7. Aufgabe 6- Roboterinitialisierung in C

Schreiben Sie ein Programm, dass den Roboter in die Grundstellung fährt! Die Grundstellung ist erreicht, wenn bei allen rechtsherum angesteuerten Motoren die Endschalter angesprochen haben.
Da der Antrieb, dessen Endschalter angesprochen hat, automatisch abgeschaltet wird, ist es für diese Aufgabe ausreichend, alle Motoren einzuschalten und nach einer ausreichend großen Zeit wieder auszuschalten.

Hinweis: Die normale Initialisierungsfunktion StdInit8255 ist bei Verwendung des Roboters nicht verwendbar. Stattdessen muss man das Kontrollwort/Betriebsmodus selbst konstruieren und in das Kontrollwort des 8255 Parallelbausteins schreiben.