Hört sich nicht weiter schlimm an.
Die Odometrie und die Taster muss man erst kalibrieren. Also mach dir mal selber ein paar Testprogramme mit denen du die Odometrie und die Taster auswertest und diese damit einstellen kannst.