Rev 333 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 333 | Rev 338 | ||
|---|---|---|---|
| Line 67... | Line 67... | ||
| 67 | 67 | ||
| Line 68... | Line 68... | ||
| 68 | MM3_timer0(); // Kompass auslesen |
68 | MM3_timer0(); // Kompass auslesen |
| 69 | 69 | ||
| 70 | if (!cntKompass--) // Aufruf mit 25 Hz |
- | |
| Line 71... | Line 70... | ||
| 71 | { |
70 | if (!cntKompass--) // Aufruf mit 25 Hz |
| 72 | 71 | { |
|
| 73 | - | ||
| 74 | if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();} |
- | |
| 75 | if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;} |
- | |
| 76 | - | ||
| 77 | 72 | ||
| 78 | 73 | if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();} |
|
| - | 74 | if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;} |
|
| 79 | 75 | KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360)-180; |
|
| 80 | KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360)-180; |
76 | cntKompass = 320; // 320 |
| 81 | cntKompass = 320; // 320 |
77 | |