Eduardo Munoz Gutierrez / Mbed OS mbed-os-micromouse

Dependencies:   Motor

Revision:
3:cb2db19c4076
Parent:
2:49fbdf1e7fb0
Child:
4:d8dc8544fe81
--- a/main.cpp	Wed Mar 27 02:49:52 2019 +0000
+++ b/main.cpp	Wed Mar 27 02:57:46 2019 +0000
@@ -28,10 +28,10 @@
 float location = 0;
 
 void motors() {
+    car.speed(SPEED);
     while (true) {
         printf("motors::Checking Motors.. \n\r");
         location += car.speed();
-        car.speed(SPEED);
         if (not motor_turn_queue.empty()){
             osEvent evt = motor_turn_queue.get();
             if (evt.status == osEventMessage){
@@ -54,7 +54,7 @@
 
 void car_state() {
     State prev_state = ir.state();
-    float prev_speed = 0.0;
+    float prev_speed = SPEED;
     while (true) {
         float turn;
         float speed = SPEED;