Added try-except around append(sensor)

This commit is contained in:
Patrick Goebel 2016-11-01 15:48:03 -07:00
parent aa8ba65e1d
commit d9968a7f4b

View File

@ -201,6 +201,7 @@ class ArduinoROS():
# self.sensors[len(self.sensors)]['trigger_pin'] = params['trigger_pin']
# self.sensors[len(self.sensors)]['output_pin'] = params['output_pin']
try:
self.device.sensors.append(sensor)
if params['rate'] != None and params['rate'] != 0:
@ -210,6 +211,8 @@ class ArduinoROS():
rospy.loginfo(name + " service ready at " + rospy.get_name() + "/" + name + "/read")
else:
rospy.loginfo(name + " service ready at " + rospy.get_name() + "/" + name + "/write")
except:
rospy.logerr("Sensor type " + str(params['type'] + " not recognized."))
# If at least one IMU or gyro is used for odometry, set the use_imu_heading flag on the base controller
if self.use_base_controller and len(self.imu_for_odom) > 0: