3. 机器人运动学基础

几何标定与精度补偿的所有算法，最终都要落到一个共同的基础之上：机器人运动学。无论是用激光跟踪仪测量末端位姿，还是用球杆仪采集圆轨迹误差，标定过程本质上都是在回答同一个问题——关节变量与末端位姿之间的映射关系是什么，这个映射中哪些参数被制造和装配误差污染了。本节把DH参数、旋量理论、正逆运动学与几何误差建模串成一条完整的逻辑链，为后续参数辨识与补偿打下基础。

一、核心原理：从关节空间到笛卡尔空间的映射

串联机器人的运动学描述的是关节变量 q = [q1, q2, ..., qn] 与末端执行器位姿 T 之间的函数关系。正运动学是 T = f(q, θ)，其中 θ 是连杆几何参数；逆运动学是 q = f⁻¹(T, θ)。注意这里多了一个 θ：运动学模型中的几何参数并不是真值，而是名义值。当实际加工出的连杆长度、关节轴线偏移与名义值不一致时，用名义参数算出的位姿就会偏离真实位姿，这个偏差就是几何误差。

因此几何误差建模可以理解为：在名义运动学模型上叠加参数扰动，研究扰动如何传播到末端位姿。这正是标定能够成立的理论前提——只要误差可参数化，就能通过测量反解出参数偏差。

二、DH参数与旋量理论：两种等价的建模语言

标准DH（Denavit-Hartenberg）参数用四个量描述相邻连杆关系：连杆长度 a、连杆扭角 α、关节偏置 d、关节转角 θ。相邻坐标系变换写成四个基本变换的乘积：

T(i-1,i) = Rot(z, θi) · Trans(z, di) · Trans(x, ai) · Rot(x, αi)

展开为齐次矩阵：
[ cθ  -sθcα   sθsα   a·cθ ]
[ sθ   cθcα  -cθsα   a·sθ ]
[ 0    sα     cα     d    ]
[ 0    0      0      1    ]

DH参数的优点是形式紧凑、参数少，缺点是当相邻关节轴线平行或接近平行时会出现参数奇异，且难以直接对应物理轴线位置。旋量理论（Screw Theory）用关节旋量 ξ 和指数积公式描述运动：

T(θ) = exp([S1]θ1) · exp([S2]θ2) · ... · exp([Sn]θn) · M

其中 Si 为第 i 个关节的旋量，M 为零位位姿，
[Si] 为旋量的 4×4 矩阵表示。

旋量理论的物理意义更直观：每个关节对应空间中一条确定的螺旋轴，关节运动就是绕该轴的旋转或沿该轴的平移。它的参数直接对应轴线位置和方向，因此几何误差可以自然地表达为旋量坐标的微小扰动，避免了DH参数在平行轴处的奇异问题。两种建模语言在数学上等价，工程中常根据标定需求选择：DH适合结构规整的工业臂，旋量适合复杂构型或需要连续可微误差模型的场合。

三、正逆运动学在标定流程中的分工

正运动学用于预测：给定一组关节角和当前参数估计，算出末端应该在哪里，与测量值比较得到残差。逆运动学用于执行：当辨识出参数误差后，需要把补偿量换算回关节指令，让机器人实际到达期望位姿。两者在标定中的角色可以概括为下表。

四、案例场景：六轴臂末端定位误差的溯源

某六轴工业机器人重复定位精度良好，但绝对定位误差达到 1.2 mm。用激光跟踪仪在 30 个位姿点测量末端实际位置，与名义正运动学计算结果比较，得到位置残差。将残差对 DH 参数求偏导构造雅可比矩阵，用最小二乘辨识出 24 个几何参数偏差，其中 a2 偏差 0.35 mm、d4 偏差 0.28 mm、α3 偏差 0.05°。把辨识结果回代正运动学，残差从 1.2 mm 降到 0.15 mm，验证了误差建模的正确性。最后通过逆运动学把参数修正量转化为关节角补偿，实际定位误差降至 0.2 mm 以内。

五、常见误区与复盘

• 误区一：把重复定位精度当成绝对定位精度。重复定位精度只反映同一指令下的一致性，几何误差是系统性偏差，两者来源不同，补偿方法也不同。
• 误区二：只标定DH参数，忽略关节柔性和齿轮间隙。纯几何模型无法解释负载下的弹性变形，高精度场合需要引入非几何误差项。
• 误区三：用少量测量点辨识大量参数。参数可辨识性要求测量位姿数量足够且激励充分，否则会出现参数耦合、辨识结果不可信。
• 误区四：补偿后不做验证。补偿效果必须在独立验证点上评估，避免过拟合到标定点。

总结来看，DH参数和旋量理论提供了描述机器人运动的两种语言，正运动学负责预测、逆运动学负责执行，而几何误差建模则是在这两者之间架起桥梁：把参数偏差通过雅可比映射为位姿误差，再通过测量反解参数，最终用逆运动学把修正量送回控制系统。理解这条链路，是后续参数辨识、补偿算法和精度评估的基础。