无人驾驶模型预测控制(六)-加入规划层的轨迹跟踪控制

结合规划层的轨迹跟踪控制系统

思想:局部规划+轨迹跟踪
局部规划:低精度模型+长周期
跟踪控制层:高精度模型+短周期
在这里插入图片描述
基于MPC规划层需满足的条件:

  1. 满足运动学、动力学约束
  2. 能避障

基于MPC控制层需满足的条件:

  1. 实际跟踪轨迹与期望轨迹偏差尽量小
  2. 优化出的控制量满足执行机构的限制
  3. 不打滑,不侧翻

基于MPC的规划器

模型:点质量动力学模型
参考点的选择:(考虑目标点信息时)离车最近的轨迹上的点。
避障函数:惩罚离障碍物的距离
在这里插入图片描述
轨迹重规划层的模型预测控制器目标函数
在这里插入图片描述
五次多项式轨迹拟合

  • 3
    点赞
  • 34
    收藏
    觉得还不错? 一键收藏
  • 4
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值