วันพฤหัสบดีที่ 2 สิงหาคม พ.ศ. 2550

เดินเป็นรูป3เหลี่ยม

โจทยที่2 โปรแกรมให้หุ่นยนต์เดินเป็น3เหลี่ยม ด้านเท่า

' {$STAMP BS2sx}
' {$PBASIC 2.5}
PAUSE 1000
Main: GOSUB S_Right : PAUSE 90
GOSUB forward : PAUSE 1177
GOSUB S_Right : PAUSE 310
GOSUB forward : PAUSE 1177
GOSUB S_Right : PAUSE 290
GOSUB forward : PAUSE 1177
GOSUB S_Right : PAUSE 100
GOSUB motor_off : PAUSE 2000
GOTO Main
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
Motor_off:LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN

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