move visualize navigation goals to cob_helper_tools

benmaidel · May 31, 2017 · f3c841b · f3c841b
1 parent c243b00
commit f3c841b
Show file tree

Hide file tree

Showing 3 changed files with 7 additions and 2 deletions.
diff --git a/cob_helper_tools/CMakeLists.txt b/cob_helper_tools/CMakeLists.txt
@@ -14,5 +14,6 @@ install(PROGRAMS
   scripts/auto_recover.py
   scripts/fake_diagnostics.py
   scripts/fake_driver.py
+  scripts/visualize_navigation_goals.py
   DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
 )
diff --git a/cob_helper_tools/package.xml b/cob_helper_tools/package.xml
@@ -15,5 +15,7 @@
   <exec_depend>cob_script_server</exec_depend>
   <exec_depend>diagnostic_msgs</exec_depend>
   <exec_depend>rospy</exec_depend>
+  <exec_depend>tf</exec_depend>
+  <exec_depend>visualization_msgs</exec_depend>
 
 </package>
diff --git a/..._server/src/visualize_navigation_goals.py → ...ols/scripts/visualize_navigation_goals.py b/..._server/src/visualize_navigation_goals.py → ...ols/scripts/visualize_navigation_goals.py
@@ -4,7 +4,6 @@
 import tf
 from visualization_msgs.msg import Marker
 from visualization_msgs.msg import MarkerArray
-from geometry_msgs.msg import Point
 
 class VisualizerNavigationGoals():
     def __init__(self):
@@ -80,4 +79,7 @@ def pubMarker(self):
     r = rospy.Rate(1)
     while not rospy.is_shutdown():
         p.pubMarker()
-        r.sleep()
+        try:
+            r.sleep()
+        except rospy.exceptions.ROSInterruptException as e:
+            pass