1. 项目概述
在工程车辆控制领域,铰接式重型车辆的路径跟踪一直是个颇具挑战性的问题。这类车辆由于独特的铰接结构,其动力学特性比普通车辆复杂得多。我最近完成了一个基于H∞控制器和鲁棒线性二次调节器(RLQR)的混合控制方案研究,通过Matlab仿真验证了其在复杂工况下的优异性能。
这类车辆常见于矿山、港口等场景,比如铰接式自卸卡车,其前后车体通过铰接点连接,可以实现更小的转弯半径。但这也带来了控制难题——前后车体的运动相互影响,使得传统控制方法往往难以获得理想的跟踪效果。我们的研究正是要解决这个痛点。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 车辆建模与误差分析
2.1 运动学模型构建
建立准确的车辆模型是控制算法设计的基础。对于铰接式车辆,我们采用了两部分建模的方法:
-
前车体模型:
- 位置:(x_f, y_f)
- 航向角:θ_f
- 长度:L_f
-
后车体模型:
- 位置:(x_r, y_r)
- 航向角:θ_r
- 长度:L_r
铰接角φ=θ_f-θ_r是关键状态变量。通过几何关系推导,我们得到了车辆的运动学方程:
code复制ẋ_f = v·cos(θ_f)
ẏ_f = v·sin(θ_f)
θ̇_f = v·tan(δ)/L_f
φ̇ = v·(tan(δ)/L_f - sin(φ)/L_r)
其中δ是前轮转向角,v是车速。这个模型虽然简化,但能很好地反映车辆的基本运动特性。
2.2 动力学模型扩展
为了更精确地描述车辆行为,我们进一步建立了六自由度动力学模型:
-
考虑轮胎侧偏特性:
- 前轮侧偏力:F_yf = -C_f·α_f
- 后轮侧偏力:F_yr = -C_r·α_r
(C_f, C_r为侧偏刚度,α为侧偏角)
-
铰接点约束力分析:
- 纵向约束力:F_x
- 横向约束力:F_y
- 力矩:M_z
通过牛顿-欧拉方程,我们得到了包含12个状态变量的完整动力学模型,为后续控制器设计提供了坚实基础。
2.3 路径误差定义与建模
路径跟踪的核心是减小以下两个误差:
- 横向误差e_y:车辆到参考路径的垂直距离
- 航向误差e_θ:车辆航向与路径切线方向的夹角
我们基于Frenet坐标系建立了误差动力学模型:
code复制
