/branches/MergedVersionsByOsiair/alpha/v060JokoKompassNick666MM3Acc/timer0.c |
---|
48,16 → 48,10 |
if (!cntKompass--) // Aufruf mit 25 Hz |
{ |
if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();} |
if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;} |
KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360); |
cntKompass = 640; |
} |
} |