ich glaube, ein fehler ist schon mal, dass du schreibst,{
StatusLED(GREEN);
}
und dannach schreibst du dann noch weiter an dieser funktion
MotorDir(FWD,FWD);
MotorSpeed(150,150);
BackLED(ON,ON);
FrontLED(ON);
obwohl du mit der geschweiften klammer nach dem StatusLED-Befehl die aktion schon beendet hast.