การเขียนโปรแกรมควบคุมรถหุ่นยนต์เคลื่อนที่หลบสิ่งกีดขวางโดยใช้ โมดูลตรวจจับระยะทาง
แบบอินฟราเรด อาศัยคุณสมบัติของโมดูลในการวัดระยะทางที่ให้ค่ามากหรือน้อยตามระยะของวัตถุที่ตรวจพบ จากนั้นเราจะทำการเขียนโปรแกรมเพื่อออกแบบ รูปแบบการเดินของรถหุ่นยนต์เพื่อหลบหลีกสิ่งกีดขวาง
ในการเขียนโปรแกรมนั้นเราจะใช้โมดูลตรวจจับ ระยะทางแบบอินฟราเรด ที่สามารถวัดระยะทาง ได้ถูกต้อง GP2D120 วัดระยะทางในช่วง 3 - 40 เซนติเมตร โดยให้ผลการตรวจจับเป็นแรงดันไฟตรง ในย่าน 0.4 - 2.4V ประกอบด้วยตัวส่ง และตัวรับอินฟราเรด ที่ติดตั้ง ภายใต้ ตัวถัง เดียวกัน จะทำงานทันทีที่มีไฟเลี้ยง 5V จ่ายให้โดยตัวส่ง อินฟราเรด จะขับแสงอินฟราเรด จาก ตัวมันตลอดเวลา และเมื่อใดที่มีวัตถุมาขวางกั้น ทำให้เกิดการสะท้อนของแสงอินฟราเรดกลับไปยังตัวรับภายใน
โดยเราจะทำการติดอุปกรณ์ดังกล่าวไว้บริเวณด้านหน้าของรถหุ่นยนต์
โปรแกรมจะสั่งงานให้รถหุ่นยนต์เคลื่อนที่ไปด้านหน้า แล้วตรวจสอบอ่านข้อมูลจาก sensor ว่าค่าที่อ่านได้มากกว่า 300 หรือไม่ โดยเราจะใช้ if then เพื่อเปรียบเทียบเงื่อนไขโดยในที่นี้เราจะเปรียบเทียบเงื่อนไขของ
ถ้าโมดูลตรวจจับระยะทางแบบอินฟราเรดรับค่า > 300 ตามที่กำหนดในโปรแกรม จะแสดงให้เห็นว่ามีวัตถุกีดขวางอยู่ด้านหน้า เราจะต้องทำการจะต้องสั่งให้รถหุ่นยนต์ถอยหลังแล้วเลี้ยวขวา โดยระยะการเลี้ยวกำหนดเป็นค่าสุ่ม (Random) ทำให้ระยะเลี้ยวแต่ละครั้งจะไม่เท่ากัน
|