3、全向运动学原理：刚体平面运动、速度分解、平移与旋转的叠加
麦克纳姆轮底盘之所以能实现全向移动，其本质在于对刚体平面运动规律的工程化应用。在二维平面中，任何刚体的运动状态都可以被唯一地分解为两个正交方向的平移速度（vx，vy）与一个绕质心的旋转角速度（ω）。全向轮底盘的控制器正是基于这一运动学模型，将期望的底盘速度矢量映射为四个轮子的独立转速。理解这一从“刚体运动”到“轮速分配”的数学桥梁，是进行底盘运动控制、里程计解算与路径规划的前提。
上图展示了全向运动学分解的完整逻辑链：首先将底盘视为一个刚体，用三个自由度描述其期望运动；然后针对每个轮子的安装位置，将质心速度分解到轮心处；最后将平移分量与旋转分量线性叠加，得到每个轮子的目标转速。下面从刚体运动基础开始，逐步展开这一分解过程。
3.1 刚体平面运动的核心原理
在机器人运动学中，刚体平面运动是指物体在二维平面内的运动，其状态可由三个独立变量完全描述：沿x轴的线速度vx、沿y轴的线速度vy，以及绕垂直于平面的z轴旋转的角速度ω。这三个变量构成了底盘的速度向量V = (vx, vy, ω)T。
刚体上任意一点P的速度并非简单地等于质心速度。根据刚体运动学，点P的速度为：
v_P = v_C + ω × r_CP其中，vC是质心速度，rCP是从质心指向点P的位置矢量，ω×rCP表示由于旋转引起的切向速度分量。对于麦克纳姆轮底盘，每个轮子的安装位置不同，因此即使底盘整体做相同的运动，各轮心处的速度矢量也是不同的。
工程含义：这一原理决定了全向底盘的运动控制不能简单地对四个轮子给定相同转速。必须根据每个轮子的几何位置，将期望的底盘速度分解到各轮心，再结合轮子的安装角度和辊子方向，反解出每个轮子的目标转速。
3.2 速度分解：从底盘速度到轮心速度
速度分解是连接底盘运动与轮子运动的桥梁。具体步骤如下：
- 确定底盘几何参数：测量轮子相对于底盘中心的x、y坐标（a, b），以及轮子的安装角度（通常为0°或90°）。
- 计算轮心速度：对于第i个轮子，其轮心速度为：
v_ix = v_x - ω × b_i
v_iy = v_y + ω × a_i其中(ai, bi)是第i个轮子的坐标。注意旋转分量ω×r的方向遵循右手定则。
- 投影到辊子方向：麦克纳姆轮的辊子与轮子轴线呈45°角。将轮心速度投影到垂直于辊子轴的方向，得到有效驱动力方向的分量。
| 轮子位置 | 坐标符号 | 辊子方向 | 速度分解特点 |
|---|---|---|---|
| 左前(FL) | (+a, +b) | 与x轴呈45° | vx和vy分量同向叠加 |
| 右前(FR) | (+a, -b) | 与x轴呈-45° | vx和vy分量反向叠加 |
| 左后(RL) | (-a, +b) | 与x轴呈-45° | vx和vy分量反向叠加 |
| 右后(RR) | (-a, -b) | 与x轴呈45° | vx和vy分量同向叠加 |
3.3 平移与旋转的叠加：麦克纳姆轮逆运动学
将平移分量与旋转分量线性叠加，即可得到每个轮子的最终转速。以标准麦克纳姆轮底盘（轮子呈矩形布置，辊子与轮轴呈±45°）为例，其逆运动学方程为：
n_FL = (1/R) × (v_x - v_y - ω×(a+b))
n_FR = (1/R) × (v_x + v_y + ω×(a+b))
n_RL = (1/R) × (v_x + v_y - ω×(a+b))
n_RR = (1/R) × (v_x - v_y + ω×(a+b))其中R是轮子半径，a和b分别是轮子到质心的纵向和横向距离。这个方程清晰地展示了平移与旋转的叠加关系：
- 平移分量：vx和vy对所有轮子产生同向或反向的贡献，实现前后左右移动。
- 旋转分量：ω×(a+b)项使对角线上的轮子产生相反的附加转速，实现原地旋转。
经验提醒：在实际工程中，a和b的取值通常不相等。当底盘需要原地旋转时，四个轮子的转速值应相等但方向两两相反。如果发现底盘旋转时出现平移漂移，应检查a和b的测量值是否准确，以及四个轮子的辊子方向是否安装正确。
3.4 案例拆解：原地旋转与斜向移动的对比
假设一个麦克纳姆轮底盘参数为：a = 0.3m，b = 0.2m，R = 0.05m。我们分析两种典型运动模式。
场景一：原地旋转（vx=0, vy=0, ω=1 rad/s）
n_FL = (1/0.05) × (0 - 0 - 1×(0.3+0.2)) = -10 rad/s
n_FR = (1/0.05) × (0 + 0 + 1×(0.3+0.2)) = +10 rad/s
n_RL = (1/0.05) × (0 + 0 - 1×(0.3+0.2)) = -10 rad/s
n_RR = (1/0.05) × (0 - 0 + 1×(0.3+0.2)) = +10 rad/s左侧轮反转，右侧轮正转，且转速值相等，实现绕质心的纯旋转。
场景二：45°斜向移动（vx=1 m/s, vy=1 m/s, ω=0）
n_FL = (1/0.05) × (1 - 1 - 0) = 0 rad/s
n_FR = (1/0.05) × (1 + 1 + 0) = 40 rad/s
n_RL = (1/0.05) × (1 + 1 - 0) = 40 rad/s
n_RR = (1/0.05) × (1 - 1 + 0) = 0 rad/s左前轮和右后轮静止，右前轮和左后轮同向旋转，底盘沿45°方向平移。这验证了麦克纳姆轮“通过辊子被动滑动实现横向分量”的独特机制。
| 运动模式 | vx (m/s) | vy (m/s) | ω (rad/s) | 轮速特征 |
|---|---|---|---|---|
| 前后平移 | 1 | 0 | 0 | 四轮同向等速 |
| 左右平移 | 0 | 1 | 0 | 对角轮同向，相邻轮反向 |
| 原地旋转 | 0 | 0 | 1 | 左右侧轮反向等速 |
| 斜向45° | 1 | 1 | 0 | 两个轮静止，两个轮旋转 |
3.5 常见误区与工程复盘
在全向运动学应用过程中，工程师常遇到以下问题：
风险一：辊子方向装反。麦克纳姆轮必须成对安装，左前和右后使用同一方向辊子，右前和左后使用另一方向。若装反，底盘将无法实现横向移动，甚至出现“卡死”现象。
风险二：忽略轮子打滑。运动学模型假设辊子与地面为纯滚动接触。实际中，辊子与地面的摩擦系数有限，高速运动或急加速时会出现打滑，导致实际轨迹与理论计算偏差。此时需要引入闭环控制（如编码器反馈）进行修正。
风险三：质心偏移。如果底盘负载分布不均，实际质心与几何中心不重合，旋转运动会产生额外的平移分量。在重载AGV中，应通过动力学补偿或调整运动学参数来缓解。
复盘总结：全向运动学的核心在于“分解-叠加”的线性思维。掌握刚体平面运动的三自由度描述，理解速度从质心到轮心的传递规律，熟练运用逆运动学方程进行轮速分配，是设计可靠全向底盘控制系统的关键。建议在实车调试前，先用仿真工具验证运动学模型，再逐步过渡到实物测试，可大幅缩短调试周期。