Einen Fehler hätte ich schon mal:
double r = 32*deg/180;// PI*reifenabstand*winkel/180°
Obwohl das für Dein Streckenproblem eher wenig Bedeutung hat.
Übrigens: double = float beim AVR-GCC und es wird viel Speicher verbraucht.