Να το.
'{$STAMP BS2}
BaffoSX var in6
BaffoDX var in4
PBin var in2
ricIR_SX var bit
ricIR_DX var bit
output 7
output 1
statoBaffi var nib
M1a con 14
M1b con 15
M2a con 5
M2b con 3
Aspetta:
if PBin = 1 then Aspetta
pause 500
main:
freqout 7, 1, 38500
ricIR_SX = in8
freqout 1, 1, 38500
ricIR_DX = in0
if ricIR_SX =0 OR ricIR_DX = 0 then goback
if BaffoDX = 0 AND BaffoSX = 0 then InvertiMarcia
if BaffoDX = 1 AND BaffoSX=0 then DeviaDestra
if BaffoDX=0 AND BaffoSX=1 then DeviaSinistra
if PBin =0 then stopp
if BaffoDX=1 AND BaffoSX=1 then Avanza
goto main
DeviaDestra:
high M1a: low M1b
pause 50
low M2a: high M2b
pause 300
high M1a: low M1b:
pause 50
high M2a: low M2b:
pause 300
goto main
DeviaSinistra:
high M1a: low M1b
pause 50
low M2a: high M2b
pause 300
low M1a: high M1b:
pause 50
low M2a: high M2b:
pause 300
goto main
Avanza:
low M1a: high M1b
pause 50
high M2a: low M2b:
pause 300
goto main
InvertiMarcia:
high M1a: low M1b:
pause 50
low M2a: high M2b:
pause 1000
low M1a: high M1b:
pause 50
low M2a: high M2b:
pause 3000
goto main
stopp:
low 14: low 15
pause 50
low 3: low 5
pause 500
goto Aspetta
goback:
' ---------------------------------------------------- πίσω ---------------------------------------------------------------
low 5: high 3
low 15: high 14
pause 500
low 14: high 15
low 5: high 3
pause 1500
low 5: low 3
low 14:low 15
pause 50
goto main