настройка таймера/счетчика

//*************************************************************************************************************
/*
 * Timer_1sec.cpp
 *
 * Created: 06.05.2017 10:16:02
 *  Author: Grey-vsm
 */ 
 
      #define F_CPU 4096000
      #include <avr/io.h>
      #include <avr/interrupt.h>
      
      #define ddrSEC DDRD
      #define portSEC PORTD
      
       // Declare your global variables here
       unsigned char volatile T;
       unsigned char volatile a;
      //----------------------------------------------------------
      
      //-----Prototips Function------------------------------------------------------
      void Init_MK (void); //Прототип функции инициализации МК
      //-----------------------------------------------------------------------------
                                                                                     
      //----Функция обработки прерывания по переполнению таймера/счетчика------------
      ISR (TIMER0_OVF_vect)
         {
             TCNT0=0xFE;
             T=T+1;
             if (T>=2)
               {  T=0;
                  a=1;
                };
             asm("RETI");
          }
                                                                                      
      void Init_MK (void)
         {                                                                                 
           // Input/Output Ports initialization
           // Port D initialization
           // Func7=Out Func6=Out Func5=Out Func4=Out Func3=Out Func2=Out Func1=Out Func0=Out
           // State7=1  State6=1  State5=1  State4=1  State3=1  State2=1  State1=1  State0=1
           ddrSEC=0xFF;
           portSEC=0xFF;
                                                                                                             
           // Timer/Counter 0 initialization
           // Clock source: System Clock
           // Clock value: 4,000 kHz
           TCCR0=0x05;   /*Регистр управления тактовым сигналом.
                Задаётся коэфициент деления тактового сигнала=1024*/
           TCNT0=0xFE;   // Счетный регистр таймера Т0
                                                                                                       
           // Timer(s)/Counter(s) Interrupt(s) initialization
           TIMSK=0x01;
          }
                                                                                                                                                                                            
      int main(void)
         {
             Init_MK ();
             asm("sei");
             T=0;
             a=0;
             while(1)
                {
                    if (a)
                      {
                          portSEC=portSEC^(1<<0);
                          a=0;
                       } 
                 }
          }
//*************************************************************************************************************

ISR (TIMER0_OVF_vect)
  {
         static unsigned char tmp=0;   
          TCNT0=56;// подкорректировать для своего таймера 
     tmp++;
    if(tmp>=40)
        {
         tmp=0;
         // здесь код который должен вызываются каждую секунду
         }
  }