@@ -276,6 +276,7 @@ lock
bsf PORTA, 5
call delay100 ; Blocking 100ms delay
bsf PORTA, 4 ; Stop the motor
+ call delay1000
goto idle
@@ -316,14 +317,25 @@ delay_wait
bcf T0CON, TMR0ON ; Stop the timer
return
+delay500
+ movlw d'5'
+ movwf DLYCOUNT
+ goto delay_repeat
+
+delay1000
+ movlw d'10'
delay2000
movlw d'20'
movwf DLYCOUNT
-delay2000_repeat
+delay_repeat
call delay100
decfsz DLYCOUNT, f
- goto delay2000_repeat
end