四轮差速机器人运动学建模与轨迹跟踪控制

1. 四轮差速移动机器人运动学基础

四轮差速移动机器人是一种常见的移动平台，其核心运动原理基于左右两侧轮组的差速控制。这种结构简单可靠，在服务机器人、仓储AGV等领域广泛应用。要理解其轨迹跟踪控制，首先需要掌握其运动学模型。

1.1 基本假设与参数定义

在建立运动学模型时，我们通常做以下合理假设：

• 机器人车体为刚性结构，仅在二维平面(xOy)内运动
• 车轮与地面之间为纯滚动接触，无滑动摩擦（无侧滑）
• 左右两侧轮组分别同速运动，即右侧两轮速度相同(vR)，左侧两轮速度相同(vL)

关键几何参数包括：

• 轮距(B)：左右轮组中心线之间的横向距离
• 车轮半径(r)：驱动轮的有效滚动半径

实际应用中，轮距B的准确测量非常重要。建议使用激光测距仪多次测量取平均值，误差应控制在±1mm以内。我们曾遇到因轮距测量偏差2mm导致轨迹跟踪持续偏移的案例。

1.2 正运动学分析

正运动学研究的是已知轮速求解机器人整体运动状态的问题。对于四轮差速结构：

底盘中心线速度(v)和角速度(ω)与左右轮速的关系为：

code复制v = (vR + vL)/2
ω = (vR - vL)/B

这个关系式揭示了差速转向的本质——通过左右轮速差产生旋转力矩。当vR=vL时机器人直线运动；当vR=-vL时机器人原地旋转。

1.3 逆运动学分析

逆运动学则是根据期望的整体运动状态反推所需的轮速控制量。由正运动学公式可推导出：

code复制vR = v + B·ω/2
vL = v - B·ω/2

在实际控制器实现时，这两个公式将期望的v和ω转换为电机控制指令。需要注意的是，当期望ω较大时，需检查计算出的vR和vL是否超出电机物理极限。

2. 轨迹跟踪控制架构设计

2.1 位姿微分方程

在世界坐标系下，机器人位姿(位置和朝向)随时间变化的微分方程为：

code复制ẋ = v·cosθ
ẏ = v·sinθ
θ̇ = ω

其中(x,y)为底盘中心坐标，θ为机器人朝向角。这个非线性方程描述了机器人运动学本质，是轨迹跟踪控制的基础。

2.2 误差定义与坐标变换

直接使用世界坐标系误差(e_x, e_y)进行控制存在方向耦合问题。更合理的做法是将误差投影到机器人本体坐标系：

code复制e_for