   Serial.println(" )");
 }
 
-bool isValidSymbol(char character){
-  static char symbols[] = "RPSMDTAM-";
-
-  return !containsChar(symbols, character);
-}
-
 bool containsChar(char *string, char character){
   if(!(*string)){ //if string is empty
     return false;

  if(*instruction == 'M'){
    ++instruction;
    if(containsChar("SP", *instruction)){
      int value = atoi(instruction);
      if(*instruction == 'S'){
	return value < 255 && value > -255;
      }


void printDistanceInfo(Distance_Info info){
  Serial.print("Afstand emmer: ");
  Serial.print(info.emmerDistance / 59.0);
  Serial.print(", afstand pomp: ");
  Serial.println(info.pompDistance / 59.0);
}

void printStateInfo(State_Info info){
