| /branches/MergedVersionsByOsiair/alpha/v064JokoGPSNick666MM3Acc/timer0.c |
|---|
| 93,12 → 93,13 |
| if (!cntKompass--) // Aufruf mit 25 Hz |
| { |
| KompassValue = (MM3_heading()); |
| if (KompassValue < 0 ) { KompassValue = 380+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); |