Расчет времени таймера на Atmega?

Question

[Славка]

static int getCounter(int  seconds) {

  double frc = ((double)1 / seconds) * 1000;
  int cnt  =  65536 -  (15625 / frc) ;
  return cnt;

}

Вот функция которая принимает на вход миллисекунды и настраивает регистр таймера TCNTx , но проблема в том что на осциллографе выходит ерунда.
Контроллер Atmega2560, плата Arduino Mega. Пред делитель настроен на 1024, т.е 16кк / 1024 = 15625
Внутри прерывания обычное пинание пина digitalWrite(port, !digitalRead(port));

Answer 1

[Ocelot]

Попробуйте так:

const unsigned long F_cpu = 16000000UL;
const unsigned long Prescaler = 1024UL;
unsigned int cnt = seconds * F_cpu / Prescaler;
if (cnt > 65535)   cnt = 65535;