轨迹跟踪算法——Stanley法

Stanley法核心思想:

Stanley法又称为前轮反馈控制法(Front wheel feedback),核心在于基于前轮中心的路径跟踪偏差量对方向盘转向控制量进行计算。该算法基于横向跟踪误差为前轴中心到最近路径点的距离的非线性反馈函数,并且能实现横向跟踪误差指数收敛为0。根据车辆位姿与给定路径的几何关系可以直观的获得控制车辆方向盘转角的控制量。

前轮转角控制量由两部分组成:1.由航向误差引起的转角,即当前车身方向与参考轨迹最近的点的切线方向的夹角。2.由横向误差引起的转角,即前轮中心到参考轨迹最近点的横向距离。

 模型推导:

跟踪结果图:

 纯追踪及LQR的跟踪见:

纯追踪算法(Pure Pursuit) vs 线性二次型(LQR)法_Jeossirey的博客-CSDN博客_purepursuit算法

点击下方卡片,加入会员全年无限制学习后台(MPC各矩阵的底层逻辑、MPC纵向控制、模型验证、MPC自适应巡航控制、非线性系统如何线性化及MPC动力学跟踪任何轨迹、约束添加及新求解器的求解、轨迹规划、纵向规划等80个系列)会员专享爆品课程及资源,同时获得分佣资格,可赚回自己的学费! 

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

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值