8051 - Jak napisać funkcję DELAY z użyciem Timera?

void Delay(WORD czas)
           {
		   BYTE timerS;
           timerS = czas;
           for (timerS=0;timerS<czas;timerS++) {}
		   }

1: /*****************************************************************
2: Timer0 powoduje mruganie diody LED dokładnie co 1sek.
3: Program powoduje mruganie diody LED w ten sposób, Ŝe dioda LED świeci
4: przez 1 sek i jest zgaszona przez 1 sekundę.
5: Źródłem przerwań jest układ Timer0. Powoduje on przerwanie co
6: 0.005 sek. Aby odliczyć czas 1 sek podprogram musi być wywołany
7: 200 razy. Podprogram ten takŜe generuje krótkie dźwięki
8: wydawane przez Buzzer z wbudowanym generatorem.
9: *****************************************************************/
10:
11: #include "51xD2.h" // zbiór definiujący rejestry procesora
12: #define Buzzer P3_5 // definicja adresu bitu Buzzer
13: #define LED P1_0 // dodatkowy zespół diod
14: #define TH0RELOAD 0xd8 // 0xd8f0 = -10000 dla Fosc=24MHz
15: #define TL0RELOAD 0xf0 // ...
16: #define SECOND 200 //1sek to 200 przerwań od Timer0
17:
18: //----------------------------------------------------------------
19: void main(void) {
20: TH0 = TH0RELOAD;
21: TL0 = TL0RELOAD;
22: TMOD = TMOD | 0x01; // tryb dla Timer0: mode1
23: TR0 = 1; // start Timer0
24: ET0 = 1; // zgoda na przerwania od Timer0
25: EA = 1; // zezwolenie na przerwania
26:
27: while(1) {}; // program główny nie robi nic
28: }
29: //podprogram przerwania ------------------------------------------
30: void T0_int(void) interrupt 1 using 1 {
31: static BYTE count=0;
32: TH0 = TH0RELOAD; // reload Timer0 registers
33: TL0 = TL0RELOAD;
34: Buzzer=1; // Buzer sygnał o długości 1/200sek
35: if (++count == SECOND) { // odliczanie liczby przerwań do 200
36: Buzzer=0; // uaktywnij Buzzer
37: count = 0; // zeruj licznik odliczający czas jednej sek
38: LED=!LED; // mruganie diody LED
39: }
40: }

#define Sbit(x, y, z)       sbit x = y^z
#define Sfr(x, y)	    sfr x = y

#define TH0RELOAD 0xfc // 0xfc18 = -1000 dla Fosc=12MHz
#define TL0RELOAD 0x18 
#define SECOND 1000 // 1 sek wymaga 1000 przerwan od Timer0

typedef unsigned int  WORD;
typedef unsigned char BYTE;

//-------funkcje czasu---------------

Sfr (TL0 , 0x8A); 
Sbit (ET0  , 0xA8, 1);
Sfr (TH0 , 0x8C);
Sfr (TMOD , 0x89); 
Sbit (TR0 , 0x88, 4);
Sbit (EA   , 0xA8, 7);

void timer0_init(void) 
{

TH0 = TH0RELOAD; // zaladowanie czasu odliczania
TL0 = TL0RELOAD;
TMOD = TMOD | 0x01; // tryb 1 ukladu Timer0
TR0 = 1; // Timer0 start
ET0 = 1; // odblokowanie przerwan od Timer0
}

void Delay(WORD czas)
           {
		   BYTE i;
           ET0 = 0;
           ET0 = 1;
		   for (i=0; i<czas; i++) {}

		   }

//------glowna-----------------
void main (void)
{
timer0_init(); // przygotowanie ukladu Timer0

while (1)
      {


	  cos tam.....
	  Delay(wartosc); 
          cos tam.....
}

	 LJMP START
	 ORG 100H
START:
	 ...
	 LCALL CZEKAJ
	 ...
	 LJMP START

CZEKAJ:
	 MOV R0,#255
	 MOV R1,#255
	 MOV R2,#255
ODLICZAJ:
	 DJNZ R2,ODLICZAJ
ODLICZAJ1:
	 DJNZ R1,ODLICZAJ1
ODLICZAJ2:
	 DJNZ R0,ODLICZAJ2
	 RET