| /branches/MK3Mag V0.14 Code Redesign Killagreg/timer0.c |
|---|
| 114,7 → 114,7 |
| // disable PWM when bad compass heading value |
| if(Heading < 0) |
| { |
| PORTB &= ~(PORTB2); |
| PORTB &= ~(1<<PORTB2); |
| cmps_cnt = 0; |
| } |
| else |
| 123,7 → 123,7 |
| if(++cmps_cnt >= 380) |
| { |
| // set PWM out to high |
| PORTB |= PORTB2; |
| PORTB |= (1<<PORTB2); |
| // reset periode counter |
| cmps_cnt = 0; |
| } |
| 131,7 → 131,7 |
| else if(cmps_cnt >= (Heading + 10)) |
| { |
| // set PWM out to low |
| PORTB &= ~(PORTB2); |
| PORTB &= ~(1<<PORTB2); |
| } |
| } |