pyDrake向同一场景图添加两个plant时出现Python bindings错误如何解决？

问题原因 #

该报错属于pydrake绑定层的已知限制：AddMultibodyPlantSceneGraph的C++原生接口确实支持传入已有的SceneGraph实例来新增Plant，但Python层的返回值所有权处理逻辑不完善，第二次调用传入已创建的SceneGraph时会触发所有权冲突，因此无法直接通过连续调用两次AddMultibodyPlantSceneGraph实现需求。

解决方案 #

避开使用AddMultibodyPlantSceneGraph自动添加的接口，手动实例化两个MultibodyPlant，分别注册到同一个SceneGraph并连接对应端口即可实现目标：既保留两个Plant独立的动力学计算逻辑，又共享同一场景图实现碰撞、可视化等交互功能。

验证后的实现代码 #

from pydrake.multibody.plant import MultibodyPlant
from pydrake.geometry import SceneGraph
from pydrake.systems.framework import DiagramBuilder

builder = DiagramBuilder()
# 手动创建并添加SceneGraph到Builder
scene_graph = builder.AddSystem(SceneGraph())
scene_graph.set_name("shared_scene_graph")

# 初始化第一个MultibodyPlant
plant1 = MultibodyPlant(time_step=0.0)
plant1.set_name("plant_1")
# 注册Plant到共享SceneGraph
plant1.RegisterAsSourceForSceneGraph(scene_graph)
# 连接Plant与SceneGraph的对应端口
builder.Connect(
    plant1.get_geometry_poses_output_port(),
    scene_graph.get_source_pose_port(plant1.get_source_id())
)
builder.Connect(
    scene_graph.get_query_output_port(),
    plant1.get_geometry_query_input_port()
)
builder.AddSystem(plant1)

# 初始化第二个MultibodyPlant，流程完全一致
plant2 = MultibodyPlant(time_step=0.0)
plant2.set_name("plant_2")
plant2.RegisterAsSourceForSceneGraph(scene_graph)
builder.Connect(
    plant2.get_geometry_poses_output_port(),
    scene_graph.get_source_pose_port(plant2.get_source_id())
)
builder.Connect(
    scene_graph.get_query_output_port(),
    plant2.get_geometry_query_input_port()
)
builder.AddSystem(plant2)

# 完成两个Plant的模型添加后分别执行Finalize
# 此处可插入你各自的模型加载、关节添加等逻辑
plant1.Finalize()
plant2.Finalize()

后续排查建议 #

• 确认两个Plant的source_id返回值不同，避免注册冲突
• 若需要实现两个Plant之间的接触力交互，可额外将SceneGraph的接触结果输出端口连接到各自的外力输入端口
• 可视化时直接将SceneGraph的输出端口连接到Meshcat或Drake Visualizer即可，两个Plant的几何体都会被正常渲染

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