Stop all motor movement when timing out

himalayanelixir · himalayanelixir · commit 2a1bf6307e82 · 2019-09-03T17:02:47.000-07:00
diff --git a/arduino_controller/arduino_controller_functions.ino b/arduino_controller/arduino_controller_functions.ino
@@ -109,10 +109,13 @@ void ProcessData()
       if (timeout_counter >= TIMEOUT)
       {
         go = false;
+        for (int i = 0; i < NUMBER_MOTORS; i++)
+        {
+            my_servo[i].write(90);
+        }
       }
       timeout_counter = timeout_counter + 1
       
-
     }
   }
   else
@@ -145,6 +148,10 @@ void ProcessData()
       if (timeout_counter >= TIMEOUT)
       {
         go = false;
+        for (int i = 0; i < NUMBER_MOTORS; i++)
+        {
+            my_servo[i].write(90);
+        }
       }
       timeout_counter = timeout_counter + 1
     }

Original file line number	Diff line number	Diff line change
`@@ -109,10 +109,13 @@ void ProcessData()`
`109`	`109`	`if (timeout_counter >= TIMEOUT)`
`110`	`110`	`{`
`111`	`111`	`go = false;`
	`112`	`+ for (int i = 0; i < NUMBER_MOTORS; i++)`
	`113`	`+ {`
	`114`	`+ my_servo[i].write(90);`
	`115`	`+ }`
`112`	`116`	`}`
`113`	`117`	`timeout_counter = timeout_counter + 1`
`114`	`118`
`115`		`-`
`116`	`119`	`}`
`117`	`120`	`}`
`118`	`121`	`else`
`@@ -145,6 +148,10 @@ void ProcessData()`
`145`	`148`	`if (timeout_counter >= TIMEOUT)`
`146`	`149`	`{`
`147`	`150`	`go = false;`
	`151`	`+ for (int i = 0; i < NUMBER_MOTORS; i++)`
	`152`	`+ {`
	`153`	`+ my_servo[i].write(90);`
	`154`	`+ }`
`148`	`155`	`}`
`149`	`156`	`timeout_counter = timeout_counter + 1`
`150`	`157`	`}`