1.简介
车辆运动规划与控制需要通过对车辆运动学或者动力学系统的控制来实现
如果规划阶段能够考虑车辆 运动学和动力学约束,那么运动跟踪控制性能会更好
车辆在地面运动的动力学过程是非常复杂的,为了尽量准确描述车辆运动,需要建立复杂的微分方程组,并用多个状态变量来描述其运动
用于模型预测控制的模型只要能够表现出车辆运动学与动力学约束,就可以使模型预测控制器实现预定控制目的
特别是在规划阶段,为了保证规划算法的实时性,约束简化和近似就是一种非常重要的手段,比如 轮胎摩擦圆约束 和 点质量模型
因此,过于复杂的模型并不是研究的重点,实际性价比不大
从无人驾驶车辆 路径重规划 和 道路跟踪控制 的角度对车辆系统进行建模,建立能够尽量准确反映车辆运动特性,并且有利于模型预测控制器设计的简化车辆运动学模型和动力学模型
2.车辆运动学
车辆运动学模型从几何学的角度研究车辆的运动规律
包括车辆的空间位姿、速度等随时间的变化
当车辆在良好路面上低速行驶时,一般不需要考虑车辆的操纵稳定性等动力学问题
此时基于运动学模型设计的路径跟踪控制器具备可靠的控制性能
3.运动模型
先看阿克曼转向车辆的运动模型:
符号 | 含义 | 符号 | 含义 | 符号 | 含义 |
---|---|---|---|---|---|
Xr | 车辆后轴中心X坐标位置的变化量 | Yr | 车辆后轴中心 Y坐标位置的变化量 | φ | 车辆的横摆角(航向角)的变化量 |
φ | 车辆的横摆角(航向角) | Vr | 车辆后轴中心的速度 | w | 车辆横摆角的角速度 |
4.推导
大概从上面公式也能知道其含义,接下来看图推导:
符号 | 含义 | 符号 | 含义 | 符号 | 含义 |
---|---|---|---|---|---|
(Xr, Yr) | 车辆前轴中心的坐标 | (Xr, Yr) | 车辆后轴中心的坐标 | φ | 车辆的横摆角(航向角) |
Vr | 车辆后轴中心的速度 | Vr | 车辆后轴中心的速度 | δf | 前轮偏角 |
l | 轴距 | N | 车辆前轴中心 | M | 车辆后轴中心 |
R | 后轮转向半径 | P | 车辆瞬时转动中心 | w | 车辆横摆角的角速度 |
此处假设转向过程中车辆质心侧偏角保持不变,即车辆瞬时转向半径与道路曲率半径相同
在后轴行驶轴心( X r , Y r ) 处速度为:
前后轴的运动学约束为:
垂直于运动方向上的变化相互抵消
可得:
根据前后轮的几何关系可得:
将 公式3 和 4 代入 公式2
可解得横摆角速度为:
其实可以从图中的几何关系推导得出,假设横摆的线速度为 Vw,那么有 tan δf = Vw / Vr,而角速度公式 w = Vw / l
不过推导一下也不是很难,恩,相对后续的内容,这是最简单的了
先对公式4求导
把公式3代入
再代入公式2的第一个式子
展开
梳理一下
同时根据 横摆角速度w 和 车速 Vr可以得到 转向半径R 和 前轮偏角δ f
由 公式3 和 5,可得到车辆运动学模型为:
该模型可被进一步表示为更为一般的形式:
在路径跟踪控制过程中,往往采用速度和横摆角速度作为控制量,将 公式5 代入上运动学模型转换成如下:
5. 车辆跟踪误差模型
跟踪误差模型是车辆路径跟踪控制中常用的车辆运动模型之一
如图所示,
其中 P1点处的曲率 Kref = 1 / R
角速度相同的条件下,可以得到关于投影沿道路中心线的移动速度s ˙的以下关系:
车辆跟踪误差方程可以表示为:
忽略车辆的横向速度 Vy ,则可以写为:
基于跟踪误差模型设计的模型预测控制权可以方便的对跟踪过程中的航向偏差和距离偏差施加约束
同时可以考虑道路曲率对跟踪效果的影响,有利于提升弯道跟踪的效果
评论(0)
您还未登录,请登录后发表或查看评论