add planning failed msg

kroshu · Oct 19, 2023 · ccf722c · ccf722c
1 parent 05794d3
commit ccf722c
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/kuka_driver_examples/eci_demo/src/MoveitBasicPlan.cpp b/kuka_driver_examples/eci_demo/src/MoveitBasicPlan.cpp
@@ -307,6 +307,9 @@ int main(int argc, char * argv[])
     moveit_visual_tools.trigger();
     moveit_visual_tools.prompt("Press 'Next' in the RvizVisualToolsGui window to execute");
     move_group_interface_->execute(*planned_trajectory);
+  } else {
+    draw_title("Planning failed");
+    moveit_visual_tools.trigger();
   }
 
   DetachAndRemoveObject("pallet_0");