2. 车辆动力学基础
轮速与IMU融合估计车辆状态，本质上是在“车辆如何运动”这一物理模型约束下，把轮速传感器测得的车轮转动信息与IMU测得的惯性信息进行互补校正。因此，在进入具体算法之前，必须先建立一套统一的车辆动力学语言：车辆在空间中如何运动、轮胎如何产生力、力与运动之间通过什么变量耦合、以及不同坐标系之间如何转换。本章围绕纵向、侧向、横摆三个自由度展开，并给出轮胎力与滑移率的基本定义和常用符号约定。
一、核心原理：三自由度平面运动描述
在常规道路工况下，车辆状态估计最常用的简化模型是平面三自由度模型，即纵向运动、侧向运动和横摆运动。忽略垂向、俯仰和侧倾后，车辆在水平面内的运动可以用车身坐标系下的三个状态量描述：纵向速度 v_x、侧向速度 v_y 和横摆角速度 r（也常写作 ω_z 或 ψ̇）。
纵向运动由驱动力与阻力之差决定，侧向运动由轮胎侧向力提供向心力，横摆运动则由左右轮胎力对质心形成的力矩差驱动。三者并非独立：当车辆转向时，前轮侧偏产生侧向力，侧向力绕质心形成横摆力矩，横摆角速度改变航向角，进而改变轮胎侧偏角，形成闭环耦合。这正是轮速与IMU融合时必须同时考虑多状态的原因。
三自由度运动方程（车身坐标系，忽略垂向与侧倾）：
m·(v̇_x − r·v_y) = F_x
m·(v̇_y + r·v_x) = F_y
I_z·ṙ = M_z其中 m 为整车质量，I_z 为绕质心垂向轴的转动惯量，F_x、F_y 为轮胎合力在车身坐标系的投影，M_z 为横摆合力矩。
注意方程左侧出现了 r·v_y 与 r·v_x 的交叉项，这是车身坐标系随车辆旋转产生的科里奥利项。IMU安装在车身上，其加速度计输出本身就是车身坐标系下的比力，因此直接使用上述方程比在惯性系下建模更自然，也更容易与轮速信号对齐。
二、轮胎力与滑移率：从轮速到力的桥梁
轮胎是车辆与地面之间唯一的力传递界面。纵向力主要由滑移率决定，侧向力主要由侧偏角决定。滑移率定义为车轮实际滚动速度与车身纵向速度之间的相对差异：
驱动工况： s_x = (ω·R_e − v_x) / (ω·R_e)
制动工况： s_x = (ω·R_e − v_x) / v_x其中 ω 为车轮角速度，R_e 为有效滚动半径，v_x 为车轮中心处的纵向速度。当 ω·R_e > v_x 时轮胎处于驱动滑移，当 ω·R_e < v_x 时处于制动滑移。滑移率在约 0.1～0.2 附近时纵向附着系数达到峰值，之后随滑移率增大而下降，进入不稳定区域。
侧偏角 α 定义为车轮平面方向与车轮实际运动方向之间的夹角。在小角度范围内，侧向力与侧偏角近似线性：F_y ≈ C_α·α，其中 C_α 为侧偏刚度。当侧偏角超过约 5°～8° 后，侧向力趋于饱和并可能下降，车辆进入非线性区域。轮速融合估计中，若忽略滑移率与侧偏角的非线性，在大制动或急转向工况下会出现明显偏差。
工程提示：轮速传感器直接测量的是车轮角速度 ω，而不是车速。只有在滑移率接近零的工况下，ω·R_e 才能近似代表 v_x。这正是需要IMU纵向加速度进行互补校正的根本原因。
三、常用坐标系与符号约定
车辆动力学中至少涉及三套坐标系：车身坐标系、轮胎坐标系和惯性/大地坐标系。车身坐标系原点通常取在质心，x 轴指向车辆前进方向，y 轴指向驾驶员左侧，z 轴向上，构成右手系。轮胎坐标系原点取在轮胎接地点，x 轴沿车轮平面与地面交线指向滚动方向。惯性坐标系用于描述车辆绝对位置和航向角 ψ。
| 符号 | 含义 | 单位 | 典型来源 |
|---|---|---|---|
v_x | 车身纵向速度 | m/s | 轮速+IMU融合估计 |
v_y | 车身侧向速度 | m/s | IMU+动力学模型估计 |
r | 横摆角速度 | rad/s | IMU陀螺仪直接测量 |
a_x | 纵向加速度 | m/s² | IMU加速度计 |
a_y | 侧向加速度 | m/s² | IMU加速度计 |
ω | 车轮角速度 | rad/s | 轮速传感器 |
R_e | 有效滚动半径 | m | 标定参数 |
s_x | 纵向滑移率 | — | 由 ω、R_e、v_x 计算 |
α | 轮胎侧偏角 | rad | 由 v_x、v_y、r 计算 |
δ | 前轮转角 | rad | 方向盘转角/传动比 |
ψ | 航向角 | rad | r 积分得到 |
β | 质心侧偏角 | rad | arctan(v_y/v_x) |
坐标系之间的转换关系是融合算法的基础。车身坐标系到惯性坐标系的旋转矩阵为：
[x_dot] [cosψ −sinψ] [v_x]
[y_dot] = [sinψ cosψ] [v_y]而IMU测量值到车身坐标系的转换则取决于安装位置和安装角。若IMU未安装在质心，还需补偿因横摆和侧向运动产生的离心加速度与切向加速度，否则 a_y 测量中会混入 r·v_x 和 ṙ·l 等分量。
四、场景案例：双移线工况下的状态耦合
以标准双移线测试为例。车辆先向左转向，前轮转角 δ 为正，前轴产生侧偏角，前轮侧向力向左，绕质心形成逆时针横摆力矩，横摆角速度 r 增大，航向角 ψ 增加。此时车身产生侧向速度 v_y，后轴也出现侧偏角并产生侧向力。当驾驶员回正并向右转向时，δ 反向，横摆力矩反向，r 逐渐减小并反向。
在这一过程中，轮速传感器会因左右轮路径差和滑移率变化而输出不同转速，IMU则测量到明显的侧向加速度和横摆角速度。若只使用轮速平均速度作为 v_x，在侧向加速度较大时误差可达 5%～10%；若只积分IMU纵向加速度，则会因零偏产生漂移。融合的价值正在于用轮速抑制IMU积分漂移，用IMU补偿轮速在滑移工况下的失真。
五、常见误区与复盘要点
- 误区一：把轮速直接当车速。轮速乘以滚动半径得到的是车轮线速度，只有在滑移率接近零时才等于车速。制动、驱动、低附着路面都会破坏这一假设。
- 误区二：忽略坐标系交叉项。在车身坐标系下建模时，
r·v_y和r·v_x不能省略，尤其在高速大转向工况下，这些项的量级可与加速度本身相当。 - 误区三：混淆横摆角速度与航向角变化率。在水平面上二者数值相等，但航向角
ψ是积分量，会累积误差；横摆角速度r是IMU直接测量量，不存在积分漂移，但存在零偏。 - 误区四：忽略IMU安装位置。若IMU不在质心，加速度计输出包含
ṙ·l和r²·l等分量，必须做杆臂补偿，否则侧向加速度会被污染。 - 误区五：用线性轮胎模型覆盖全工况。滑移率超过峰值附着点、侧偏角超过饱和区后，线性模型失效，融合估计需要引入非线性观测或工况判别。
复盘建议：在搭建轮速IMU融合算法前，先确认三件事——坐标系定义是否统一、符号正方向是否一致、IMU安装位置与杆臂是否已标定。这三项若出错，后续滤波器参数再精细也无法得到正确的 v_x、v_y 和 r。
本章建立的运动学与动力学基础，是后续轮速与IMU融合观测器设计的共同语言。纵向、侧向、横摆三自由度的耦合关系，轮胎力与滑移率/侧偏角的非线性特性，以及车身坐标系、轮胎坐标系与惯性坐标系之间的转换，共同决定了融合算法中状态量选取、观测方程构建和噪声建模的方式。