<< Go Back

ด้วยหลักการตรวจสอบการสะท้อนที่พื้น ทำให้รถรถหุ่นยนต์แยกแยะได้ว่าตำแหน่งใด มีการสะท้อนหรือไม่มีการสะท้อน จึงนำแนวคิดนี้ไปประยุกต์กับการสำรวจเส้นทาง การเคลื่อนที่ของรถหุ่นยนต์ให้รถหุ่นยนต์เคลื่อนที่อยู่ในพื้นที่ที่กำหนดได้
จากแผงวงจรตรวจจับแสงอินฟราเรดสะท้อนที่ติดตั้งด้านหน้าของตัวรถหุ่นยนต์ เมื่อรถหุ่นยนต์เคลื่อนที่อยู่บริเวณพื้นโต๊ะซึ่งเป็นสีขาว ก็จะเกิดการสะท้อนกลับของแสง ผู้ใช้งานสามารถสั่งให้รถหุ่นยนต์เคลื่อนที่ไปด้านหน้าได้ แต่แผงวงจรตรวจจับออกนอกพื้นที่โต๊ะ จะไม่เกิดการสะท้อนกลับของแสง ผู้ใช้งานต้องสั่งให้รถหุ่นยนต์ถอยหลัง แล้วเปลี่ยนทิศทางจากตำแหน่งนั้น ไปยังทิศทางด้านอื่นๆ ของโต๊ะ

โปรแกรมจะทำการวนลูปตรวจสอบว่าค่าของ Senor

มีค่ามากกว่า 100 หรือไม่ ถ้ามากกว่าโปรแกรมจะสั่งให้มอเตอร์ A และ มอเตอร์ B หมุนเดินหน้า

ถ้าโปรแกรมจะทำการวนลูปตรวจสอบว่า sensor 0  ว่าค่าน้อยกว่า 100

โปรแกรมจะสั่งให้มอเตอร์ A ถอยหลัง 50 หน่วย และมอเตอร์ B ถอยหลังเป็นค่าสุ่ม

ถ้าโปรแกรมจะทำการวนลูปตรวจสอบว่า sensor 1 และ มีค่าน้อยกว่า 100

โปรแกรมจะสั่งให้มอเตอร์ B ถอยหลัง 60 หน่วย และมอเตอร์ A ถอยหลังเป็นค่าสุ่ม

แสดงรูปตัวอย่างการทำงาน

 

<< Go Back