option autorun on
for i = 2 to 4
setpin i,dout
next i

const red = 2, green = 3, amber = 4
pause 1000


do
d = distance(15,16)
select case (d)
case is <= 15 'If distance to wall is 15cm or less red LED will come on solid
mustStop
case is <= 40 'If distance is 40 cm or less and greater than 15cm red and amber LED's will flash
prepareToStop
case is <= 100 'If distance is a metre or less and greater than 40cm amber LED will flash
caution
case else 'If distance is greater than a metre the green LED will come on solid
allClear
end select
loop

sub mustStop
pin(red) = 1
pin(green) = 0
pin(amber) = 0
? d, "cm STOP NOW!"
pause 200
end sub

SUB prepareToStop
pin(red) = 0
pin(amber) = 1
pin(green) = 0
pause 100
? d, "cm Prepare to STOP"
pin(red) = 1
pin(amber) = 0
pin(green) = 0
PAUSE 100
END SUB

sub caution
pin(red) = 0
pin(amber) = 1
pin(green) = 0
pause 100
pin(red) = 0
pin(amber) = 0
pin(green) = 0
? d, "cm CAUTION"
pause 100
end sub

sub allClear
pin(red) = 0
pin(amber) = 0
pin(green) = 1
pause 500
? d
pin(green) = 0
pause 500
end sub

sub allClear
pin(red) = 0
pin(amber) = 0
pin(green) = 1
pause 10 'make this pause shorter and comment out the other
? d
pin(green) = 0
' pause 500
end sub