3. 刚体运动学与误差建模基础

运动平台的几何精度问题，最终都要落到“位姿”这两个字上。位姿包含位置与姿态两部分，位置是三个平移量，姿态是三个转动量。要把这六个量在统一框架下描述清楚，并进一步分析误差如何从各个支链、铰链、驱动轴传递到末端平台，就必须先建立刚体运动学与误差建模的基础语言。本节围绕齐次变换、旋转矩阵、刚体位移、误差旋量、小角度近似以及平台位姿误差表达展开，目标是让读者能够把“平台偏了多少”翻译成可计算的数学对象。

一、坐标系约定与齐次变换

讨论位姿之前必须先固定参照约定。工程中通常定义基坐标系 {B} 固定在平台底座或地基上，动坐标系 {P} 固定在运动平台上并随平台运动，工具坐标系 {T} 固定在末端执行器上。本文所有姿态角均采用“先绕 Z 轴偏航、再绕 Y 轴俯仰、最后绕 X 轴滚转”的 Z-Y-X 欧拉角约定，旋转矩阵按右乘顺序组合。参照系一旦切换，必须在公式和图示中明确标注，否则正负号极易混乱。

齐次变换矩阵是描述刚体位姿的核心工具。一个 4×4 的齐次变换矩阵把旋转和平移统一在一起：

T = [ R  p ]
    [ 0  1 ]

其中 R 为 3×3 旋转矩阵，p = [px, py, pz]^T 为位置向量。
点 p_B 在 {B} 中的坐标与 {P} 中的坐标关系为：
p_B = R_BP · p_P + p_BP
写成齐次形式：
[ p_B ]   [ R_BP  p_BP ] [ p_P ]
[  1  ] = [  0      1   ] [  1  ]

齐次变换的实用价值在于可级联。若从基座到平台经过 n 个连杆，则末端位姿为各段变换矩阵连乘：T_BT = T_B1 · T_12 · … · T_(n-1)n。这种连乘结构正是误差建模的入口——每一段的微小偏差都会通过连乘放大或耦合到末端。

二、旋转矩阵与刚体位移

旋转矩阵 R 是正交矩阵，满足 R^T R = I 且 det(R) = 1。它只有三个独立参数，但用九个元素表达，因此存在冗余约束。绕 X、Y、Z 轴的基本旋转矩阵分别为：

Rx(α) = [1  0     0   ; 0  cosα  -sinα ; 0  sinα  cosα]
Ry(β) = [cosβ  0  sinβ ; 0  1  0 ; -sinβ  0  cosβ]
Rz(γ) = [cosγ  -sinγ  0 ; sinγ  cosγ  0 ; 0  0  1]

Z-Y-X 欧拉角组合：R = Rz(γ)·Ry(β)·Rx(α)

刚体位移则是旋转与平移的组合。需要注意，旋转和平移不可交换：先转后移与先移后转结果不同。在误差建模中，这一非交换性正是姿态误差与位置误差相互耦合的根源。例如平台绕 Y 轴产生微小俯仰后，原本沿 X 方向的平移误差会在 Z 方向投影出分量，这就是姿态误差“污染”位置精度的典型表现。

三、误差旋量与小角度近似

当平台处于名义位姿附近时，实际位姿与名义位姿之差通常很小。此时用完整旋转矩阵做差并不方便，工程上更常用误差旋量（也称位姿误差向量）来描述：

Δξ = [ δp ; δθ ] = [ δx, δy, δz, δθx, δθy, δθz ]^T

其中 δp 为位置误差向量，δθ 为姿态误差向量（小角度下近似为旋转向量）。

小角度近似是误差旋量能够线性化的关键。当转角 θ 远小于 1 rad（例如小于 0.01 rad，约 0.57°）时，有 sinθ ≈ θ、cosθ ≈ 1，于是旋转矩阵可近似为：

R ≈ I + [δθ]×
其中 [δθ]× 为反对称矩阵：
[δθ]× = [ 0    -δθz   δθy ]
        [ δθz   0    -δθx ]
        [-δθy  δθx    0   ]

