.include "m8def.inc"
.equ F_CPU=8000000   ;тактовая частота 8 МГц

.equ   D=100000*F_CPU/1000000   ; для примера 100мс

.equ   D_HIGH=$70   ; ячейки, хранящие задержку D/256
.equ   D_MIDL=$71   ; ячейки, хранящие задержку D/256
.equ   D_LOW =$72   ;

.cseg
.org 0
   RJMP START         ;переход на обработку сброса

.org 9
T0_OVER:
   SUBI   R27,BYTE1(1)
   SBCI   R26,BYTE2(1)
   SBCI   R25,BYTE3(1)
   BRNE   NO_DELAY
   RET
NO_DELAY:
   RETI

START:
   LDI ZH, high(RAMEND)      ;Инциализация стека
   LDI ZL, low(RAMEND)       ;
   OUT SPH,ZH               ;
   OUT SPL,ZL               ;

   LDI   R25,BYTE3(D/256)   ; для примера
   LDI   R26,BYTE2(D/256)   ; для примера
   LDI   R27,BYTE1(D/256)   ;
   STS   D_HIGH,R25         ;
   STS   D_MIDL,R26         ;
   STS   D_LOW,R27         ;
GO:
   LDS   R25,D_HIGH   ; загрузка D/256
   LDS   R26,D_MIDL   ;
   LDS   R27,D_LOW
   
   LDI   R21,1<<SE
   OUT   MCUCR,R21

   LDI   R21,1<<TOIE0
   OUT   TIMSK,R21
   OUT   TIFR,R21

   LDI   R21,1<<CS00   ;F_CPU/1
   OUT   TCCR0,R21

   SEI
WAIT:
   SLEEP
   BRIE   WAIT
   RJMP   GO
.EXIT

//==================
#ifndef SOFT_TIMERS_H

#define SOFT_TIMERS_H

#include "soft_timers.h"

#include "main_def_func.h"
//==================

//==================
#define ST_TCNT         TCNT2
#define ST_TIMSK        TIMSK
#define ST_OCIE         OCIE2
#define ST_OCR          OCR2
#define ST_TCCR         TCCR2
#define CS0             CS20
#define CS1             CS21
#define CS2             CS22
//==================

//==================
typedef struct soft_timer
{
   bool status;
   u08 sys_tick_prev;
   u16 cnt;       // Counter.
   u16 period;    // Period.
} soft_timer;
//==================

//==================
void init_soft_timers (void);

#define handle_soft_timer(a) _handle_soft_timer (&a)
bool _handle_soft_timer (void *ptr_timer);

#define set_soft_timer(a,b,c) _set_soft_timer (&a, b, c)
void _set_soft_timer (void *ptr_timer, u16 time, u16 period);

#define reset_soft_timer(a) _reset_soft_timer (&a)
void _reset_soft_timer (void *ptr_timer);
//==================

//==================
extern bool tick;

void Main_Timer_Init (void);
bool Main_Get_Tick (void);
//==================

#endif

//==================
// Реализация программных таймеров.
// Примечание. Важно!!!!!!!!!!!!!!!
// При смене состояния конечного автомата нужно сбросить
// все таймеры, которые используются в этом состоянии. Иначе может быть
// следующая ситуация: если таймер уже использовался в
// текущем состоянии и флаг EN установлен, то по окончании времени
// выполнится соответствующий код.
//---------- Пример использования ----------
// set_soft_timer (ST_LED_2_BLINK, 50, 50); // Установка таймера.
// if (handle_soft_timer (ST_LED_2_BLINK))  // Проверка таймера.
//==================

//==================
#include "soft_timers.h"
//==================

//==================
static u08 sys_tick;
//==================

//==================
#pragma vector = TIMER2_COMP_vect
__interrupt void SysTimerComp (void)
{
   ST_OCR += 250;
   sys_tick++;
}
//==================

//==================
void init_soft_timers (void)
{
   sys_tick = 0;
   ST_TCNT = 0;
   ST_OCR = 250;
   ST_TCCR |= (1<<CS2);
   set_bit (ST_TIMSK, ST_OCIE);
}
//----------
void _set_soft_timer (void *ptr_timer, u16 time, u16 period)
{
   struct soft_timer *ptr = ptr_timer;

   ptr -> status = true;

   if (time == 0)
      ptr -> sys_tick_prev = ~sys_tick;
   else
      ptr -> sys_tick_prev = sys_tick;

   ptr -> cnt = time;
   ptr -> period = period;
}
//----------
bool _handle_soft_timer (void *ptr_timer)
{
   struct soft_timer *ptr = ptr_timer;

   if (ptr -> status)
   {
      if (ptr -> sys_tick_prev != sys_tick)
      {
         ptr -> sys_tick_prev = sys_tick;

         if (ptr -> cnt == 0)
         {
            if (ptr -> period != 0) ptr -> cnt = ptr -> period;
            return true;
         }
         else
         {
            ptr -> cnt--;

            if (ptr -> cnt == 0)
            {
               if (ptr -> period != 0) ptr -> cnt = ptr -> period;
               return true;
            }
         }
      }
   }

   return false;
}

void _reset_soft_timer (void *ptr_timer)
{
   struct soft_timer *ptr = ptr_timer;

   ptr -> status = 0;
   ptr -> sys_tick_prev = 0;
   ptr -> cnt = 0;
   ptr -> period = 0;
}
//==================