Remote Control

' {$STAMP BS2sx}
' {$PBASIC 2.5}
KEY VAR Byte
main: DO
SERIN 3,2063,250,timeout,[KEY]
IF KEY = "D" OR KEY = "d" THEN GOSUB forward
IF KEY = "A" OR KEY = "a" THEN GOSUB backwarD
IF KEY = "C" OR KEY = "c" THEN GOSUB t_left
IF KEY = "B" OR KEY = "b" THEN GOSUB t_right
LOOP
GOTO maintimeout: LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURNf
orward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN
backward: HIGH 12 : LOW 13 : HIGH 14 : LOW 15 : RETURN
S_left: HIGH 13 : LOW 12 : HIGH 14 : LOW 15 : RETURN
S_Right: HIGH 12 : LOW 13 : HIGH 15 : LOW 14 : RETURN
T_Right: LOW 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN
T_LEFT: HIGH 13 : LOW 12 : LOW 15 : LOW 14 : RETURN
Motor_off:LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN