| 71,7 → 71,13 |
|---|
| } |
| // if(cntKompass < 10) cntKompass = 10; |
| // KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L; |
| //Salvo 12.9.2007 Ersatzkompass als Basis nehmen, nicht den magnetkompass |
| KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180; |
| // int i; |
| // i = GyroKomp_Int/GYROKOMP_INC_GRAD_DEFAULT; |
| // if (i < 180) KompassRichtung = ((540 + i - KompassStartwert) % 360) - 180; |
| // else KompassRichtung = ((540 + (i-360) - KompassStartwert) % 360) - 180; |
| // Salvo End |
| Kompass_Neuer_Wert = 1; |
| cntKompass = 0; |
| } |