Warp物理引擎中关节链碰撞检测的注意事项

概述

在使用NVIDIA Warp物理引擎进行刚体动力学仿真时，开发者可能会遇到关节链中非根刚体与地面碰撞失效的问题。本文将深入分析这一现象的原因，并提供完整的解决方案，帮助开发者正确设置关节链的碰撞检测。

问题现象

当创建一个由多个刚体通过关节连接的复合结构时（例如一个由球体和两个胶囊体组成的"行走者"模型），可能会出现以下异常情况：

1. 根刚体（球体）能够正常与地面发生碰撞
2. 通过关节连接的非根刚体（胶囊体"腿"）会穿透地面而不产生碰撞
3. 这些非根刚体却能够与其他障碍物正常碰撞
4. 单独创建的同类型刚体能够正常与地面碰撞

原因分析

使用SemiImplicitIntegrator的情况

当使用SemiImplicitIntegrator（基于最大坐标的积分器）时，问题通常源于不正确的eval_fk函数调用。开发者可能在仿真循环中错误地调用了eval_fk，这会干扰积分器对状态数据（body_q和body_qd）的自动更新。

解决方案：

• 仅在模型构建完成后（builder.finalize()之后）调用一次eval_fk
• 从仿真循环中移除eval_fk调用

使用FeatherstoneIntegrator的情况

当切换到FeatherstoneIntegrator（基于广义坐标的积分器）时，可能出现类似问题，但原因不同：

1. 关节添加顺序错误：自由关节应该在添加其他关节之前添加
2. FeatherstoneIntegrator要求模型中的关节按拓扑顺序排列
3. 需要确保根刚体有自由关节

解决方案：

• 在添加其他关节前先添加自由关节
• 确保关节按正确的拓扑顺序排列
• 使用eval_ik而非eval_fk初始化状态

最佳实践

1. 模型构建顺序：

   • 先添加自由关节
   • 再添加其他约束关节
   • 最后添加碰撞形状

2. 积分器选择：

   • 简单场景使用SemiImplicitIntegrator
   • 复杂关节链使用FeatherstoneIntegrator

3. 初始化：

   # 对于SemiImplicitIntegrator
   wp.sim.eval_fk(model, model.joint_q, model.joint_qd, None, state)
   
   # 对于FeatherstoneIntegrator
   wp.sim.eval_ik(model, state, state.joint_q, state.joint_qd)
   

4. 碰撞设置：

   • 明确设置has_ground_collision=True
   • 检查model.ground = True

总结

Warp物理引擎中关节链的碰撞行为受到多种因素影响，包括积分器类型、关节添加顺序和初始化方式。通过理解这些底层机制并遵循最佳实践，开发者可以确保复合刚体结构的碰撞行为符合预期。特别要注意不同积分器对状态更新的不同要求，以及关节拓扑顺序对FeatherstoneIntegrator的影响。