| 10,7 → 10,13 |
|---|
| |
| unsigned int BeepMuster = 0xffff; |
| unsigned int ServoValue = 0; |
| |
| //Salvo 8.9.2007 |
| volatile uint8_t Kompass_Neuer_Wert= 0; |
| volatile unsigned int Kompass_Value_Old = 0; |
| // Salvo End |
| //Salvo 21.9.2007 |
| short unsigned int Kompass_present= 0; //>0 bedeutet dass der Kompass vorhanden ist |
| // Salvo End |
| enum { |
| STOP = 0, |
| CK = 1, |
| 22,7 → 28,10 |
|---|
| T0_RISING_EDGE = 7 |
| }; |
| |
| |
| // Aenderungen von Peter Muehlenbrock ("Salvo") Stand 24.12.2007 |
| /* |
| Ersatzkompass abgeleitet aus Magnetkompass und Giergyro fuer nahezu neigungsubhaengige Kompassfunktion |
| */ |
| SIGNAL (SIG_OVERFLOW0) // 8kHz |
| { |
| static unsigned char cnt_1ms = 1,cnt = 0; |
| 31,6 → 40,7 |
|---|
| if(SendSPI) SendSPI--; |
| if(!cnt--) |
| { |
| if (Kompass_present > 0) Kompass_present--; //Runterzaehlen. Wenn 0 ist der Kompass nicht vorhanden |
| cnt = 9; |
| cnt_1ms++; |
| cnt_1ms %= 2; |
| 65,7 → 75,7 |
|---|
| else PORTC &= ~(1<<7); |
| } |
| |
| if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) |
| if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) //Salvo 25.10.2008 |
| { |
| if(PINC & 0x10) |
| { |
| 77,11 → 87,29 |
|---|
| { |
| cntKompass += cntKompass / 41; |
| if(cntKompass > 10) KompassValue = cntKompass - 10; else KompassValue = 0; |
| // Salvo Kompassoffset 23.12.2007 *********** |
| Kompass_present = 255; |
| // Kompass_Value_Old = KompassValue; |
| if (KOMPASS_OFFSET > 0) KompassValue = cntKompass -KOMPASS_OFFSET; |
| else KompassValue = cntKompass - ((int) (Parameter_UserParam4*2)); |
| |
| if (KompassValue < 0) |
| { |
| KompassValue += 360; |
| } |
| if (KompassValue >= 360) |
| { |
| KompassValue -= 360; |
| } |
| // Salvo End |
| } |
| // if(cntKompass < 10) cntKompass = 10; |
| // KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L; |
| KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180; |
| cntKompass = 0; |
| //Salvo 13.9.2007 Ok Erkennung des Magnetkompasses |
| Kompass_Neuer_Wert = 1; |
| // Salvo End |
| cntKompass = 0; |
| } |
| } |
| } |