Browse Source

stretch_driver node error out if found old stretch_body

pull/77/head
Mohamed Fazil 2 years ago
parent
commit
c7b938dd29
1 changed files with 5 additions and 0 deletions
  1. +5
    -0
      stretch_core/nodes/stretch_driver

+ 5
- 0
stretch_core/nodes/stretch_driver View File

@ -6,6 +6,7 @@ import threading
from rwlock import RWLock
import stretch_body.robot as rb
from stretch_body.hello_utils import ThreadServiceExit
import stretch_body
import tf2_ros
import tf_conversions
@ -338,6 +339,10 @@ class StretchBodyNode:
rospy.loginfo("{0} started".format(self.node_name))
if int(stretch_body.__version__.split('.')[1]) < 4:
rospy.logerr("ERROR: Found old stretch_body version. Please upgrade stretch_body to 0.4.0 or above.")
rospy.signal_shutdown('Found old stretch_body version.')
self.robot = rb.Robot()
self.robot.startup()

Loading…
Cancel
Save