     Serial.println("Message ERROR\n\rInvalid command!\n\r");
       
   newMessageReceived = false;
-  inputString = "";
+  inputString.remove(0);
 }
 

          u[i] = max(buffer, -mios);
      }

      for (int i=0; i<6; i++)
      {
        Serial.print(u[i]);
        Serial.print(", ");
      }
      Serial.println("");
    }

    else if (buffer == "SetKp")

  if (newMessageReceived)
    handleNewMessage();

  if(millis() - timeOfLastMessageReceived > 200)
  {
    for(int i=0; i<6; i++)
      u[i] = 0;
