自動駕駛路徑跟蹤算法

1.純跟蹤算法

compute_wheel2 = atan(2 * Vehicle_length * sin(pid_yaw) / (k * 2 / 3.6 + Lf)) * 57.3   # Lf 為預瞄距離

https://blog.csdn.net/adamshan/article/details/80555174

2.standly算法

δ(t)=θe​(t)+atan(ke(t)/v(t)​)  # k是系數，θe​(t)是航向偏差，e(t) 是橫向偏差， v(t)​是速度

https://blog.csdn.net/renyushuai900/article/details/98460758