diff --git a/src/fanuc_sim/objectives/interpolate_to_joint_state.xml b/src/fanuc_sim/objectives/interpolate_to_joint_state.xml
index 892d8e83..e4f99ff4 100644
--- a/src/fanuc_sim/objectives/interpolate_to_joint_state.xml
+++ b/src/fanuc_sim/objectives/interpolate_to_joint_state.xml
@@ -34,6 +34,9 @@
+
+
+
diff --git a/src/fanuc_sim/objectives/move_to_joint_state.xml b/src/fanuc_sim/objectives/move_to_joint_state.xml
index 60b6c5d1..63ab4a8e 100644
--- a/src/fanuc_sim/objectives/move_to_joint_state.xml
+++ b/src/fanuc_sim/objectives/move_to_joint_state.xml
@@ -32,6 +32,9 @@
+
+
+
diff --git a/src/fanuc_sim/objectives/move_to_pose.xml b/src/fanuc_sim/objectives/move_to_pose.xml
index 1e58a85e..4009dca1 100644
--- a/src/fanuc_sim/objectives/move_to_pose.xml
+++ b/src/fanuc_sim/objectives/move_to_pose.xml
@@ -36,6 +36,9 @@
+
+
+
diff --git a/src/fanuc_sim/objectives/move_to_waypoint.xml b/src/fanuc_sim/objectives/move_to_waypoint.xml
index ca42e19e..ad9ec51d 100644
--- a/src/fanuc_sim/objectives/move_to_waypoint.xml
+++ b/src/fanuc_sim/objectives/move_to_waypoint.xml
@@ -47,6 +47,9 @@
name="controller_names"
default="/joint_trajectory_controller"
/>
+
+
+
diff --git a/src/lab_sim/objectives/add_waypoints_to_mtc_task.xml b/src/lab_sim/objectives/add_waypoints_to_mtc_task.xml
index a8b2f957..9359a4b0 100644
--- a/src/lab_sim/objectives/add_waypoints_to_mtc_task.xml
+++ b/src/lab_sim/objectives/add_waypoints_to_mtc_task.xml
@@ -41,6 +41,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/apriltag_pick_object.xml b/src/lab_sim/objectives/apriltag_pick_object.xml
index df3f814f..90dc1d9a 100644
--- a/src/lab_sim/objectives/apriltag_pick_object.xml
+++ b/src/lab_sim/objectives/apriltag_pick_object.xml
@@ -90,6 +90,10 @@
-
+
+
+
+
+
diff --git a/src/lab_sim/objectives/create_pose_vector.xml b/src/lab_sim/objectives/create_pose_vector.xml
index 0a5ccce0..fe951010 100644
--- a/src/lab_sim/objectives/create_pose_vector.xml
+++ b/src/lab_sim/objectives/create_pose_vector.xml
@@ -111,6 +111,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/force_relaxation.xml b/src/lab_sim/objectives/force_relaxation.xml
index a62429fe..f137daea 100644
--- a/src/lab_sim/objectives/force_relaxation.xml
+++ b/src/lab_sim/objectives/force_relaxation.xml
@@ -50,6 +50,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/get_april_tag_pose_from_image.xml b/src/lab_sim/objectives/get_april_tag_pose_from_image.xml
index 302e2f6f..6a223a9e 100644
--- a/src/lab_sim/objectives/get_april_tag_pose_from_image.xml
+++ b/src/lab_sim/objectives/get_april_tag_pose_from_image.xml
@@ -40,6 +40,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/load_mesh_as_green_poincloud.xml b/src/lab_sim/objectives/load_mesh_as_green_poincloud.xml
index 28acf149..cce854ba 100644
--- a/src/lab_sim/objectives/load_mesh_as_green_poincloud.xml
+++ b/src/lab_sim/objectives/load_mesh_as_green_poincloud.xml
@@ -31,6 +31,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/load_mesh_as_red_pointcloud.xml b/src/lab_sim/objectives/load_mesh_as_red_pointcloud.xml
index 4984c7c5..e7492b15 100644
--- a/src/lab_sim/objectives/load_mesh_as_red_pointcloud.xml
+++ b/src/lab_sim/objectives/load_mesh_as_red_pointcloud.xml
@@ -31,6 +31,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/pick_first_object_in_vector.xml b/src/lab_sim/objectives/pick_first_object_in_vector.xml
index 30bd2bf4..b153b8a1 100644
--- a/src/lab_sim/objectives/pick_first_object_in_vector.xml
+++ b/src/lab_sim/objectives/pick_first_object_in_vector.xml
@@ -43,6 +43,10 @@
-
+
+
+
+
+
diff --git a/src/lab_sim/objectives/place_object.xml b/src/lab_sim/objectives/place_object.xml
index 21a7eaa5..fec0fd73 100644
--- a/src/lab_sim/objectives/place_object.xml
+++ b/src/lab_sim/objectives/place_object.xml
@@ -30,6 +30,10 @@
-
+
+
+
+
+
diff --git a/src/lab_sim/objectives/plan_and_save_trajectory.xml b/src/lab_sim/objectives/plan_and_save_trajectory.xml
index fe26aee1..ae458e45 100644
--- a/src/lab_sim/objectives/plan_and_save_trajectory.xml
+++ b/src/lab_sim/objectives/plan_and_save_trajectory.xml
@@ -51,6 +51,10 @@
-
+
+
+
+
+
diff --git a/src/lab_sim/objectives/plan_move_to_pose.xml b/src/lab_sim/objectives/plan_move_to_pose.xml
index 9f1da373..c280015e 100644
--- a/src/lab_sim/objectives/plan_move_to_pose.xml
+++ b/src/lab_sim/objectives/plan_move_to_pose.xml
@@ -35,6 +35,9 @@
name="move_to_pose_solution"
default="{move_to_pose_solution}"
/>
+
+
+
diff --git a/src/lab_sim/objectives/plan_to_pose.xml b/src/lab_sim/objectives/plan_to_pose.xml
index 13d39ec9..3bb7c76b 100644
--- a/src/lab_sim/objectives/plan_to_pose.xml
+++ b/src/lab_sim/objectives/plan_to_pose.xml
@@ -49,6 +49,9 @@
+
+
+
diff --git a/src/lab_sim/objectives/save_and_execute_a_trajectory_from_disk.xml b/src/lab_sim/objectives/save_and_execute_a_trajectory_from_disk.xml
index ddeac5a6..33d02a77 100644
--- a/src/lab_sim/objectives/save_and_execute_a_trajectory_from_disk.xml
+++ b/src/lab_sim/objectives/save_and_execute_a_trajectory_from_disk.xml
@@ -15,6 +15,10 @@
-
+
+
+
+
+
diff --git a/src/lab_sim/objectives/take_snap.xml b/src/lab_sim/objectives/take_snap.xml
index ebadf701..0fdb917b 100644
--- a/src/lab_sim/objectives/take_snap.xml
+++ b/src/lab_sim/objectives/take_snap.xml
@@ -14,6 +14,10 @@
-
+
+
+
+
+
diff --git a/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/get_imarker_pose_from_mesh_visualization.xml b/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/get_imarker_pose_from_mesh_visualization.xml
index 9be4f855..70fa45ba 100644
--- a/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/get_imarker_pose_from_mesh_visualization.xml
+++ b/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/get_imarker_pose_from_mesh_visualization.xml
@@ -26,6 +26,9 @@
+
+
+
diff --git a/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/move_to_waypoint.xml b/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/move_to_waypoint.xml
index dd1dac8a..15132ea6 100644
--- a/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/move_to_waypoint.xml
+++ b/src/moveit_pro_kinova_configs/kinova_gen3_base_config/objectives/move_to_waypoint.xml
@@ -38,6 +38,9 @@
+
+
+
diff --git a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_pose.xml b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_pose.xml
index 51a3f183..fca077c6 100644
--- a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_pose.xml
+++ b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_pose.xml
@@ -63,6 +63,9 @@
+
+
+
diff --git a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_waypoint.xml b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_waypoint.xml
index 4733f815..c81b5485 100644
--- a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_waypoint.xml
+++ b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/move_to_waypoint.xml
@@ -45,6 +45,9 @@
name="controller_names"
default="/joint_trajectory_controller"
/>
+
+
+
diff --git a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/re_zero_force_torque_sensors.xml b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/re_zero_force_torque_sensors.xml
index 9c4f1ec4..5fbbf52e 100644
--- a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/re_zero_force_torque_sensors.xml
+++ b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/re_zero_force_torque_sensors.xml
@@ -18,6 +18,10 @@
-
+
+
+
+
+
diff --git a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/sample_april_tag.xml b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/sample_april_tag.xml
index 78f8523c..0f26bbba 100644
--- a/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/sample_april_tag.xml
+++ b/src/moveit_pro_kinova_configs/kinova_gen3_mujoco_config/objectives/sample_april_tag.xml
@@ -56,6 +56,9 @@
+
+
+
diff --git a/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/estimate_object_pose.xml b/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/estimate_object_pose.xml
index fede7df6..1414ad50 100644
--- a/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/estimate_object_pose.xml
+++ b/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/estimate_object_pose.xml
@@ -71,6 +71,10 @@
-
+
+
+
+
+
diff --git a/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/move_to_a_stampedpose.xml b/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/move_to_a_stampedpose.xml
index 03509637..60cfa019 100644
--- a/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/move_to_a_stampedpose.xml
+++ b/src/moveit_pro_mobile_manipulation/mobile_manipulation_config/objectives/move_to_a_stampedpose.xml
@@ -57,6 +57,9 @@
default="/joint_trajectory_controller"
/>
+
+
+
diff --git a/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/take_snap.xml b/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/take_snap.xml
index 07878d8d..89f2873c 100644
--- a/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/take_snap.xml
+++ b/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/take_snap.xml
@@ -14,6 +14,10 @@
-
+
+
+
+
+
diff --git a/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/wrist_snap.xml b/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/wrist_snap.xml
index 97c4f73b..324be61b 100644
--- a/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/wrist_snap.xml
+++ b/src/moveit_pro_mobile_manipulation/picknik_ur_mobile_config/objectives/wrist_snap.xml
@@ -13,6 +13,10 @@
-
+
+
+
+
+
diff --git a/src/moveit_pro_ur_configs/arm_on_rail_sim/objectives/pick_object.xml b/src/moveit_pro_ur_configs/arm_on_rail_sim/objectives/pick_object.xml
index b92faa44..8fa1bfc1 100644
--- a/src/moveit_pro_ur_configs/arm_on_rail_sim/objectives/pick_object.xml
+++ b/src/moveit_pro_ur_configs/arm_on_rail_sim/objectives/pick_object.xml
@@ -30,6 +30,10 @@
-
+
+
+
+
+
diff --git a/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/interpolate_to_joint_state.xml b/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/interpolate_to_joint_state.xml
index 9687de28..67b02a66 100644
--- a/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/interpolate_to_joint_state.xml
+++ b/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/interpolate_to_joint_state.xml
@@ -33,6 +33,9 @@
+
+
+
diff --git a/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_joint_state.xml b/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_joint_state.xml
index 1e0c2a5e..82d378cb 100644
--- a/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_joint_state.xml
+++ b/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_joint_state.xml
@@ -31,6 +31,9 @@
+
+
+
diff --git a/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_pose.xml b/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_pose.xml
index cda5743f..c00a3227 100644
--- a/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_pose.xml
+++ b/src/moveit_pro_ur_configs/picknik_ur_multi_arm_config/objectives/move_to_pose.xml
@@ -35,6 +35,9 @@
+
+
+
diff --git a/src/moveit_pro_ur_configs/picknik_ur_site_config/objectives/retreat_to_initial_pose.xml b/src/moveit_pro_ur_configs/picknik_ur_site_config/objectives/retreat_to_initial_pose.xml
index ee4c82a9..24964ffa 100644
--- a/src/moveit_pro_ur_configs/picknik_ur_site_config/objectives/retreat_to_initial_pose.xml
+++ b/src/moveit_pro_ur_configs/picknik_ur_site_config/objectives/retreat_to_initial_pose.xml
@@ -59,6 +59,9 @@
default="{pre_approach_robot_state}"
/>
+
+
+