这一近似把非线性旋转关系转化为线性叠加关系，使误差可以按“各误差源独立贡献再求和”的方式处理。需要强调的是，小角度近似有适用边界：当单轴转角超过约 1° 时，二阶项不可忽略，线性叠加会产生明显偏差，此时应回到完整旋转矩阵或采用一阶加二阶修正。

四、平台位姿误差表达与灵敏度

把误差旋量落到运动平台上，需要明确它是在哪个坐标系下表达的。工程上有两种常用方式：一种是在基坐标系 {B} 下表达，适合与激光跟踪仪、经纬仪等全局测量设备对接；另一种是在动坐标系 {P} 下表达，适合分析平台自身结构变形。两者之间通过旋转矩阵转换：δξ_B = Ad(T) · δξ_P，其中 Ad(T) 为伴随变换矩阵。若不做说明就混用，误差方向会整体旋转，导致标定结果错误。

误差旋量的另一大用途是灵敏度分析。设平台位姿由 m 个几何参数 q = [q1, q2, …, qm]^T 决定，则位姿误差可写为：

Δξ = J(q) · Δq

其中 J(q) 为 6×m 的误差雅可比矩阵，其第 i 列为
∂ξ/∂qi = [∂px/∂qi, ∂py/∂qi, ∂pz/∂qi,
          ∂θx/∂qi, ∂θy/∂qi, ∂θz/∂qi]^T

雅可比矩阵的每一列代表某个几何参数单位偏差对末端六维位姿的影响。列向量的范数越大，说明该参数越“敏感”，标定和加工时应优先控制。例如某 6-SPS Stewart 平台在中心位姿附近，若某条支链的杆长误差列范数为 0.8，而铰链偏置列范数为 0.15，则杆长误差对末端位置的影响约为铰链偏置的五倍，校准资源应优先投向杆长标定。

五、一个可复算的示例

假设某三自由度平台名义位姿为 p_nom = [200, 0, 150] mm，R_nom = I。由于装配偏差，实际位姿为 p_act = [200.3, −0.2, 149.7] mm，实际姿态为绕 Z 轴偏转 0.004 rad、绕 Y 轴偏转 −0.002 rad。按定义计算：

δp = p_act − p_nom = [0.3, −0.2, −0.3] mm
δθ ≈ [0, −0.002, 0.004] rad（小角度下直接取旋转向量）

误差旋量 Δξ = [0.3, −0.2, −0.3, 0, −0.002, 0.004]^T
位置误差幅值 |δp| = √(0.3² + 0.2² + 0.3²) ≈ 0.469 mm
姿态误差幅值 |δθ| = √(0.002² + 0.004²) ≈ 0.00447 rad ≈ 0.256°

该结果说明：位置误差约 0.47 mm，姿态误差约 0.26°，均在 1° 以内，小角度近似成立。若进一步用雅可比矩阵反推各支链杆长应补偿的量，即可进入标定补偿环节。需要提醒的是，上述数值为教学示例，实际平台应以测量数据为准。

六、建模时的常见陷阱

• 欧拉角顺序不一致：Z-Y-X 与 X-Y-Z 得到的旋转矩阵不同，混用会导致姿态误差方向错误。
• 旋转与平移顺序颠倒：齐次变换中 R 与 p 的排列顺序固定，先转后移与先移后转不可互换。
• 小角度近似超界：单轴转角超过约 1° 时仍用线性叠加，会低估耦合误差。
• 误差旋量参照系未标注：在 {B} 系和 {P} 系下表达的 δθ 方向不同，必须显式说明。
• 忽略非几何误差：热变形、弹性变形、控制跟随误差同样会进入位姿误差，建模时应作为独立误差源列出。

掌握以上内容后，读者应能完成从“平台实际偏了多少”到“误差旋量六维向量”的完整转换，并能用雅可比矩阵判断各误差源的敏感程度。这是后续几何误差辨识、标定补偿与精度验证的共同基础。