/branches/MergedVersionsByOsiair/alpha/v060SalvoKompassNick666MM3Gyro/timer0.c |
---|
60,8 → 60,15 |
if (!cntKompass--) // Aufruf mit 25 Hz |
{ |
KompassValue = MM3_heading(); |
KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180; |
KompassValue = (MM3_heading()); |
if (KompassValue < 0 ) { KompassValue = 380+MM3_heading();} |
if (KompassValue > 359) { KompassValue = 359;} |
KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360); |
cntKompass = 320; |
} |
} |