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

' {$STAMP BS2sx}
' {$PBASIC 2.5}
' {$PORT COM1}
PAUSE 1000
main: GOSUB u_turn : PAUSE 100
 GOSUB forward : PAUSE 750
 GOSUB u_turn : PAUSE 220
 GOSUB forward : PAUSE 750
 GOSUB u_turn : PAUSE  220
 GOSUB forward : PAUSE 750
 GOSUB u_turn : PAUSE 200
 GOSUB motor_stop : PAUSE 10000
 GOTO main
u_turn : LOW 13 : HIGH 12 : HIGH 15 : LOW 14 : RETURN
forward : HIGH 13 : LOW 12 : HIGH 15 : LOW 14 : RETURN
motor_stop : LOW 13 : LOW 12 : LOW 15 : LOW 14 : RETURN