งานสวิดแสง

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
ADC VAR Word
R VAR Word
I VAR Byte
X VAR Word
ko VAR Word
PAUSE 1000
HIGH 10
GOSUB forward
GOSUB RD_ADC IF ( ADC > 75) THEN
DO GOSUB motor_off
LOOP UNTIL(ko=1)
ENDIF
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
Motor_off:LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN _________________________________________________________________ Don't just search. Find. Check out the new MSN Search! http://search.msn.com/

งานทัดสวิด

' {$STAMP BS2Sx}
' {$PBASIC 2.5}
PAUSE 1000
main:GOSUB forward
GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 500
GOSUB s_right : PAUSE 200
ENDIF
GOSUB forward GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 480
GOSUB s_right : PAUSE 200
ENDIF
GOSUB forward GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 480
GOSUB s_left : PAUSE 200
ENDIF GOSUB forward
GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 480
GOSUB s_right : PAUSE 200
ENDIF
GOSUB forward
GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 480
GOSUB s_right : PAUSE 200
ENDIF GOSUB forward
GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 480
GOSUB s_left : PAUSE 200
ENDIF
GOSUB forward
GOSUB soso
IF (IN4 = 0) OR (IN6 = 0) THEN
GOSUB backward : PAUSE 480
GOSUB s_left : PAUSE 200
ENDIF
GOSUB forward : PAUSE 260
GOSUB motor_off
GOTO main
forward: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN
backward: LOW 13 : HIGH 12 : LOW 15 : HIGH 14 : RETURN
s_right: LOW 13 : HIGH 12 : HIGH 15 : LOW 14 : RETURN
s_left : HIGH 13 : LOW 12 : LOW 15 : HIGH 14 : RETURN
motor_off: LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN
soso: DO
LOOP UNTIL((IN4 = 0) OR (IN6 = 0)) : RETURN