Commit aaa8d4c1 authored by Birte Kristina Friesel's avatar Birte Kristina Friesel
Browse files

atmega2650 timer: actually use CTC mode

parent 36f39d1b

include/arch/atmega2560/driver/timer.h

+5 −3
Original line number Diff line number Diff line
@@ -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);

			}