เขาวงกต

อาจารย์ให้สั่งให้หุ่นเดินเขาวงกตดังรูป
โดยอาจารย์ให้ใช้อุปกรณ์ตรวจจับการชน
หลัก

‘ {$STAMP BS2sx}
‘ {$PBASIC 2.5}
a var word
a=0

loop
gosub f
if ( in1=0)*or( in2=0)* do (ถ้าชนให้)
gosub bw. :pause 250
gosub tr. :pause 250 (ถอยหลังแล้วเลี้ยว)
a=a+1
loopuntil (a=2)
จากนั้นก็ให้ชนแล้วเลี้ยวซ้าย,ขวา,ขวา,ซ้าย ตามลำดับ
f: HIGH 13 : LOW 12 : HIGH 15 : LOW 14 :RETURN
r: LOW 13 : HIGH12 : HIGH 15 : LOW 14 : RETURN
l: HIGH 13 : LOW 12 : LOW 14 :HIGH15 : RETURN


*ค่าอุปกรณ์ตรวจจับการชน (ไม่ชน=1,ชน=0)