basic stamp การเขียนโปรเเกรมหุ่นยนต์ เบื่องต้น
' {$STAMP BS2p}
' {$PORT COM1}
loopright VAR Word
loopdelay VAR Word
GOSUB MotorReturnRight45
GOSUB delay
loop:
GOSUB MotorReturnRight135
GOSUB delay
GOTO loop
'########## Delay ##########
delay:
FOR loopdelay= 1 TO 50
PULSOUT 13,1250
PULSOUT 14,2500
PAUSE 20
NEXT
RETURN
'########### motorforward ###########
motorforward:
PULSOUT 13,1250
PULSOUT 14,2500
PAUSE 20
RETURN
'######### motorreturnright45 ##########
motorreturnright45:
FOR loopright= 1 TO 20
PULSOUT 13,2500
PULSOUT 14,2500
PAUSE 20
NEXT
RETURN
'############ motorreturnright135 ###########
motorreturnright135:
FOR loopright= 1 TO 50
PULSOUT 13,2500
PULSOUT 14,2500
PAUSE 20
NEXT
RETURN
ข้อความข้างต้น เป็นชุดคำสั่ง ให้หุ่นยนต์เดินเป็นรูปสามเหลี่ยม
' {$STAMP BS2p}
' {$PORT COM1}
loopleft VAR Word
loopright VAR Word
loopstraight VAR Word
loopmain:
IF(IN4=0 AND IN3=0 AND IN1=1 AND IN0=1) THEN motorBackward
IF(IN4=0 AND IN3=1 AND IN1=1 AND IN0=1) THEN motorEvadeleft
IF(IN4=1 AND IN3=0 AND IN1=1 AND IN0=1) THEN motorEvadeRight
IF(IN4=1 AND IN3=1 AND IN1=1 AND IN0=0) THEN motorforward
IF(IN4=1 AND IN3=1 AND IN1=1 AND IN0=1) THEN motorforward
IF(IN4=1 AND IN3=1 AND IN1=1 AND IN0=0) THEN motorforward
IF(IN4=1 AND IN3=1 AND IN1=1 AND IN0=1) THEN motorforward
GOTO loopmain
'##########motorforward###########
motorforward:
PULSOUT 13,1250
PULSOUT 14,2500
PAUSE 20
GOTO loopmain
'##########motorbackward##########
motorbackward:
FOR loopstraight=1 TO 5
PULSOUT 13,2500
PULSOUT 14,1250
PAUSE 20
NEXT
GOTO loopmain
'#########motorevaderight#########
motorevaderight:
FOR loopright=1 TO 40
PULSOUT 13,2500
PULSOUT 14,1250
PAUSE 20
NEXT
FOR loopright=1 TO 20
PULSOUT 13,1250
PULSOUT 14,1250
PAUSE 20
NEXT
GOTO loopmain
'#########motorevadeLeft########
motorevadeleft:
FOR loopleft=1 TO 40
PULSOUT 13,2500
PULSOUT 14,1250
PAUSE 20
NEXT
FOR loopleft=1 TO 20
PULSOUT 13,2500
PULSOUT 14,2500
PAUSE 20
NEXT
GOTO loopmain
ชุดโปรแกรมเป็นชุดควบคุมการทำงานของหุ่นยนต์เพื่อหลบหลีกสิ่งกีดขวาง
โดยเราสามารถใช้โปรเเกรม basic stamp ในการเขียนโปรเเกรมได้
โดยเราสามารถหัดเขียนโปรเเกรมได้จาก หนังสือ "คู่มือการใช้งาน et-robot stamp p40"