Fang vielleicht mal eine Nummer kleiner an und erweitere das schrittweise.
z.B. erst mal den Motor in den Endschalter fahren lassen und stoppen. Dann wieder herausfahren. Automatisch zwischen zwei Schaltern hin und her-fahren. Dann erst losfahren wenn ein Taster gedrückt wurde.