2. 机器人运动学基础
机械臂运动学参数标定的本质,是辨识一组能够准确描述“关节空间—笛卡尔空间”映射关系的几何参数。要理解标定对象、误差来源与辨识模型,必须先掌握机器人运动学的几种主流表示方法。本章围绕刚体变换、齐次矩阵、标准DH参数、改进DH参数与指数积表示展开,为后续误差建模与参数辨识奠定数学基础。
一、核心原理:从刚体变换到齐次矩阵
机械臂的每一个连杆都可以视为刚体。描述刚体在空间中的位姿,需要同时表达位置与姿态:位置用三维平移向量 p = [x, y, z]ᵀ 表示,姿态用 3×3 旋转矩阵 R 表示。旋转矩阵满足正交性 RᵀR = I 且 det(R) = 1,其列向量分别对应连杆坐标系三个轴在基坐标系中的方向。
若把旋转与平移合并为一个 4×4 矩阵,就得到齐次变换矩阵:
T = [ R p ]
[ 0 1 ]
其中 R 为 3×3 旋转矩阵,p 为 3×1 平移向量,
0 为 1×3 零向量,1 为标量。
齐次矩阵的最大优势在于:连续变换可以通过矩阵连乘直接复合。若从基座到末端依次经过 n 个连杆,则末端位姿为 T₀ⁿ = T₀¹·T₁²·…·Tₙ₋₁ⁿ。这一连乘结构正是运动学标定中“参数误差如何传播到末端位姿误差”的数学根源。
二、方法流程:DH参数与改进DH参数
Denavit-Hartenberg(DH)参数用四个量描述相邻连杆坐标系之间的变换:连杆长度 a、连杆扭角 α、关节距离 d、关节转角 θ。标准DH的变换顺序为:绕 z 轴转 θ → 沿 z 轴移 d → 沿 x 轴移 a → 绕 x 轴转 α,即:
Tᵢ₋₁,ᵢ = Rot(z, θᵢ) · Trans(z, dᵢ) · Trans(x, aᵢ) · Rot(x, αᵢ)
改进DH(Modified DH)则把坐标系固连方式调整为:绕 x 轴转 α → 沿 x 轴移 a → 绕 z 轴转 θ → 沿 z 轴移 d,即:
Tᵢ₋₁,ᵢ = Rot(x, αᵢ₋₁) · Trans(x, aᵢ₋₁) · Rot(z, θᵢ) · Trans(z, dᵢ)
两者描述同一物理结构,但坐标系定义位置不同,导致参数含义与误差模型形式不同。工程中必须明确采用哪一种约定,否则标定结果会出现系统性偏差。
三、指数积表示:另一种统一视角
指数积(Product of Exponentials, PoE)表示法基于李群与螺旋理论,把每个关节的运动描述为绕某条空间螺旋轴的旋转或平移。对于转动关节,其螺旋轴 ξ 由轴方向 ω 和轴上一点 q 确定,对应的齐次变换为矩阵指数 e^{ξ̂θ}。整条运动链的末端位姿可写为:
T(θ) = e^{ξ̂₁θ₁} · e^{ξ̂₂θ₂} · … · e^{ξ̂ₙθₙ} · M
其中 M 为零位时的末端位姿,
ξ̂ᵢ 为第 i 个关节的螺旋轴矩阵,
θᵢ 为第 i 个关节变量。
PoE 的显著优点是:所有关节轴都在同一基坐标系下描述,无需为每个连杆单独建立坐标系,避免了DH约定不一致带来的歧义。在标定中,PoE 模型可直接对螺旋轴参数求导,误差模型更简洁,近年来在协作机械臂与高精度标定中应用日益广泛。
四、对比与选型:四种表示方法一览
| 表示方法 | 核心参数 | 坐标系约定 | 标定适用性 |
|---|---|---|---|
| 刚体变换/齐次矩阵 | R, p | 无固定约定 | 基础工具,用于误差传播分析 |
| 标准DH | a, α, d, θ | z轴沿关节轴,x轴沿公垂线 | 经典,参数少,但奇异位形多 |
| 改进DH | a, α, d, θ | x轴沿关节轴,z轴沿公垂线 | 误差模型更连续,适合辨识 |
| 指数积(PoE) | 螺旋轴 ξ, 零位位姿 M | 统一基坐标系 | 无坐标系歧义,适合现代标定 |
五、案例与误区复盘
某六轴机械臂在标定后发现末端位置残差在特定姿态下突然增大。排查发现:标定程序采用改进DH建模,而控制器内部使用标准DH参数,两者对 a 与 α 的归属定义不同,导致参数映射错误。修正方法是建立两套参数之间的转换关系,或在标定中统一采用控制器实际使用的约定。
- 混用标准DH与改进DH参数,导致变换矩阵连乘顺序错误。
- 忽略关节零位偏置,把机械零位与编码器零位直接等同。
- 认为DH参数一定唯一;实际上同一机械臂可有多组等价DH参数。
- 在PoE模型中仍按DH习惯逐连杆建系,反而引入不必要的复杂性。
掌握上述表示方法后,就能理解标定模型为何要对特定参数求偏导、误差如何沿运动链累积,以及不同约定下辨识结果为何不能直接互换。这是后续建立误差模型、设计测量方案与求解参数的基础。