first commit

Dependencies:   mbed MMA8451Q

Revision:
17:d2c98ebda90b
Parent:
16:8cd4dd323941
Child:
19:65fecaa2a387
--- a/state_control.h	Tue Oct 26 17:06:39 2021 +0000
+++ b/state_control.h	Tue Oct 26 19:10:13 2021 +0000
@@ -37,10 +37,11 @@
 void _run(void){
     // TODO: realease brakes, start the motors
     // 
-    brakeLeftBool = false;
-    brakeLeftBool = false;
+    disable_brakes();
     motor_enabled = true; 
     turn_led(GREEN); 
+    setpointLeft = 0.2;
+    setpointRight = 0.2;
     };
 void _wait(void){
      // release brakes, turn on steering system, do not start the motor