Subversion Repositories FlightCtrl

Rev

Rev 308 | Rev 312 | 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 
 
- 
 
 65 
                if (KompassValue < 0 ) { KompassValue = 380+MM3_heading();}
- 
 
 66 
                if (KompassValue > 359) { KompassValue = 359;}
- 
 
 67 
                       
63 
                        KompassValue = MM3_heading();
 68 
 
- 
 
 69 
                KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360);
- 
 
 70 
                       
64 
                        KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
 71 
 
65 
                        cntKompass = 320;
 72 
                        cntKompass = 320;
66 
                }
 73 
                }