/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); |
} |
} |