วันอาทิตย์ที่ ๔ พฤศจิกายน พ.ศ. ๒๕๕๐

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
เขียนโดย ที่ ไม่มีความคิดเห็น:

วันพุธที่ ๑๙ กันยายน พ.ศ. ๒๕๕๐

sensor ใกล้ที่สุด

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
ADC VAR Word
R VAR Word
I VAR Byte
X VAR Word

PAUSE 1000
HIGH 10
DO
GOSUB forward
GOSUB RD_ADC
IF ( ADC > 385 ) THEN
GOSUB backward : PAUSE 80
GOSUB motor_off : PAUSE 10000
ENDIF
LOOP

RD_ADC: LOW 10 : PAUSE 1 : HIGH 10
SEROUT 10,240,[1]
SERIN 10,240,[ADC.BYTE0,adc.BYTE1]
RETURN
Error: DEBUG "Error Reading" , CR
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
เขียนโดย ที่ ไม่มีความคิดเห็น:

sensor 5cm

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
ADC VAR Word
R VAR Word
I VAR Byte
X VAR Word

PAUSE 1000
HIGH 10
DO
GOSUB forward
GOSUB RD_ADC
IF ( ADC > 250 ) THEN
GOSUB backward : PAUSE 80
GOSUB motor_off : PAUSE 10000
ENDIF
LOOP

RD_ADC: LOW 10 : PAUSE 1 : HIGH 10
SEROUT 10,240,[1]
SERIN 10,240,[ADC.BYTE0,adc.BYTE1]
RETURN
Error: DEBUG "Error Reading" , CR
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
เขียนโดย ที่ ไม่มีความคิดเห็น:

sensor 3cm

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
ADC VAR Word
R VAR Word
I VAR Byte
X VAR Word

PAUSE 1000
HIGH 10
DO
GOSUB forward
GOSUB RD_ADC
IF ( ADC > 320 ) THEN
GOSUB backward : PAUSE 80
GOSUB motor_off : PAUSE 10000
ENDIF
LOOP

RD_ADC: LOW 10 : PAUSE 1 : HIGH 10
SEROUT 10,240,[1]
SERIN 10,240,[ADC.BYTE0,adc.BYTE1]
RETURN
Error: DEBUG "Error Reading" , CR
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
เขียนโดย ที่ ไม่มีความคิดเห็น:

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

โคด 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
เขียนโดย ที่ ไม่มีความคิดเห็น:

แผนผัง

แผนผัง
เขียนโดย ที่ ไม่มีความคิดเห็น:

วันเสาร์ที่ ๒๕ สิงหาคม พ.ศ. ๒๕๕๐

โคดสอบ

' {$PBASIC 2.5}
' {$PORT COM2}
' {$STAMP BS2sx}
a VAR Word
b VAR Word
c VAR Word
d VAR Word
PAUSE 2000
a = 0
b = 0
c = 0
d = 0
GOSUB forward : PAUSE 1177
GOSUB S_left : PAUSE 205
DO
a = a + 1
GOSUB T_RIGHT : PAUSE 20
GOSUB FORWARD : PAUSE 15
LOOP UNTIL ( a = 75 )
DO
b = b + 1
GOSUB T_Left : PAUSE 21
GOSUB FORWARD : PAUSE 15
LOOP UNTIL ( b = 90 )
DO]
c = c + 1
GOSUB T_RIGHT : PAUSE 20
GOSUB FORWARD : PAUSE 15
LOOP UNTIL ( c = 80 )
GOSUB forward : PAUSE 2344
DO
d = d + 1
GOSUB T_Right : PAUSE 20
GOSUB forward : PAUSE 5
LOOP UNTIL ( d = 50 )
GOSUB forward : PAUSE 4288
GOSUB S_RIGHT : PAUSE 370
GOSUB motor_off : PAUSE 3000
forward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN
backward: HIGH 12 : LOW 13 : HIGH 14 : LOW 15 : RETURN
S_right: HIGH 13 : LOW 12 : HIGH 14 : LOW 15 : RETURN
S_left: HIGH 12 : LOW 13 : HIGH 15 : LOW 14 : RETURN
T_left: LOW 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN
T_right: HIGH 13 : LOW 12 : LOW 15 : LOW 14 : RETURN
Motor_off:LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN
เขียนโดย ที่ ไม่มีความคิดเห็น:
สมัครสมาชิก: บทความ (Atom)