in der erweiterrten lib gibt unter examples ein programm das ihn "genau" geradeaus fahren lässt.
Ich hab das problem auch und bei mir funktioniert das so recht gut.

mfG