   delay(DELAY / 10);
 }
 
-//TODO remove
-void sendToADKDelayed(int command, int param1, int param2) {
-  int time = millis();
-  if (time - last_send > 2000) {
-    last_send = time;
-    randomint = random(-1500, 1500);
-    memset(outStringBuffer, 0, BUFFSIZE);
-    sprintf(outStringBuffer, "%d,%d,%d", command, param1, param2);
-    memcpy(outBuffer, outStringBuffer, BUFFSIZE);
-    adk.write(strlen(outStringBuffer), outBuffer);
-    if (COM_DEBUG_MODE) {
-      Serial.print("\nSending | ");
-      Serial.print(outStringBuffer);
-      Serial.print(" | ");
-      Serial.print(strlen(outStringBuffer));
-      Serial.println(" bytes outgoing");
-    }
-  }
-  delay(DELAY / 10);
-}
-
 bool decodeCommand(char* incoming, int* command, int* param1, int* param2) {
   // Incoming message pattern command,param1,param2
   char delimiter = ',';

bool sensorsOk(){  
  return !FLIsOut() && !FRIsOut();
}
bool FRIsOut(){
  return analogRead(FR)>emergency_sensor_threshold;
}
bool FLIsOut(){
  return analogRead(FL)>emergency_sensor_threshold;
}

void terminateAndroidApp(){
  sendToADK(INFO,TERMINATE,CMD_NULL_VALUE);  
}
#include <stdio.h>
#include <adk.h>

#define LED_GREEN 22
#define LED_YELLOW 24
#define LED_RED 26
