Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 309 → Rev 310

/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);