Beim Vorwärtslaufen ist übrigens ein Fehler in Deinem Algorithmus. Da er dort die rechte Seite falsch bedient. Aber nur beim Vorwärtslaufen, so dass es kein mechanischer Fehler sein kann.