Rev 319 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 319 | Rev 320 | ||
|---|---|---|---|
| Line 46... | Line 46... | ||
| 46 | { |
46 | { |
| 47 | MM3_timer0(); // Kompass auslesen |
47 | MM3_timer0(); // Kompass auslesen |
| Line 48... | Line 48... | ||
| 48 | 48 | ||
| 49 | if (!cntKompass--) // Aufruf mit 25 Hz |
49 | if (!cntKompass--) // Aufruf mit 25 Hz |
| 50 | { |
- | |
| Line 51... | Line 50... | ||
| 51 | 50 | { |
|
| 52 | 51 | ||
| 53 | if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();} |
- | |
| 54 | if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;} |
- | |
| 55 | - | ||
| 56 | - | ||
| 57 | - | ||
| Line 58... | Line 52... | ||
| 58 | KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360); |
52 | if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();} |
| 59 | 53 | if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;} |
|
| 60 | 54 | ||