Frenet坐标系的推导


     本文主要是参考文章: 轨迹规划1:Frenet坐标转化公式推导,旨在对其中一些不太清楚的推导过程以及有错的部分做一个说明更正,使对数学知识已经遗忘大半的你我也能理解公式的推导过程.
     如果想要看frenet推导的视频作品,可以看看以下两位B站大佬的作品:
          1. 《Lattice算法2之Frenet坐标公式推导》
          2. 《自动驾驶决策规划算法第一章第三节(上) 直角坐标与自然坐标转换》

0. 向量Tr等的推导

     

1. 式(3)即 L 的推导

在这里插入图片描述

2. L 方向的判断

          这部分文章中是直接给结论的,并没有解释原因,经过查阅其他资料,想了解具体为什么可以参考这篇文章:《【自动驾驶】笛卡尔坐标系和frenet坐标系相互转换》.
在这里插入图片描述
          不过这篇文章也只是解释了 Tr X Nr 的正负即为l的正负,对于为什么 Tr X Nr 的正负即为l的正负并没有给出合理的解释,在请教了B站UP<<读书思过>>之后,给出了一个比较令人信服的解释: 跟据右手定则,对于 Tr X Nr ,大拇指所指的方向即为叉乘结果的方向,也就是垂直于 TrNr 所在平面也同时垂直于 TrNr 的向量Z, 而剩下的四指握拳的方向即为 Tr 转向 Nr 的方向,为什么 Tr 转向 Nr 的方向可以关联到 l 的方向呢?打个比方,对于汽车来说,横向偏移量主要来自与打方向盘,如果向左打方向盘的话,也就是顺时针旋转,就会产生向左的位移,可以把 Tr X Nr 中四指的旋转方向与方向盘的旋转方向关联起来,当 Tr 转向 Nr 的方向为顺时针的时候,也就相当于方向盘顺时针旋转的时候,就会产生向左的偏移,这样就不难理解为什么 Tr 转向 Nr 的方向可以关联到 l 的方向了(如果有更合理的解释欢迎交流).
在这里插入图片描述

3. L 对 t 的一阶导数推导

在这里插入图片描述

4. Vx 的推导

在这里插入图片描述

5. s 对 t 的一阶导数推导

在这里插入图片描述

6. L 对 s 的一阶导数推导

在这里插入图片描述

7. L 对 s 的二阶导数推导

在这里插入图片描述

8. Vx 对 t 的一阶导数(即ax)推导

在这里插入图片描述

9. s 对 t 的二阶导数推导

在这里插入图片描述
          对于该公式的表达形式,有文章 《Frenet坐标系与Cartesian坐标系互转》 是这样写的:
在这里插入图片描述
          这里简单写一下,两者是相等的:
在这里插入图片描述

10. 参考引用

     博客资料
          1.《轨迹规划1:Frenet坐标转化公式推导》
          2.《【自动驾驶】笛卡尔坐标系和frenet坐标系相互转换》
          3.《Frenet坐标系与Cartesian坐标系互转》

     视频资料
          1.《Lattice算法2之Frenet坐标公式推导》
          2.《自动驾驶决策规划算法第一章第三节(上) 直角坐标与自然坐标转换》

     文章结尾再次感谢B站UP 读书思过 对本人提出问题的详细耐心解答!

  • 8
    点赞
  • 31
    收藏
    觉得还不错? 一键收藏
  • 6
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 6
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值