车辆运动学模型与动力学模型:从理论到实战
各位同学,欢迎来到第二章。上一章我们聊了仿真环境搭建,今天要啃的这块骨头,是自动驾驶控制算法的基石——车辆模型。
说实话,我刚入行那会儿,觉得模型推导就是纯数学游戏,跟实际工程差得远。直到有一次,我负责的LKA(车道保持)项目在实车测试时,方向盘一直在那里“哆嗦”,怎么调参数都没用。后来才发现,是我用的模型太粗糙,忽略了轮胎侧偏特性。嗯,从那以后,我再也不敢小看模型了。
今天的内容,我会从最简单的自行车模型讲起,一步步深入到状态空间方程。你想想看,搞懂了这些,你就能在仿真里精准预测车辆行为,到了实车上也能快速定位问题。
2.1 自行车模型:简化但不简单
为什么叫“自行车模型”?说白了,就是把四轮车辆简化成两轮。前轮和后轮各一个,合并了左右轮的受力。这个简化在低速、小转向角场景下,精度完全够用。
我个人习惯,在仿真初期先用自行车模型。它参数少,调起来快。等基本逻辑跑通了,再换更复杂的模型做精细化验证。
自行车模型的运动学方程,核心就三个变量:
- 横向位置 y:车辆偏离车道中心的距离
- 航向角 ψ:车辆朝向与车道中心线的夹角
- 前轮转角 δ:方向盘输入对应的前轮角度
推导过程其实不复杂。假设车辆后轮中心为参考点,速度方向始终沿着后轮朝向。那么:
y_dot = v * sin(ψ)
ψ_dot = (v / L) * tan(δ)
这里 L 是轴距。v 是车速。你看,是不是很简洁?
2.2 轮胎侧偏特性:被忽视的关键
刚才的自行车模型,假设轮胎是刚性的,没有侧向滑移。但真实轮胎不是这样。你想想看,轮胎是橡胶做的,有弹性。转弯时,轮胎接地印迹会发生扭曲,产生一个侧偏角。
这个侧偏角 α 和侧向力 F_y 的关系,就是轮胎侧偏特性。在小角度范围内,它们近似线性:
F_y = C_α * α
C_α 就是侧偏刚度。单位是 N/rad 或 N/deg。
我在项目中遇到过最坑的事,就是用了错误的侧偏刚度值。那次我们做高速车道保持,仿真里一切完美,上了实车一过弯就甩尾。查了两天才发现,轮胎供应商给的侧偏刚度数据是在标准胎压下测的,而我们实车胎压高了0.3 bar。就这么点差异,侧偏刚度变了15%。
轮胎侧偏特性还有一个关键点:饱和特性。当侧偏角超过某个阈值(通常是5-8度),侧向力不再线性增加,而是趋于饱和。这时候车辆就开始“推头”或“甩尾”了。嗯,这里要注意,我们的车道保持控制器,最好别让侧偏角进入饱和区。否则控制效果会急剧恶化。
2.3 状态空间方程:把模型装进计算机
有了自行车模型和轮胎侧偏特性,我们就可以建立完整的动力学模型了。状态空间方程,说白了就是把微分方程写成矩阵形式,方便计算机求解。
我常用的状态向量是:
x = [y, ψ, β, ψ_dot]^T
其中 β 是质心侧偏角。ψ_dot 是横摆角速度。
控制输入 u = [δ](前轮转角)。
那么状态空间方程可以写成:
x_dot = A * x + B * u
矩阵 A 和 B 的推导过程,我直接给出结果:
| 参数 | 表达式 | 说明 |
|---|---|---|
| A(1,2) | v | 横向位置对航向角的耦合 |
| A(3,3) | -(C_f + C_r) / (m * v) | 质心侧偏角阻尼项 |
| A(4,3) | -(a*C_f - b*C_r) / I_z | 横摆运动与侧偏的耦合 |
| B(3,1) | C_f / (m * v) | 前轮转角对侧偏角的影响 |
| B(4,1) | a * C_f / I_z | 前轮转角对横摆角速度的影响 |
这里 m 是整车质量,I_z 是横摆转动惯量,a 和 b 分别是质心到前后轴的距离。
2.4 模型参数标定方法:纸上得来终觉浅
模型建好了,参数怎么来?不能靠猜。我总结了一套标定流程,经过多个项目验证:
- 静态参数测量:轴距 L、质心位置 a 和 b、整车质量 m。这些可以直接测量或从设计图纸获取。
- 轮胎侧偏刚度标定:这个最麻烦。我常用的方法是做稳态圆周试验。让车辆以恒定车速、恒定方向盘转角绕圈,记录横摆角速度和侧向加速度。然后反推侧偏刚度。
- 横摆转动惯量 I_z 标定:可以用双摆法,或者用CAD模型估算。我个人习惯用CAD估算,精度够用,省时间。
- 模型验证:用一组独立的测试数据(比如双移线工况)来验证模型预测精度。如果误差超过5%,就要回头检查参数。
我曾经在标定侧偏刚度时,犯过一个低级错误。我用的是稳态圆周试验数据,但忽略了路面坡度。结果算出来的侧偏刚度偏大30%。后来加了坡度补偿,才得到正确值。所以,标定环境一定要控制好。
好了,这一章的内容就到这里。从自行车模型到状态空间方程,再到参数标定,每一步都有坑,但也都有解法。下一章我们会聊控制器的设计,到时候这些模型就要派上大用场了。
记住,模型是工具,不是真理。理解它的假设和局限,比记住公式更重要。
公众号:蓝海资料掘金营,微信deep3321