From: fdila <federicadilauro1998@gmail.com>
Date: Tue, 12 May 2020 10:53:35 +0000 (+0200)
Subject: reset st on rospy shutdown, fix #42
X-Git-Url: http://git.leonardobizzoni.com/?a=commitdiff_plain;h=a4179cfb15babec0a28aa0cb5c11ca982f6a859d;p=pioneer-stm32

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 7ac62c7..78c50f1 100755
--- 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()