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ᵢ)

两者描述同一物理结构,但坐标系定义位置不同,导致参数含义与误差模型形式不同。工程中必须明确采用哪一种约定,否则标定结果会出现系统性偏差。

标准DH与改进DH坐标系定义对比 标准DH(Distal) zᵢ₋₁ xᵢ₋₁ 关节 i-1 zᵢ xᵢ 关节 i aᵢ:沿 xᵢ 轴平移 αᵢ:绕 xᵢ 轴旋转 dᵢ:沿 zᵢ₋₁ 轴平移 θᵢ:绕 zᵢ₋₁ 轴旋转 改进DH(Proximal) zᵢ₋₁ xᵢ₋₁ 关节 i-1 zᵢ xᵢ 关节 i aᵢ₋₁:沿 xᵢ₋₁ 轴平移 αᵢ₋₁:绕 xᵢ₋₁ 轴旋转 dᵢ:沿 zᵢ 轴平移 θᵢ:绕 zᵢ 轴旋转

三、指数积表示:另一种统一视角

指数积(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习惯逐连杆建系,反而引入不必要的复杂性。
工程建议:标定前先确认控制器与标定算法使用同一种运动学约定;若必须转换,应通过正运动学数值验证转换前后末端位姿一致,再进入参数辨识环节。

掌握上述表示方法后,就能理解标定模型为何要对特定参数求偏导、误差如何沿运动链累积,以及不同约定下辨识结果为何不能直接互换。这是后续建立误差模型、设计测量方案与求解参数的基础。