Witam, proszę o sprawdzenie programu, który ma polegać na prosto silniki 1s przerwy, tył 1s przerwy itd. Proszę o pomoc.

$regfile = "m88def.dat"
$crystal = 16000000
'Konfiguracja sterowania sprzętowym PWM
Config Timer1 = Pwm , Pwm = 8 , Prescale = 1 , Compare A Pwm = Clear Down , Compare B Pwm = Clear Down
'Konfiguracja portów
Config Portb = Output
Config Portd = &B01111111
Config Portc = Input
Portd.7 = 1
Przycisk Alias Pind.7
Led Alias Portd.6
Enable_a Alias Portb.1
Enable_b Alias Portb.2
Silnik_prawy_a Alias Portd.3
Silnik_prawy_b Alias Portd.2
Silnik_lewy_a Alias Portd.1
Silnik_lewy_b Alias Portd.0
Bitwait Bit , Set | Reset
Bitwait Pind.7 , Reset 'czekaj aż 7 linia portu D będzie w stanie 0.
Do
'Obrót w jedną stronę
Set Silnik_prawy_a
Reset Silnik_lewy_b
Wait 1
'Obrót w stronę przeciwną
Reset Silnik_prawy_a
Set Silnik_lewy_b
Wait 1
'Stop
Reset Silnik_prawy_a
Reset Silnik_lewy_b
Wait 1
Loop
End