روشن شدن دو موتور با تایمرصفر mega16 ؟

[mega16]

با سلام میخوام برنامه ای بنویسم با تایمر 1 مگا 16 بدون استفاده از وقفه تایمر یعنی روش polling مانند همین چیزی که در زیر نوشتم میخوام در واقع 5 ثانیه موتور اول روشن بشه و بعد از 5 ثانیه موتور اول خاموش وموتور دوم روشن بشه واین عمل تکرار گردد حالا نمیدونم چه کدی به برنامه زیر اضافه کنم وکجای برنامه بنویسمش دوستان کمک کنن:

کد:

#include <mega16.h>

// Declare your global variables here

void main(void)
{
DDRC=0xFF;
PORTC=0x01;
TCNT1H=0xb3;
TCNT1L=0xb4;
TCCR1A=0x00;
TCCR1B=0x04;


while (1)
      {
while(!(TIFR & 0x04));
TIFR|=0x40;
TCNT1H=0xb3;
TCNT1L=0xb4;

      };
}