วันพุธที่ 1 สิงหาคม พ.ศ. 2550

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

จากที่ผมได้โปรแกรมหุ่นยนต์ ทำให้ผมได้รู้ว่าการที่เราอยากให้หุ่นยนต์เดินไปข้างหน้าจากนั้นหมุนตัวแล้วเดินกับมา
' {$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

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