<< Go Back

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

โดยเราจะทำการติดอุปกรณ์ดังกล่าวไว้บริเวณด้านหน้าของรถหุ่นยนต์

โปรแกรมจะสั่งงานให้รถหุ่นยนต์เคลื่อนที่ไปด้านหน้า แล้วตรวจสอบอ่านข้อมูลจาก sensor ว่าค่าที่อ่านได้มากกว่า 300 หรือไม่   โดยเราจะใช้   if  then   เพื่อเปรียบเทียบเงื่อนไขโดยในที่นี้เราจะเปรียบเทียบเงื่อนไขของ 

    

ถ้าโมดูลตรวจจับระยะทางแบบอินฟราเรดรับค่า  > 300  ตามที่กำหนดในโปรแกรม  จะแสดงให้เห็นว่ามีวัตถุกีดขวางอยู่ด้านหน้า   เราจะต้องทำการจะต้องสั่งให้รถหุ่นยนต์ถอยหลังแล้วเลี้ยวขวา โดยระยะการเลี้ยวกำหนดเป็นค่าสุ่ม (Random) ทำให้ระยะเลี้ยวแต่ละครั้งจะไม่เท่ากัน

 

<< Go Back