reset st on rospy shutdown, fix #42

diff --git a/utils/catkin_ws/src/serial_bridge/scripts/serial_control.py b/utils/catkin_ws/src/serial_bridge/scripts/serial_control.py
index 7ac62c716b5aab4e19e8d8f931c683f15b102242..78c50f15c200324a4c03cb06ab552556aad35a41 100755 (executable)
--- a/utils/catkin_ws/src/serial_bridge/scripts/serial_control.py
+++ b/utils/catkin_ws/src/serial_bridge/scripts/serial_control.py
@@ -138,6 +138,12 @@ def controller():
             rospy.logerr("Decode Error")
             ser.reset_input_buffer()
 
+def reset_st():
+    ser.dtr = 1
+    time.sleep(1)
+    ser.dtr = 0
+
+rospy.on_shutdown(reset_st)
 
 if __name__ == '__main__':
     controller()