Asimov v0 碰撞与接触系统精讲：如何配置胶囊碰撞体与关节接触排除
Asimov v0 碰撞与接触系统精讲：如何配置胶囊碰撞体与关节接触排除
Asimov v0 是一款完全开源的人形机器人双下肢项目，其 MuJoCo 仿真模型的碰撞与接触系统采用了工程化极强的设计：用轻量胶囊（capsule）碰撞体替代高精度网格，并通过接触排除（contact exclude）消除相邻连杆的自碰撞干扰。本文带你快速读懂这套碰撞与接触配置的完整思路。
为什么碰撞配置对人形机器人仿真至关重要
人形机器人有密集的关节链，如果每个连杆都用高精度 STL 网格参与碰撞检测，会带来两个问题：
- 计算开销大：网格-网格碰撞检测远慢于胶囊体，难以支撑实时控制策略训练
- 自碰撞干扰：相邻连杆在关节处天然重叠，不手动排除的话机器人会"撞自己"，导致仿真抖动甚至发散
Asimov v0 的 sim-model/xmls/asimov.xml 正是针对这两点做的完整解答，整个模型 12 个自由度、每条腿 6 个关节的碰撞逻辑都集中在这一个文件里。
胶囊碰撞体方案：视觉与碰撞彻底分离
🔍 打开 XML 文件可以看到，模型对每个连杆都定义了两套几何体：
- 视觉几何体：
class="visual"，引用高精度的 STL 网格（如left_hip_pitch_link.STL），仅用于渲染 - 碰撞几何体：胶囊体，用两个端点坐标
fromto定义一条线段的"膨胀"，计算代价极低
关键技巧在于 asimov.xml 第 16-18 行 的 default 声明：视觉几何体被设置为 contype="0" conaffinity="0"，意思是视觉网格完全不参与碰撞检测；而 第 20-28 行 的 collision 默认类则统一赋予 type="capsule" contype="1" conaffinity="1"，让胶囊体真正参与碰撞。
两类胶囊：foot_capsule 与 body_capsule
项目把胶囊按用途分成两个 class，参数差异一目了然：
| 类别 | 半径 size | 用途 | 示例 |
|---|---|---|---|
body_capsule |
0.05 m | 髋、大腿等粗壮连杆 | left_knee_link_collision 用 fromto="0 0 0 0 0 -0.25" 描述 25 cm 长的腿段 |
foot_capsule |
0.01 m | 脚底与脚趾 | 每只脚由 5 根细胶囊拼出足底轮廓，见 left_foot1~6_collision |
💡 为什么脚底要用小胶囊？ 足底需要与地面精确接触以测量地面反力，粗胶囊会导致接触点漂移；而脚底面积有限，用多根细胶囊并联就能以极低成本逼近真实接触面。脚趾部分（left_toe1~5_collision，见 第 124-128 行）同样采用 5 根细胶囊排布，配合 脚趾关节 的刚性弹簧限制实现踮脚动作的仿真。
地面本身是一块平面 geom（floor），contype="1" conaffinity="1" 确保它能与所有胶囊发生碰撞。
关节接触排除：一行一行看懂 14 组 exclude
即使碰撞体设计得很聪明，相邻连杆在关节附近仍会几何重叠。Asimov v0 的解法在 第 195-210 行的 <contact> 段：
<exclude body1="pelvis_link" body2="left_hip_pitch_link" />
<exclude body1="left_hip_pitch_link" body2="left_hip_roll_link" />
...
<exclude body1="left_ankle_roll_link" body2="left_toe_link" />
每条腿沿运动链有 8 个 body（pelvis → 髋三关节 → 膝 → 踝两关节 → 脚趾），相邻 body 两两配对，左右腿各 7 组，共 14 组排除规则，覆盖了全腿所有相邻关节。
核心原理：exclude 只屏蔽"相邻关节对"的接触，而不是一刀切关闭自碰撞。这样机器人依然能感知：
- 双脚与地面的接触（支撑、站立）
- 跨腿时大腿与另一侧小腿的碰撞（避免双腿互相穿插）
- 摆臂式动作中非相邻连杆的意外接触
这是人形机器人仿真的标准做法：排除的越少越好，只排除物理上不可能真实接触的组合。
关键文件与参数速查
| 内容 | 路径 |
|---|---|
| 碰撞/接触主配置 | sim-model/xmls/asimov.xml |
| 视觉/碰撞 default 定义 | 第 16-28 行 |
| 腿段胶囊体 | body_capsule 示例 |
| 足底细胶囊 | foot_capsule 定义 |
| 接触排除列表 | 第 195-210 行 |
| 连杆网格资源 | sim-model/assets/meshes/ |
| 机械结构与关节规格 | mechanical/ 目录，关节扭矩表见 README.md |
新手避坑指南
- 调胶囊半径：想改变机器人"胖瘦"，只需修改
body_capsule的size（默认 0.05 m），视觉网格不变 - 漏写 exclude 的后果：仿真中关节处出现巨大反力、机器人原地抖动，先检查
<contact>是否漏配了该关节对 - 多写 exclude 的后果：双腿互穿、脚穿地，因为把不该排除的接触屏蔽了
- foot_capsule 的 size=0.01 决定了足底接触精度，不要随意放大，否则站立控制会不稳定
📌 总结：Asimov v0 的碰撞系统 = 胶囊体降维（快）+ 视觉碰撞分离（净）+ 最小化接触排除（准）。这套模式适用于几乎所有腿式机器人仿真，读懂这一个文件，你就掌握了 MuJoCo 人形机器人碰撞配置的核心范式。