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

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