Multibody Plant点接触模型失效：球体穿透圆柱问题咨询

• 确认碰撞几何与属性加载有效性
  首先检查URDF头部是否声明了Drake命名空间：xmlns:drake="http://drake.mit.edu"，否则<drake:proximity_properties>会被解析器忽略。同时可通过代码验证碰撞几何是否正确加载：

  for body in plant.GetBodyIndices():
      print(plant.GetCollisionGeometriesForBody(plant.get_body(body)))
  

  确保球体和圆柱的碰撞几何均在输出列表中。

• 严格遵循接触模型设置时机
  plant.set_contact_model()必须在plant.Finalize()执行前调用，否则接触配置不会生效。正确流程示例：

  plant = MultibodyPlant(time_step=0.001)
  parser = Parser(plant)
  parser.AddModelFromFile("your_model.urdf")
  plant.set_contact_model(ContactModel.kPoint)  # 此步骤必须在Finalize之前
  plant.Finalize()
  

• 排查点接触模型的几何适配问题
  点接触模型依赖精准的接触点计算，若球体与圆柱的相对姿态/位置导致几何算法无法识别接触（如球体从圆柱端面边缘擦过、几何重叠量过小），会出现穿透假象。可尝试：

  • 调整初始位姿，让球体与圆柱有明显的几何重叠
  • 检查球体的URDF碰撞标签是否配置正确（需确保球体也有<collision>块及对应几何定义）

• 水弹性模型的额外配置检查
  切换到水弹性碰撞时，需确保：

  • 在URDF中为碰撞几何添加<drake:hydroelastic role="rigid"/>属性
  • 调用plant.set_solver(ContactSolver.kHydroelastic)指定水弹性求解器
  • 若使用软接触，需配置对应的刚度、阻尼属性

• 优化求解器约束容差
  直接配点法中，若求解器约束容差设置过大，会允许少量几何穿透。可尝试调小容差参数，或确认优化问题中已自动引入MultibodyPlant的接触约束。

内容的提问来源于stack exchange，提问作者Ben Kang