Den Fehler warum der Roboter zeitweise Stoppt konnte ich finden. Den Fehler habe ich gefunden indem ich Serial.print in jede Funktion eingefügt habe um zu sehen wo er hängen bleibt. Der Fehler ist aufgetreten wenn z.B. der Ultraschall was erkannt hat und direkt drauf der Stoßstangen Taster betätigt wurde.
Das war der fall als z.B. der Roboter auf das Fliegengitter an der Tür zugefahren ist. Der Ultraschallsensor hat erst ausgelöst als er direkt davor stand, da hat allerdings auch schon der Stoßstangen Taster ausgelöst. Habe das Programm angepasst und es Funktioniert wie es soll.