   delay(1000);
   Serial.println("All power to the engines!");
   stop(SOFT);
-  blinkGreenTimer=blinkRedTimer= millis();
-  stateGreen=stateRed=true;
+  blinkGreenTimer=blinkYellowTimer= millis();
+  stateGreen=stateYellow=true;
   emergency_mode=warning=false;
   digitalWrite(LED_GREEN, LOW);
   digitalWrite(LED_YELLOW, LOW);

        stateGreen=!stateGreen;
        blinkGreenTimer=millis();
        digitalWrite(LED_GREEN, stateGreen);
      }
    } 
    else {
      if (millis()-blinkRedTimer>300){
        stateRed=!stateRed;
        blinkRedTimer=millis();
        digitalWrite(LED_YELLOW, stateRed);   
      }
      Serial.print("*");
    }

char inStringBuffer[BUFFSIZE];
char outStringBuffer[BUFFSIZE];
uint32_t bytesRead = 0;
int blinkGreenTimer, blinkYellowTimer;
bool stateYellow,stateGreen;
bool emergency_mode,warning;
int emergency_sensor_threshold =900;

