วันศุกร์ที่ ๗ กันยายน พ.ศ. ๒๕๕๐

โคด Touch Switch

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
PAUSE 2000
GOSUB forward
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_LEFT : PAUSE 190
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_LEFT : PAUSE 190
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_right : PAUSE 190
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_left : PAUSE 190
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_left : PAUSE 190
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_right : PAUSE 190
GOSUB idea
GOSUB backward : PAUSE 400
GOSUB S_right : PAUSE 190
GOSUB idea
END

forward: 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
idea:
GOSUB forward
DO
LOOP UNTIL ( IN1 = 0 ) OR ( IN6 = 0 )
RETURN

ไม่มีความคิดเห็น: