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

本文介绍了无人驾驶系统中结合规划层的轨迹跟踪控制,利用MPC(模型预测控制)进行路径规划和跟踪。规划层采用点质量动力学模型,考虑避障并以离车辆最近的轨迹点作为参考。控制层则确保实际轨迹与期望轨迹偏差最小,同时满足执行机构限制。通过五次多项式拟合局部规划层的离散点,实现规划与控制的平滑对接,用非线性二次规划解决优化问题。
摘要由CSDN通过智能技术生成

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

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

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

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

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

基于MPC的规划器

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

非线性二次

评论 4
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值