Drake螺丝紧固建模中末端执行器与螺丝虚假接触问题求助

1. 碰撞与视觉网格的位姿错位 #

这是最可能的直接原因：你的末端执行器碰撞网格设置了绕X轴90度旋转，但视觉网格没有对应旋转，导致视觉显示的位置和实际碰撞检测的位置完全不对齐。

末端执行器碰撞网格的位姿配置：

<collision name="hex_bit_collision">
  <pose>0 0 0.0 1.57 0 0</pose> <!-- 绕X轴旋转90度 -->
  <geometry>
    <mesh>
      <scale>1 1 1</scale>
      <uri>file:///home/artyom/HexBitEE.obj</uri>
    </mesh>
  </geometry>
</collision>

而视觉网格没有添加该旋转，导致视觉上批头还没碰到螺丝，但碰撞网格已经和螺丝的碰撞体重叠，触发接触检测。

解决方法：

• 统一两者的位姿：给视觉网格加上相同的旋转，或者移除碰撞网格的额外旋转，确保碰撞体和视觉体在空间中完全重合。
• 开启碰撞体可视化：在Drake Visualizer中勾选「Show collision geometry」，直接查看碰撞体的位置，确认是否与视觉模型对齐。

2. Proximity参数设置冲突 #

你配置的两个核心参数存在矛盾，会导致接触提前触发：

• 场景图的margin = 1e-6：Hydroelastic碰撞体的安全边距，数值过小意味着碰撞体几乎贴合原始几何。
• 多体工厂的penetration_allowance = 1e-3：允许的最大穿透量，数值远大于margin，系统会在物体还未视觉接触时，就判定为发生了接触。

相关配置代码：

# 场景图配置
scene_graph_config.default_proximity_properties.margin = 1e-6
scene_graph_config.default_proximity_properties.resolution_hint = 1e-6

# 多体工厂配置
config.penetration_allowance = 1e-3

解决方法：

• 对齐参数数值：将margin调整为与penetration_allowance匹配的范围，比如都设为1e-3，或者margin略小于penetration_allowance（如margin=5e-4，penetration_allowance=1e-3）。
• 参考官方建议：Hydroelastic模型的margin一般建议设为1e-3 ~ 1e-2，过小会引发数值不稳定。

3. 碰撞网格的几何精度问题 #

如果螺丝或批头的碰撞网格与实际功能形状不符，也会导致误检测：

• 若螺丝头的内六角在碰撞网格中是实心结构（而非空心卡槽），批头还没进入卡槽就会触发碰撞。
• 模型存在非流形几何、重叠面等问题，会导致Drake生成的Hydroelastic碰撞体形状失真。

解决方法：

• 重新导出碰撞网格：确保螺丝头的内六角是空心结构，批头的碰撞网格是匹配内六角的凸起形状，与视觉网格一致。
• 修复模型：用Blender等工具清理OBJ模型，移除冗余面、修复非流形边，保证模型是闭合的流形结构。

4. Hydroelastic分辨率设置不合理 #

resolution_hint = 1e-6的数值过小，会导致：

• 碰撞体离散化的三角形数量过多，引发数值计算误差，误判接触。
• 仿真效率急剧下降，甚至出现不稳定。

解决方法：

• 调整分辨率至合理范围：对于螺丝、批头这类小型零件，建议设为1e-3 ~ 5e-3，平衡精度和效率。
• 逐步测试：尝试不同分辨率数值，观察接触检测的准确性变化。

额外验证步骤 #

• 简化场景测试：创建仅包含螺丝和批头的仿真场景，手动移动批头靠近螺丝，观察接触触发的时机是否与视觉一致，快速定位问题。
• 检查碰撞体缩放：确认螺丝和批头的碰撞网格缩放比例与视觉网格完全一致（你的螺丝碰撞和视觉都是0.5缩放，这部分没问题，但仍需确认批头的缩放是否正确）。

内容的提问来源于stack exchange，提问作者Art Boyarov