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

  return analogRead(FL)<emergency_sensor_threshold && analogRead(FR)<emergency_sensor_threshold;
}

void setSpeedAndGo(int velocityLeft, int velocityRight) {
  releaseBrake(BOTH); 


  pinMode(LED_RED, OUTPUT);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(TERMINATE_BUTTON, INPUT);
  //pinMode(FL, INPUT);
  Serial.begin(115200);
  delay(1000);
