def connect(self):
if self.pseudo:
rospy.loginfo('Connected to pseudo sensor')
return
try:
self.serial = serial.Serial(self.serial_port, 19200, timeout=1)
rospy.logdebug("self.serial.isOpen() = {}".format(self.serial.isOpen()))
if not self.sensor_is_connected:
self.sensor_is_connected = True
rospy.loginfo('Connected to sensor')
except:
if self.sensor_is_connected:
self.sensor_is_connected = False
rospy.logwarn('Unable to connect to sensor')
评论列表
文章目录