Subversion Repositories FlightCtrl

Rev

Rev 309 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 309 Rev 312
Line 58... Line 58...
58 
        {
 58 
        {
59 
                MM3_timer0();           // Kompass auslesen
 59 
                MM3_timer0();           // Kompass auslesen
Line 60... Line 60...
60 
 
 60 
 
61 
                if (!cntKompass--)              // Aufruf mit 25 Hz
 61 
                if (!cntKompass--)              // Aufruf mit 25 Hz
62 
                {
 - 
 
- 
 
 62 
                {
Line 63... Line 63...
63 
                        KompassValue = (MM3_heading());
 63 
               
64 
 
 64 
 
- 
 
 65 
                if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();}
Line 65... Line 66...
65 
                if (KompassValue < 0 ) { KompassValue = 380+MM3_heading();}
 66 
                if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;}