yikestone/ros_arduino_bridge
1
0
Fork 0
mirror of https://github.com/YikeStone/ros_arduino_bridge.git synced 2025-08-06 04:14:09 +05:30
Code Issues Projects Releases Wiki Activity

Improved initial connection loop in arduino_driver.py

Browse Source
This commit is contained in:
Patrick Goebel 2016-06-26 18:43:21 -07:00
parent c8fe760785
commit 82b2bbb546
1 changed files with 22 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
ros_arduino_python/src/ros_arduino_python/arduino_driver.py
View File

@ -77,15 +77,31 @@ class Arduino:
# When an Arduino is first plugged in, it can take time for the serial port to wake up # When an Arduino is first plugged in, it can take time for the serial port to wake up
max_attempts = 10 max_attempts = 10
attempts = 0 attempts = 1
timeout = self.timeout
# Wake up the serial port # Wake up the serial port
while attempts < max_attempts:
self.serial_port.write('\r') self.serial_port.write('\r')
while attempts < max_attempts and self.serial_port.read() == '': time.sleep(timeout)
rospy.loginfo("Waking up serial port...") test = self.serial_port.read()
self.serial_port.write('\r') if test != '':
break
rospy.loginfo("Waking up serial port attempt " + str(attempts) + " of " + str(max_attempts))
# Increase timeout by 10%
timeout *= 1.1
self.serial_port.timeout = timeout
self.serial_port.writeTimeout = timeout
self.serial_port.flushInput()
self.serial_port.flushOutput()
attempts += 1 attempts += 1
time.sleep(1)
if test == '':
raise SerialException
if timeout != self.timeout:
rospy.loginfo("Found best timeout to be " + str(timeout) + " seconds")
# Test the connection by reading the baudrate # Test the connection by reading the baudrate
attepmpts = 0 attepmpts = 0
@ -97,7 +113,7 @@ class Arduino:
try: try:
self.serial_port.inWaiting() self.serial_port.inWaiting()
rospy.loginfo("Connected at " + str(self.baudrate)) rospy.loginfo("Connected at " + str(self.baudrate))
rospy.loginfo("Arduino is ready.") rospy.loginfo("Arduino is ready!")
except IOError: except IOError:
raise SerialException raise SerialException