 #define SHOOTED 201
 #define RELOADED 202
 #define DISTANCE 203
+#define TERMINATE 999
 
 //Ultrasonic Ranging Module
 #define TRIG_PIN 2
 #define ECHO_PIN 4
+
 //Emergency Sensors
 #define FL A5
 #define FR A4
+
 
 const int
 LEFT = 0,

  digitalWrite(LED_GREEN, LOW);
  digitalWrite(LED_YELLOW, LOW);
  digitalWrite(LED_RED, LOW);

}

void loop() {
  //Go in emergency mode after two bad readings from sensor
  if (MOV_DEBUG_MODE){
    Serial.print("FL reading: ");
    Serial.println(analogRead(FL));
  }
  Serial.print("FL reading: ");
  Serial.println(analogRead(FL));
  if (!sensorsOk() && warning){
    emergency_mode=true;    
    emergency();

ADK adk(&Usb, manufacturer, model, accessoryName, versionNumber, url, serialNumber);
// End ADK configuration
// Debug mode for communication
bool COM_DEBUG_MODE = true;
// Debug mode for movment
bool MOV_DEBUG_MODE = false;
uint8_t inBuffer[BUFFSIZE];
