diff --git a/stretch_calibration/nodes/collect_head_calibration_data b/stretch_calibration/nodes/collect_head_calibration_data index f2b1356..9beafa2 100755 --- a/stretch_calibration/nodes/collect_head_calibration_data +++ b/stretch_calibration/nodes/collect_head_calibration_data @@ -207,7 +207,7 @@ class CollectHeadCalibrationDataNode: if timeout: rospy.logerr('collect_head_calibration_data get_samples: timeout while waiting for sample.') - #raise IOError('Timeout') + raise Exception('Timed out waiting for joint_states/accelerations/markers messages after 10 seconds') with self.data_lock: #set backlash joint state diff --git a/stretch_core/launch/d435i_basic.launch b/stretch_core/launch/d435i_basic.launch index e9ccb91..68f99cc 100644 --- a/stretch_core/launch/d435i_basic.launch +++ b/stretch_core/launch/d435i_basic.launch @@ -17,6 +17,7 @@ +