第一章第三节 自然坐标与直角坐标转换(frenet 与 Cartesian迪卡尔)-下
本节课内容(一定要扣紧上个md文件的图 感受!!!!)下面的计算公式是基于s已知的情况;且l关于时间和s的求导都得算,因为比如s关于时间的二阶导的公式有l关于s的一阶导数,l关于s的二阶导也有l和s关于t的二阶导。
基于s的值,按下面的公式顺序算即可算出所有值
这里的第一步找xr,yr,theta_r,k_r就是参考线的一个完全表达,需要确定/使用参考线,用这几个变量就行了
1 求 r r r_r rr ,即:求 x r , y r x_r, y_r xr,yr 找host vehicle的点的在base frame下的投影坐标,其实找到就全算出来了,但是因为只能找近似的,所以还要推出精确解
1.1 找host vehicle的点的在base frame下的投影坐标
一般参考轨迹(车道中心线)都是离散的,所以找不到理想投影,只能近似解
遍历离散点,求离散点与车的距离,找最短的距离,称这个点为匹配点,记为 ( x m , y m , θ m , k m ) (x_m, y_m,\theta_m,k_m) (xm