Projekt z 8051

[rafalgsxr]

Witam,
Mam za zadanie w projekcie wykonać sam algorytm programu ten, co wkleiłem jest to program główny. Mój temat projektu to Układ do regulacji stabilizacji prędkości obrotowej silnika komutatorowego napięcia przemiennego. Program ma działać tak: wykrywam moment przejścia sinusa przez 0 i odliczam czas, po którym ma zostać stan wysoki na pin P3.4, na którym znajduje sie Triak, który załącza mój silnik następnie uruchamiam Timer do zliczania obrotów w przerwaniu Odczytuje tą wartość oraz wpisuje do rejestru a później zeruje Timer. Następnie obliczam obroty oraz wyświetlam je na wyświetlaczu. Teraz mam prośbę czy mógłby mi ktoś sprawdzić ten algorytm i ewentualnie powiedzieć gdzie mam błędy? Wszelka pomoc mile widziana.