1-第1章 第3节-直角坐标与自然坐标转换-2-会用公式就行

第一章第三节 自然坐标与直角坐标转换(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

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值