Subversion Repositories FlightCtrl

Rev

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

Rev 308 Rev 309
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 
                {
- 
 
 63 
                        KompassValue = (MM3_heading());
- 
 
 64 
 
63 
                        KompassValue = MM3_heading();
 65 
                if (KompassValue < 0 ) { KompassValue = 380+MM3_heading();}
- 
 
 66 
                if (KompassValue > 359) { KompassValue = 359;}
- 
 
 67 
                       
64 
                //      KompassValue += 180;
 68 
 
Line 65... Line 69...
65 
                KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360);
 69 
                KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360);
66 
                       
 70