เดินไปแล้วเดินกลับ

โจทย์ข้อ1 โปรแกรมให้หุ่นยนต์เดินไปข้างหน้า แล้วหมุนตัว180องศา และเดินกลับมา และหมุนตัวอีก180องศา

' {$STAMP BS2sx}
' {$PBASIC 2.5}
PAUSE 1000
Main: GOSUB Forward : PAUSE 1177
GOSUB S_Right : PAUSE 350
GOSUB Forward : PAUSE 1177
GOSUB S_Right : PAUSE 300
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