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 main
timeout: LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN
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

Map 2 ( เก๋ากว่าเดิม )

Map หุนยนต์

สรุปโปรแกรมหุนยนต์ทั้งหมด

' {$STAMP BS2sx}
' {$PBASIC 2.5}
PAUSE 1000
MAIN : GOSUB FORWARD : PAUSE 950
GOSUB BACKWARD : PAUSE 950
GOSUB MOTOR_OFF : PAUSE 10000
GOTO Main
Forward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN Backward: HIGH 12 : LOW 13 : HIGH 14 : LOW 15 : RETURN motor_off:LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN

เดินหน้าแล้วถอยหลัง

' {$STAMP BS2sx}
' {$PBASIC 2.5}
PAUSE 1000
MAIN : GOSUB FORWARD : PAUSE 1000
GOSUB S_RIGHT : PAUSE 185
GOTO Main Forward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN S_right: HIGH 12 : LOW 13 : HIGH 15 : LOW 14 : RETURN

เดินหน้าแล้วเลี้ยวขวา

' {$STAMP BS2sx}
' {$PBASIC 2.5}
PAUSE 1000
MAIN : GOSUB FORWARD : PAUSE 1000
GOSUB T_LEFT : PAUSE 500
GOSUB FORWARD : PAUSE 1000
GOSUB T_RIGHT : PAUSE 500
GOSUB FORWARD : PAUSE 1000
GOSUB S_LEFT : PAUSE 500
GOSUB BACKWARD : PAUSE 1000
GOSUB S_RIGHT : PAUSE 500
GOSUB forward : PAUSE 1000
GOSUB MOTOR_OFF : PAUSE 3000
GOTO Main Forward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN Backward: HIGH 12 : LOW 13 : HIGH 14 : LOW 15 : RETURN T_left: HIGH 13 : LOW 12 : LOW 15 : LOW 14 : RETURN T_right: LOW 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN S_left: HIGH 13 : LOW 12 : HIGH 14 : LOW 15 : RETURN S_right: HIGH 12 : LOW 13 : HIGH 15 : LOW 14 : RETURN motor_off:LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN

เดินหน้าเลี้ยวซ้ายเลี้ยวขวาหมุนตัวซ้ายหมุนตัวขวาหยุด

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
PAUSE 1000 main: GOSUB forward : PAUSE 1000
GOSUB U_turn : PAUSE 298
GOSUB forward : PAUSE 1000
GOSUB U_turn : PAUSE 265
GOSUB motor_stop : PAUSE 10000
GOTO main forward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN U_turn : LOW 13 : HIGH 12 : HIGH 15 : LOW 14 : RETURN motor_stop : LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN

เดินหน้าหมุนขวาเดินหน้าหมุนขวาหยุด

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM2}
PAUSE 1000 Main: GOSUB Forward : PAUSE 1700
GOSUB S_Left : PAUSE 500
GOTO MAIN Forward : HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN S_Left : HIGH 13 : LOW 12 : LOW 14 : LOW 15 : RETURN
เดินหน้าเลี้ยวซ้าย

โปรแกรมหุนยนต์4

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM2}
ko VAR Word
PAUSE 1000
main:GOSUB forward : PAUSE 800
ko = 0
DO
GOSUB forward : PAUSE 10
GOSUB r_turn : PAUSE 12
ko = ko + 1
LOOP UNTIL ( ko = 86 )
GOSUB forward : PAUSE 800
GOSUB motor_stop : PAUSE 10000
GOTO main forward : HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN r_turn : LOW 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN motor_stop : LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN

โปรแกรมหุนยนต์3

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
PAUSE 1000
main: GOSUB u_turn : PAUSE 100
GOSUB forward : PAUSE 750
GOSUB u_turn : PAUSE 220
GOSUB forward : PAUSE 750
GOSUB u_turn : PAUSE 220
GOSUB forward : PAUSE 750
GOSUB u_turn : PAUSE 200
GOSUB motor_stop : PAUSE 10000
GOTO
main u_turn : LOW 13 : HIGH 12 : HIGH 15 : LOW 14 : RETURN forward : HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN motor_stop : LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN