Es stellen sich bei deiner Programmierung noch einige Fragen?
Womit steuerst du die Servos an, nur mit Taster.
Womit willst du die Drehzahl der Motoren verändern.
Das Programm ist jetzt noch recht klein und überschaubar. Es wäre gut sich das vorab zu überlegen. Man beginnt zumeist wieder von vorne wenn man sich die Frage stellen muss, wie kann ich auf die Hundehütte noch zwei Stockwerkt draufsetzen.