 
 #include <stdio.h>
 #include <adk.h>
-#define LED_GREEN 53
-#define LED_YELLOW 52
-#define LED_RED 7
+#define LED_GREEN 22
+#define LED_YELLOW 24
+#define LED_RED 26
 #define BUFFSIZE   255
 #define MAX_POWER  400
 #define DELAY 50 // Smaller delay breaks everything about communication

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

char inStringBuffer[BUFFSIZE];
char outStringBuffer[BUFFSIZE];
uint32_t bytesRead = 0;
int blinkGreenTimer, blinkYellowTimer;
bool stateYellow,stateGreen;
bool emergency_mode,warning,FL_edge,FR_edge;
int emergency_sensor_threshold =880,currentState=IDLE;

