ROS2环境Python程序通过Moveit2控制双机械臂规划

[yejunwu123]

环境：
ROS2 Humble + Moveit2 + Python3.10

尝试在Python程序中通过Moveit2控制2个机械臂的路径规划，但没有成功，代码如下：

...
self.cr3_arm_group: PlanningComponent = self.robot.get_planning_component("cr3_arm")
self.nova2_arm_group: PlanningComponent = self.robot.get_planning_component("nova2_arm")
self.dual_arm_group: PlanningComponent = self.robot.get_planning_component("dual_arm")
...

cr3_pose_goal = PoseStamped()
cr3_pose_goal.header.frame_id = "base_link"
cr3_pose_goal.pose.position.x = -0.299975
cr3_pose_goal.pose.position.y = -0.50000693
cr3_pose_goal.pose.position.z = 0.069975

cr3_pose_goal.pose.orientation.w = 0.0
cr3_pose_goal.pose.orientation.x = 0.0
cr3_pose_goal.pose.orientation.y = 1.0
cr3_pose_goal.pose.orientation.z = 0.0

nova2_pose_goal = PoseStamped()
nova2_pose_goal.header.frame_id = "nova2_base_link"
nova2_pose_goal.pose.position.x = 0.30004
nova2_pose_goal.pose.position.y = -0.49997307
nova2_pose_goal.pose.position.z = 0.070025

nova2_pose_goal.pose.orientation.w = 0.0
nova2_pose_goal.pose.orientation.x = 0.0
nova2_pose_goal.pose.orientation.y = 1.0
nova2_pose_goal.pose.orientation.z = 0.0

self.dual_arm_group.set_start_state_to_current_state()
self.dual_arm_group.set_goal_state(pose_stamped_msg=cr3_pose_goal, pose_link="Link6")
self.dual_arm_group.set_goal_state(pose_stamped_msg=nova2_pose_goal, pose_link="nova2_Link6")

plan_result = self.plan(self.dual_arm_group)

结果显示还是只规划了一个机械臂

发现Python版有很多api调用不了
求教在Python代码中通过什么方式可以控制双机械臂同时规划？