Erfasst du auch den Winkel/Position der vorderen Räder? Vielleicht kann man das mit einbinden, dreht sich der Robo weg wen ein Stein im Weg ist so müssten sich die Vorderräder ja um den Vorlauf drehen...