Use new Pro RRT SetupMTCPlanTo_ behaviors

Replace:
* `SetupMTCMoveToPose` -> `SetupMTCPlanToPose`
* `SetupMTCMoveToJointState` -> `SetupMTCPlanToJointState`

Remove deprecated `planner_interface` port.

The new behaviors expose more planning parameters for the Pro RRT
Connect planner.

Author: dyackzan

src/fanuc_sim/objectives/move_to_pose.xml

@@ -14,12 +14,11 @@
       />
       <Action ID="SetupMTCCurrentState" task="{move_to_pose_task}" />
       <Action
-        ID="SetupMTCMoveToPose"
+        ID="SetupMTCPlanToPose"
         ik_frame="tool0"
         planning_group_name="manipulator"
         target_pose="{target_pose}"
         task="{move_to_pose_task}"
-        planner_interface="moveit_default"
       />
       <Action
         ID="PlanMTCTask"

src/lab_sim/objectives/add_waypoints_to_mtc_task.xml

@@ -6,7 +6,6 @@
     _subtreeOnly="true"
     _description=""
     joint_group_name="manipulator"
-    planner_interface="moveit_default"
     mtc_task="{mtc_task}"
   >
     <Control ID="Sequence">
@@ -17,11 +16,10 @@
         joint_group_name="{joint_group_name}"
       />
       <Action
-        ID="SetupMTCMoveToJointState"
+        ID="SetupMTCPlanToJointState"
         joint_state="{target_joint_state}"
-        name="SetupMTCMoveToJointState"
+        name="SetupMTCPlanToJointState"
         planning_group_name="{joint_group_name}"
-        planner_interface="{planner_interface}"
         task="{mtc_task}"
       />
       <Action
@@ -31,19 +29,17 @@
         joint_group_name="{joint_group_name}"
       />
       <Action
-        ID="SetupMTCMoveToJointState"
+        ID="SetupMTCPlanToJointState"
         joint_state="{target_joint_state}"
-        name="SetupMTCMoveToJointState"
+        name="SetupMTCPlanToJointState"
         planning_group_name="{joint_group_name}"
-        planner_interface="{planner_interface}"
         task="{mtc_task}"
       />
     </Control>
   </BehaviorTree>
   <TreeNodesModel>
     <SubTree ID="Add Waypoints to MTC Task">
       <input_port name="joint_group_name" default="manipulator" />
-      <input_port name="planner_interface" default="moveit_default" />
       <inout_port name="mtc_task" default="{mtc_task}" />
       <MetadataFields>
         <Metadata subcategory="Application - Basic Examples" />

src/lab_sim/objectives/joint_diagnostic.xml

@@ -12,7 +12,6 @@
         waypoint_name="Look at Table"
         joint_group_name="manipulator"
         controller_names="/joint_trajectory_controller /robotiq_gripper_controller"
-        planner_interface="moveit_default"
       />
       <Decorator ID="KeepRunningUntilFailure">
         <Control ID="Sequence">
@@ -22,14 +21,12 @@
             waypoint_name="Wrist 2 Max"
             joint_group_name="manipulator"
             controller_names="/joint_trajectory_controller /robotiq_gripper_controller"
-            planner_interface="moveit_default"
           />
           <SubTree
             ID="Move to Waypoint"
             waypoint_name="Wrist 2 Min"
             joint_group_name="manipulator"
             controller_names="/joint_trajectory_controller /robotiq_gripper_controller"
-            planner_interface="moveit_default"
           />
         </Control>
       </Decorator>

src/lab_sim/objectives/load_and_execute_joint_trajectory.xml

@@ -13,7 +13,6 @@
         _collapsed="true"
         waypoint_name="Workspace Right"
         joint_group_name="manipulator"
-        planner_interface="moveit_default"
         controller_names="/joint_trajectory_controller"
       />
       <Action

src/lab_sim/objectives/plan_and_save_trajectory.xml

@@ -14,7 +14,6 @@
         _collapsed="true"
         waypoint_name="Workspace Right"
         joint_group_name="manipulator"
-        planner_interface="moveit_default"
         controller_names="/joint_trajectory_controller"
         acceleration_scale_factor="1.0"
         controller_action_server="/joint_trajectory_controller/follow_joint_trajectory"
@@ -46,7 +45,6 @@
         mtc_task="{mtc_task}"
         waypoint_names="Pick Cube;Place Cube"
         joint_group_name="manipulator"
-        planner_interface="moveit_default"
       />
       <!-- Perform the computationally intensive calculation now -->
       <Action ID="PlanMTCTask" solution="{mtc_solution}" task="{mtc_task}" />

src/lab_sim/objectives/plan_move_to_pose.xml

@@ -15,12 +15,11 @@
       />
       <Action ID="SetupMTCCurrentState" task="{move_to_pose_task}" />
       <Action
-        ID="SetupMTCMoveToPose"
+        ID="SetupMTCPlanToPose"
         ik_frame="grasp_link"
         planning_group_name="manipulator"
         target_pose="{target_pose}"
         task="{move_to_pose_task}"
-        planner_interface="moveit_default"
       />
       <Action
         ID="PlanMTCTask"

src/lab_sim/objectives/plan_to_pose.xml

@@ -31,12 +31,11 @@
           />
           <Action ID="Script" code="pose_ctr += 1" />
           <Action
-            ID="SetupMTCMoveToPose"
+            ID="SetupMTCPlanToPose"
             ik_frame="{ik_frame}"
             planning_group_name="{planning_group_name}"
             target_pose="{target_pose}"
             task="{mtc_task}"
-            planner_interface="moveit_default"
           />
         </Control>
       </Decorator>

src/moveit_pro_kinova_configs/kinova_gen3_base_config/description/robotiq_2f_85_macro.xacro

@@ -7,8 +7,6 @@
     fake_sensor_commands:=false
     sim_ignition:=false
     sim_isaac:=false
-    isaac_joint_commands:=/isaac_joint_commands
-    isaac_joint_states:=/isaac_joint_states
     use_internal_bus_gripper_comm:=false
     com_port:=/dev/ttyUSB0
     moveit_active:=false">

src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/move_to_pose.xml

@@ -19,7 +19,7 @@
         />
         <Action ID="SetupMTCCurrentState" task="{move_to_pose_task}" />
         <Action
-          ID="SetupMTCMoveToPose"
+          ID="SetupMTCPlanToPose"
           ik_frame="grasp_link"
           planning_group_name="manipulator"
           target_pose="{target_pose}"

src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/compliant_grasp_rafti.xml

@@ -188,7 +188,7 @@
         task="{mtc_task}"
       />
       <Action ID="SetupMTCCurrentState" task="{mtc_task}" />
-      <Action ID="SetupMTCMoveToPose" target_pose="{hole_object}" />
+      <Action ID="SetupMTCPlanToPose" target_pose="{hole_object}" />
       <Action ID="PlanMTCTask" task="{mtc_task}" solution="{mtc_solution}" />
       <Action ID="ExecuteMTCTask" solution="{mtc_solution}" />
       <Action