Merge pull request #443 from PickNikRobotics/fix-octomap-ci

clear octomap at the end of octomap example

Author: shaur-k

src/lab_sim/objectives/octomap_example.xml

@@ -25,6 +25,17 @@
         pcd_topic="/pcd_pointcloud_captures"
         point_cloud="{point_cloud}"
       />
+      <Action
+        ID="LogMessage"
+        log_level="info"
+        message="Click Resume to reset the octomap and finish the Behavior"
+      />
+      <!--Clear the Octomap at the end to avoid interfering with other Behaviors-->
+      <Action
+        ID="BreakpointSubscriber"
+        breakpoint_topic="/moveit_pro_breakpoint"
+      />
+      <SubTree ID="Clear Snapshot" _collapsed="true" />
     </Control>
   </BehaviorTree>
   <TreeNodesModel>

src/lab_sim/test/objectives_integration_test.py

@@ -77,6 +77,7 @@
     "Pick 1 Pill Bottle",
     "AddBottlesToPlanningScene",
     "Interactive Marker Visualization",  # Server not available for GetTextFromUser
+    "Octomap Example",  # Requires user input to clear the octomap.
 }