สามเหลี่ยม

โจทย์ข้อ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