2. 机器人运动学基础
在机器人坐标系标定与误差补偿中，运动学是描述“机器人末端在哪里、姿态如何、关节如何运动”的数学基础。标定本质上是在修正运动学模型中的参数误差，因此必须先理解位姿表示、齐次变换、DH参数、正逆运动学以及坐标系定义。只有把这几件事串成一条完整的链路，后续的误差建模、参数辨识和补偿才有明确的物理意义。
一、位姿表示：位置与姿态的统一描述
机器人末端在三维空间中的状态称为位姿，由位置和姿态两部分组成。位置通常用三维向量表示：
p = [x, y, z]^T姿态描述的是末端坐标系相对于参考坐标系的朝向。常见表示方法包括旋转矩阵、欧拉角、轴角以及四元数。旋转矩阵是3×3正交矩阵，满足 R^T R = I 且 det(R)=1；欧拉角直观但存在万向节死锁；四元数无奇异且适合插值，在机器人控制中广泛使用。
位姿的完整表达通常写成：
T = [ R p ]
[ 0 1 ]其中 R 为3×3旋转矩阵，p 为3×1位置向量。这个4×4矩阵就是齐次变换矩阵，它把旋转和平移统一在一个线性变换中，便于连续变换的乘法组合。
二、齐次变换：坐标系之间的“翻译器”
齐次变换的核心价值在于：把“绕某轴旋转”和“沿某方向平移”统一为矩阵乘法。若坐标系{B}相对于{A}的齐次变换为 ^A T_B，则点在该坐标系下的坐标可写成：
^A P = ^A T_B · ^B P多个坐标系串联时，只需按顺序相乘：
^0 T_n = ^0 T_1 · ^1 T_2 · ... · ^{n-1} T_n这正是机器人正运动学的基础。齐次变换的逆也有简洁形式：
T^{-1} = [ R^T -R^T p ]
[ 0 1 ]理解这一点非常关键：标定中经常需要在不同坐标系之间来回转换，如果逆变换写错，误差补偿方向就会整体反向。
三、DH参数：把机器人结构写成标准表格
Denavit-Hartenberg（DH）参数用四个量描述相邻连杆坐标系之间的变换关系，是工业机器人建模最常用的标准方法。标准DH参数包括：
- ai：连杆长度，沿 xi 轴从 zi 到 zi+1 的距离；
- αi：连杆扭角，绕 xi 轴从 zi 到 zi+1 的转角；
- di：连杆偏距，沿 zi 轴从 xi-1 到 xi 的距离；
- θi：关节角，绕 zi 轴从 xi-1 到 xi 的转角。
相邻坐标系的齐次变换可写成：
T_i = Rot(z, θ_i) · Trans(z, d_i) · Trans(x, a_i) · Rot(x, α_i)展开后得到标准DH变换矩阵。对于旋转关节，θi 是变量；对于移动关节，di 是变量。DH参数表一旦建立，正运动学就变成“查表—代公式—连乘”的机械过程。
关键理解：DH参数不是几何尺寸的简单罗列，而是坐标系定义规则下的结构化描述。同一台机器人，如果坐标系定义方式不同，DH参数表也会不同，但最终末端位姿必须一致。
四、正运动学与逆运动学
正运动学是已知各关节变量，求末端位姿。对于六轴串联机器人，正运动学就是六个齐次变换矩阵连乘：
T_0_6 = T_1(θ1) · T_2(θ2) · T_3(θ3) · T_4(θ4) · T_5(θ5) · T_6(θ6)逆运动学则相反：已知末端目标位姿，求各关节角。逆解通常存在多解、无解或奇异情况。工业机器人常用解析法（如PUMA型机器人）或数值法（如雅可比迭代）。逆解的质量直接影响轨迹精度和标定补偿的可实现性。
下面这张图展示了从关节空间到末端位姿的正向链路，以及从目标位姿反求关节角的逆向链路，同时标出了DH参数和坐标系在其中的位置。
五、坐标系定义：标定的“基准”
机器人系统中通常涉及多个坐标系：基坐标系、关节坐标系、工具坐标系（TCP）、工件坐标系以及传感器坐标系。标定的本质，就是确定这些坐标系之间的真实变换关系，并修正理论模型与实际模型之间的偏差。
以工具坐标系标定为例，常用四点法或六点法：让工具末端以不同姿态接触同一固定点，通过多组位姿数据反算出TCP相对于末端法兰的变换矩阵。工件坐标系标定则通过接触三个以上已知点，建立工件坐标系与基坐标系的关系。
实操提示：标定前必须明确每个坐标系的定义原点和轴向。如果坐标系定义不统一，后续DH参数辨识和误差补偿会失去一致的参考基准，导致补偿量被错误地分配到不同关节上。
六、常见误区与复盘
| 误区 | 表现 | 纠正方法 |
|---|---|---|
| 混淆标准DH与改进DH | 变换矩阵连乘顺序错误，末端位姿偏差大 | 明确坐标系固连方式，统一采用一种DH约定 |
| 忽略关节零位偏差 | 理论零位与实际零位不一致，标定残差偏大 | 将零位偏差作为待辨识参数加入误差模型 |
| 逆解多解选择不当 | 轨迹出现跳变或碰撞 | 结合关节限位、避障和连续性选择最优解 |
| 坐标系定义不统一 | 补偿方向相反或补偿量错位 | 标定前统一基座、工具、工件坐标系定义 |
复盘时可以按以下清单检查：DH参数表是否与机器人实际结构一致；正运动学计算结果是否与示教器显示位姿吻合；逆解是否覆盖工作空间内的目标点；各坐标系定义是否在标定方案中明确记录；误差补偿量是否被正确映射回对应关节或几何参数。
注意：运动学模型是标定与补偿的“骨架”。如果正运动学本身存在系统性错误，后续任何参数辨识都只是在拟合错误模型，补偿效果会随位姿变化而迅速恶化。因此，在进入标定流程前，务必先验证正运动学模型的正确性。
总结来说，位姿表示解决“怎么描述”，齐次变换解决“怎么计算”，DH参数解决“怎么建模”，正逆运动学解决“怎么求解”，坐标系定义解决“以谁为基准”。这五者共同构成机器人运动学基础，也是后续坐标系标定与误差补偿的起点。