人形机器人全身运动控制：从步态到全身协调的工程实践

## 步态稳了，不等于机器人能干活

很多人形机器人团队的第一个里程碑是"稳定行走"。但双足步态只是下肢周期性运动，真正的工程难点在后面：边走边搬东西、上肢操作时下肢保持平衡、被推一把全身协调恢复——这就是**全身运动控制（Whole-Body Control, WBC）**的范畴。它和单纯步态控制的区别，相当于"会走路"和"会干活"的区别。

## 一、核心：质心与角动量的管理

**质心（CoM）位置与速度**：决定会不会摔倒。经典 ZMP 判据在平地步态够用，但上肢大幅动作（如双手举重物）时质心偏移超出步态规划器假设，ZMP 方法就开始吃力。

**全身角动量**：手臂摆动、上身扭转都会产生角动量，控制器必须靠下肢和躯干的协调动作把它"吃掉"，否则原地打转或失稳。优秀的全身控制器会把手臂自然摆动纳入规划，而不是把上肢当固定负载。

## 二、任务空间与关节空间的映射

工程实现通常是分层/优化结构：

1. **任务空间**：定义"我要什么"——质心轨迹、双手末端位姿、躯干姿态，各任务有优先级。
2. **优化求解**：用二次规划（QP）把多任务映射到关节力矩，同时满足接触约束（脚不打滑、力矩不超限）。高优先级任务（如平衡）严格满足，低优先级在零空间尽量满足。
3. **关节空间执行**：QP 输出的期望力矩/位置送关节伺服执行，1kHz 量级控制频率是常见要求。

关键区别：步态控制可离线规划周期轨迹再跟踪；全身控制必须在线求解，因为上肢任务和环境接触实时变化。

## 三、仿真到真机的调试经验

**仿真阶段**：先在物理仿真器里调通 QP 任务权重。经验是先只开平衡+质心任务，把"站得住、被推不倒"做扎实，再逐个加上肢任务，每加一个观察它对质心轨迹的扰动。

**真机迁移三个坑**：

1. **接触模型差异**：仿真脚底是理想接触，真机有地毯形变和打滑。初期摩擦系数估计保守一点，QP 约束收紧，宁可保守别摔机。
2. **延迟**：状态估计到力矩输出的全链路延迟，真机通常比仿真大，会吃掉高频控制器的相位裕度，表现为抖动。先测真实延迟再定控制频率和滤波。
3. **执行器饱和**：仿真力矩近似无限，真机关节有峰值力矩和发热限制。QP 必须加入真实力矩上下界，否则仿真漂亮的动作真机做不出。

## 结论

全身控制的本质，是把"不摔倒"和"干活"两个目标放进同一优化框架实时权衡。路径建议：仿真分任务逐步叠加，真机先保守约束再放开。摔机学费贵，保守迁移反而最快。

【管理员回复】补充几点 WBC 的工程要点：一是常用的做法是将全身控制表述为带优先级的二次规划（QP）问题，平衡、接触约束优先级最高，其次是末端操作任务，最后是姿态偏好；二是上肢搬运重物时，需要实时更新整体质心和动力学模型，否则下肢平衡会被打破；三是求解频率通常需要达到数百赫兹以上，对计算实时性要求较高。近年也有用强化学习训练全身策略的路线，与基于模型的 WBC 互补。大家团队的 WBC 是基于 QP 还是基于学习的方法？