Probleme mit meinem Rover-Code

Hallo!

Danke für eure ganzen Tipps ich werde es dann erstmal so machen wir ihr mir geraten habt und das ganze Programm aufdröseln.
Leider hatte ich dazu bis jetzt noch keine Zeit ich hoffe aber das ich die ganze Geschichte an diesem Wochenende zum Ende bringen kann.

Mein Vorwärts-Unterprogramm läuft jetzt auch recht gut, aber es scheint wirklich Probleme mit den Sensoren zu geben, muss ich die noch Deklarieren (Dachte bei analogen Eingängen entfällt das) oder muss ich noch eine Abfragefrequenz oder ähnliches einbauen?

Letzte Frage: Stimmt es denn, dass ich mit der bisherig eingebauten Servo Bilbliothek nur zwei Servos ansteuern kann?