| /branches/slavo_gierkompass/timer0.c |
|---|
| 52,7 → 52,18 |
| { |
| if((cntKompass) && (cntKompass < 4000)) |
| { |
| KompassValue = cntKompass; |
| // Salvo Kompassoffset 30.8.2007 *********** |
| KompassValue = cntKompass -KOMPASS_OFFSET; |
| 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; |