3. 机械臂运动学基础

在 VR 机械臂遥操作中，操作者手部的位姿必须被准确转换为机械臂末端执行器的目标位姿，而机械臂各关节又必须通过运动学关系才能到达该位姿。因此，运动学是连接“人手动作”与“机械臂动作”的数学桥梁。本节围绕刚体变换、旋转矩阵、欧拉角、四元数以及正/逆运动学展开，建立后续空间映射与遥操作控制所需的数学基础。

一、刚体变换：描述位姿的统一语言

机械臂的每一个连杆、关节和末端工具都可以视为刚体。刚体在三维空间中的状态由位置和姿态共同决定，合称位姿。位置用三维平移向量 t = [x, y, z]ᵀ 表示，姿态用 3×3 旋转矩阵 R 表示。将二者组合成 4×4 齐次变换矩阵：

T = [ R  t ]
    [ 0  1 ]

其中 R 为 3×3 旋转矩阵，t 为 3×1 平移向量，
最后一行固定为 [0 0 0 1]。

齐次变换的优点是可以用矩阵乘法连续叠加：若已知基座到关节 1 的变换 T₁、关节 1 到关节 2 的变换 T₂，则基座到关节 2 的变换为 T₁·T₂。这种链式相乘正是正运动学的核心计算方式。

二、旋转矩阵、欧拉角与四元数

旋转矩阵是最直观的姿态表示：三列分别表示刚体自身坐标轴在参考坐标系中的方向。它满足正交性 RᵀR = I 且 det(R)=1。旋转矩阵便于坐标变换，但存在冗余（9 个参数表示 3 个自由度），且连续相乘会积累数值误差。

欧拉角用三个角度描述姿态，例如绕 Z-Y-X 依次旋转的偏航、俯仰、滚转。它参数少、易理解，适合人机界面显示，但存在万向节死锁：当中间轴旋转到 ±90° 时，两个自由度重合，姿态表示不唯一，插值会出现跳变。

四元数用四个参数 q = [w, x, y, z] 表示旋转，其中 w 为实部，(x,y,z) 为虚部。单位四元数满足 w²+x²+y²+z²=1。四元数没有死锁问题，插值平滑，计算效率高，是 VR 头显、手柄姿态和机械臂姿态传输中的常用表示。其与旋转矩阵可相互转换，但需注意归一化。

三、正运动学：从关节角到末端位姿

正运动学解决的是“已知各关节角度，求末端执行器位姿”的问题。对于串联机械臂，通常采用 DH 参数法建立相邻连杆坐标系，再逐级相乘：

T_0_n = T_0_1 · T_1_2 · ... · T_(n-1)_n

其中每个 T_(i-1)_i 由连杆长度 a、扭角 α、
关节偏置 d、关节角 θ 四个 DH 参数构成。

正运动学计算直接、唯一，不存在多解问题，是机械臂仿真、碰撞检测和末端轨迹显示的基础。在 VR 遥操作中，系统可实时用正运动学计算当前机械臂末端的实际位姿，并与操作者手部目标位姿进行比较，形成视觉反馈。

四、逆运动学：从目标位姿反求关节角

逆运动学解决的是“已知末端目标位姿，求各关节角度”的问题。它是遥操作映射的关键：操作者手部在 VR 空间中移动，系统将手部位姿作为目标，通过逆运动学解算出机械臂各关节应转动的角度。

逆运动学通常比正运动学复杂，原因包括：

• 多解性：同一末端位姿可能对应多组关节角，例如“肘部朝上”或“肘部朝下”。
• 无解性：目标位姿超出机械臂工作空间时无解。
• 奇异位形：某些姿态下雅可比矩阵降秩，关节速度趋于无穷。

常见求解方法有解析法、几何法和数值迭代法。解析法速度快、精度高，但依赖具体构型；数值法通用性强，但需迭代且可能陷入局部解。实际遥操作中常结合工作空间限制、关节限位和避障约束，从多解中选取最平滑、最安全的一组。

五、案例：VR 手柄到机械臂末端的映射流程

假设操作者移动 VR 手柄，系统需要让机械臂末端跟随。典型流程如下：

1. 读取手柄位姿，得到四元数 q_hand 和平移 t_hand。
2. 将手柄位姿映射到机械臂基座坐标系，得到目标位姿 T_target。
3. 调用逆运动学求解器，计算关节角 θ₁…θₙ。
4. 检查关节限位、奇异位形和碰撞，必要时修正或拒绝。
5. 将关节角发送给机械臂控制器，同时用正运动学计算实际末端位姿并显示。

该流程中，四元数用于姿态传输，齐次变换用于坐标统一，正运动学用于反馈验证，逆运动学用于目标求解，四者缺一不可。

六、常见误区与复盘

概念	输入	输出	特点	遥操作中的作用
刚体变换	旋转+平移	4×4 齐次矩阵	统一描述位姿	坐标系统一与链式叠加
旋转矩阵	姿态	3×3 矩阵	正交、冗余	坐标变换与姿态计算
欧拉角	三个角度	姿态	直观、有死锁	界面显示与人工设定
四元数	四个参数	姿态	无死锁、平滑	VR 姿态传输与插值
正运动学	关节角	末端位姿	唯一、直接	反馈验证与仿真显示
逆运动学	末端位姿	关节角	多解、可能无解	目标映射与关节求解