Code: Select all
$regfile="m8def.dat"
$hwstack=40
$swstack=16
$framesize=32
Daljinski Alias Pinc.0
L Alias Pinc.2
D Alias Pinc.1
Relej_desno Alias Portc.5
Relej_lijevo Alias Portc.4
Ddrc=&B00110000
Dim Pom As Bit, Smjer As Bit
L=0
D=0
Do
pom=0
Relej_lijevo =0
Relej_desno =0
If L=1 or D=1 Then
Debounce Daljinski, 1, VRTI, Sub
End if
If L=0 and D=0 Then
Debounce Daljinski, 1, VRTI2, Sub
End if
Loop
VRTI:
If L= 1 Then
gosub DESNO
End if
if pom=1 Then Return
If D= 1 Then
Gosub LIJEVO
End if
Return
DESNO:
Smjer=0
Pom=1
Wait 2
Relej_desno =1
Relej_lijevo =0
If Daljinski =1 Then Return
If D=1 Then Return
Goto DESNO
LIJEVO:
Smjer=1
Pom=1
Wait 2
Relej_lijevo =1
Relej_desno =0
If Daljinski =1 Then Return
If L=1 Then Return
Goto LIJEVO
VRTI2:
If Smjer= 1 Then
Gosub DESNO
End if
if pom=1 Then Return
If Smjer= 0 Then
Gosub LIJEVO
End if
Return