diff options
| -rw-r--r-- | include/arch/atmega2560/driver/timer.h | 8 |
1 files changed, 5 insertions, 3 deletions
diff --git a/include/arch/atmega2560/driver/timer.h b/include/arch/atmega2560/driver/timer.h index c16fbe4..e12592d 100644 --- a/include/arch/atmega2560/driver/timer.h +++ b/include/arch/atmega2560/driver/timer.h @@ -19,17 +19,19 @@ class Timer { inline void setup_khz(uint16_t const frequency) { // 16 MHz base OCR4A = frequency ? 16000 / frequency : 65535; - TCCR4A = _BV(WGM42); + TCCR4A = 0; + TCCR4B = _BV(WGM42); prescaler = _BV(CS40); } inline void setup_hz(uint16_t const frequency) { // 16 MHz / 256 == 62.5 kHz base OCR4A = frequency ? 62500 / frequency : 65535; - TCCR4A = _BV(WGM42); + TCCR4A = 0; + TCCR4B = _BV(WGM42); prescaler = _BV(CS42); } inline void start(unsigned char const interrupt) { TCNT4 = 0; - TCCR4B = prescaler; + TCCR4B |= prescaler; if (interrupt) { TIMSK4 = _BV(OCIE4A); } |