| /branches/MergedVersionsByOsiair/alpha/v060SalvoKompassNick666MM3Gyro/timer0.c |
|---|
| 60,10 → 60,11 |
| 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); |