3. 人形机器人运动学基础：刚体变换、正运动学、逆运动学、雅可比矩阵
人形机器人的运动控制，无论是双足行走的步态规划、上身的平衡补偿，还是机械臂的抓取操作，其底层数学基础都建立在运动学（Kinematics）之上。运动学描述的是机器人关节空间与笛卡尔操作空间之间的映射关系，不涉及产生运动的力和力矩。对于拥有数十个自由度（DoF）的人形机器人而言，理解刚体变换、正运动学、逆运动学与雅可比矩阵，是进行动力学分析、轨迹规划与力控制的前提。本章将系统梳理这四大核心模块的数学原理、工程实现方法及在仿人机器人中的特殊考量。
3.1 刚体变换：描述位姿的数学语言
3.1.1 核心原理：从旋转矩阵到齐次变换
人形机器人由多个刚性连杆通过关节连接而成。要描述任意连杆在三维空间中的位置和姿态，需要建立固连于该连杆的坐标系，并描述该坐标系相对于参考坐标系（如世界坐标系或骨盆坐标系）的变换关系。刚体变换包含两个部分：旋转矩阵 R ∈ SO(3) 描述姿态，平移向量 t ∈ R³ 描述位置。将两者组合为 4×4 齐次变换矩阵 T，可统一表达旋转和平移：
T = [ R t ]
[ 0 1 ]其中 R 为正交矩阵（RᵀR = I，det(R) = 1），其列向量表示动坐标系各轴在参考系中的方向余弦。齐次变换的核心优势在于：连续变换可通过矩阵乘法复合，即 T₁₂ · T₂₃ = T₁₃，这为后续正运动学的链式计算奠定了基础。
3.1.2 工程实现：旋转的三种基本表示
在实际工程中，除了旋转矩阵，还常用欧拉角（如 ZYX 顺序）和四元数表示姿态。欧拉角直观但存在万向锁问题；四元数无奇异且插值平滑，适合姿态插补。下表对比了三种表示方法：
| 表示方法 | 参数数量 | 优点 | 缺点 | 人形机器人应用场景 |
|---|---|---|---|---|
| 旋转矩阵 | 9 | 无奇异，复合方便 | 冗余，需正交化 | 运动学链式计算 |
| 欧拉角 (ZYX) | 3 | 直观，易理解 | 万向锁，插值不平滑 | 用户交互、姿态显示 |
| 四元数 | 4 | 无奇异，插值平滑 | 不直观，需归一化 | 姿态控制、IMU融合 |
3.2 正运动学：从关节角到位姿的确定性映射
3.2.1 核心原理：DH参数与链式法则
正运动学解决“已知各关节角度，求末端（如手掌或脚踝）在基坐标系下的位姿”的问题。对于人形机器人，通常以骨盆（或腰部）为基坐标系，分别向头部、双臂、双腿建立运动学链。最经典的方法是 Denavit-Hartenberg (DH) 参数法，通过四个参数（aᵢ₋₁, αᵢ₋₁, dᵢ, θᵢ）描述相邻连杆间的变换。每个关节的变换矩阵为：
Tᵢ = Rot(z, θᵢ) · Trans(z, dᵢ) · Trans(x, aᵢ₋₁) · Rot(x, αᵢ₋₁)末端位姿为所有关节变换矩阵的连乘：T₀ₙ = T₁ · T₂ · ... · Tₙ。对于人形机器人，由于存在闭链（如双腿同时着地），正运动学计算需特别注意分支链的协调。
3.2.2 操作流程：建立人形机器人运动学树
- 定义基坐标系：通常选在骨盆中心，X轴向前，Z轴向上。
- 建立连杆坐标系：按 DH 规则为每个关节建立坐标系，注意人形机器人关节多为旋转关节（θ为变量）。
- 确定 DH 参数表：根据机器人 CAD 模型测量连杆长度、偏置等参数。
- 编写链式乘法函数：从基坐标系开始，逐关节左乘变换矩阵。
- 验证：将机器人置于零位姿态，检查末端坐标是否与 CAD 模型一致。
3.3 逆运动学：从期望位姿到关节角的求解
3.3.1 核心原理：多解性与求解策略
逆运动学（IK）是正运动学的逆问题：已知末端期望位姿，求解满足条件的关节角。这是人形机器人步态规划和操作规划的核心。与工业机械臂不同，人形机器人IK面临三大挑战：多解性（同一末端位姿对应多组关节角）、冗余性（自由度多于任务所需）、关节限位（人体关节活动范围有限）。求解方法分为两类：
- 解析法：通过代数或几何方法直接求解，速度快、精度高，但仅适用于特定构型（如6自由度非冗余臂）。对于人形机器人腿部，常将髋、膝、踝简化为球关节+旋转关节的组合，利用几何关系求解。
- 数值法：基于雅可比矩阵的迭代方法（如牛顿-拉夫森法、阻尼最小二乘法）。通用性强，可处理冗余和关节限位，但计算量大，可能陷入局部极小值。
3.3.2 判断方法：如何选择合适的IK算法
| 场景 | 自由度 | 实时性要求 | 推荐方法 | 原因 |
|---|---|---|---|---|
| 双足步态规划（离线） | 每条腿6 DoF | 中 | 解析法（几何法） | 可保证解的存在性和连续性 |
| 全身运动（在线） | 全身30+ DoF | 高（1kHz） | 数值法（阻尼最小二乘） | 可处理冗余，加入任务优先级 |
| 双臂操作 | 每条臂7 DoF | 高 | 数值法（梯度投影法） | 利用冗余进行避障和姿态优化 |
3.4 雅可比矩阵：速度与力的桥梁
3.4.1 核心原理：从关节空间到操作空间的线性映射
雅可比矩阵 J(q) 是末端速度与关节速度之间的线性变换：ẋ = J(q)·q̇，其中 ẋ ∈ R⁶ 为末端线速度和角速度，q̇ ∈ Rⁿ 为关节角速度。J 的每一列对应一个关节单位速度对末端速度的贡献。雅可比矩阵不仅是速度分析的工具，还通过 静力对偶原理 建立了关节力矩与末端力之间的关系：τ = Jᵀ·F。这一关系在力控制（如柔顺控制、阻抗控制）中至关重要。
3.4.2 操作流程：雅可比矩阵的构建与奇异性分析
- 构建：对于旋转关节，雅可比矩阵的第 i 列由两部分组成：角速度部分为关节轴方向向量 zᵢ₋₁；线速度部分为 zᵢ₋₁ × (pₑ - pᵢ₋₁)，其中 pₑ 为末端位置，pᵢ₋₁ 为关节 i 的位置。
- 奇异性判断：计算 det(J·Jᵀ) 或检查 J 的奇异值。当行列式接近零时，机器人处于奇异位形，此时某些方向的速度无法实现。
- 人形机器人特殊考量：双腿支撑时，两条腿的雅可比矩阵需联合分析，避免产生内部力冲突。
3.5 常见误区与总结复盘
| 误区 | 后果 | 正确做法 |
|---|---|---|
| 忽略 DH 参数中的坐标系方向约定 | 正运动学计算结果错误，机器人姿态异常 | 严格遵循 DH 规则，并在仿真中逐关节验证 |
| 逆运动学只求一组解，不考虑多解性 | 关节角跳变，运动不连续 | 根据上一时刻关节角选择最近解，或加入连续性约束 |
| 雅可比矩阵奇异时强行求逆 | 关节速度指令无穷大，损坏执行器 | 使用奇异鲁棒性逆解（如 Jᵀ(JJᵀ+λ²I)⁻¹） |
| 将工业机械臂IK直接套用于人形机器人 | 未考虑腿部闭链和平衡约束 | 结合质心位置和零力矩点（ZMP）约束进行全身IK |
总结复盘：运动学是人形机器人控制的基石。刚体变换提供了描述位姿的统一框架；正运动学建立了关节空间到操作空间的确定性映射，是仿真和验证的基础；逆运动学解决了从任务空间到关节空间的求解问题，但必须处理多解、奇异和冗余；雅可比矩阵则架起了速度、力与关节运动之间的桥梁，是进行动力学分析和力控制的关键。在实际工程中，四大模块并非孤立存在，而是相互耦合：步态规划器输出质心和足端轨迹，逆运动学求解关节角，正运动学验证轨迹正确性，雅可比矩阵则用于评估运动学性能和设计奇异规避策略。掌握这些基础，才能进一步深入动力学建模与全身运动控制。