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