车辆横向控制---pure pursuit

控制模块的输入输出:

输入:
局部路径、车辆状态、车辆位置

输出
车辆前轮转角(横向)、车辆油门开度,刹车开度(纵向)

pure pursuit 控制核心思想
纯跟踪控制算法是基于车辆运动学模型(将车辆简单描述为两轮自行车模型)的一种算法。

该算法的步骤是:

  1. 找到path(输入的局部路径)上距离车辆后轴(点B)最近的点A
  2. 沿着A往前一段前视距离找到点C
  3. 要控制前轮的转角,使B点经过点C
  4. 当然可以用一直线连接点B、C,也可以用圆弧连接两点,连接的直线或者圆弧就能算出前轮转角
  5. 按照3计算得出的车轮转角,控制车辆沿着直线或者圆弧到达C点
  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
【资源说明】 基于Matlab实现跟踪(Pure Pursuit)算法源码+项目说明.zip 基于Matlab实现跟踪(Pure Pursuit)算法 在参考资料1的基础上修正部分错误,优化代码,演示跟踪算法。 ![图片](./imgs/1.png) ## 跟踪算法本质 参考人类驾驶员的行为,以车的后轴为基点,通过控制前轮的偏角delta,使车辆沿一条经过预瞄点的**圆弧**行驶,跟踪效果将由ld决定,如何设计ld也是算法的改进方向之一。 预瞄点的引入使得控制更加平顺,普通PID控制跟踪的是离车辆最近的轨迹点,而跟踪跟踪的是预瞄点。 跟踪本质是一个**P控制器**,对车辆进行**横向控制**,代码示例中的横向误差如图所示: ![横向误差](./imgs/2.png) 可见横向误差不收敛于0,即横向控制存在静态误差,加入积分控制后,横向误差如图所示: ![横向误差](./imgs/3.png) (加入积分控制,静态误差减小,超调量增大,为减小超调量,可引入微分控制) 【备注】 1、该资源内项目代码都经过测试运行成功,功能ok的情况下才上传的,请放心下载使用! 2、本项目适合计算机相关专业(如计科、人工智能、通信工程、自动化、电子信息等)的在校学生、老师或者企业员工下载使用,也适合小白学习进阶,当然也可作为毕设项目、课程设计、作业、项目初期立项演示等。 3、如果基础还行,也可在此代码基础上进行修改,以实现其他功能,也可直接用于毕设、课设、作业等。 欢迎下载,沟通交流,互相学习,共同进步!

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值