PID+Fuzzy Controller Design for Obstacle Avoidance of Indoor Mobile Robot / การออกแบบตัวควบคุมพีไอดี+ฟัซซีสำหรับการหลบหลีกสิ่งกีดขวาง ของหุ่นยนต์เคลื่อนที่ภายในอาคาร

บทคัดย่อ

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

คำสำคัญ: หุ่นยนต์เคลื่อนที่  หลบหลีกสิ่งกีดขวาง  ตัวควบคุมฟัซซีลอจิก    

Abstract

This article presents the fuzzy logic controller used for motion control of 2-wheel mobile robot. The trajectory planning in cartesian space and PID controller is applied to track specified path toward a desired target point and to avoid the obstacle automatically. In this work, experimentations of the proposed algorithm for autonomous mobile robot can help to replace workers for material handling in factory or warehouse.  Motion simulation using a mathematical model of differential drive mobile robot is performed by MATLAB/Simulink software. Simulation results show that the fuzzy-PID controller can control mobile robot to move along desired path toward the target, and then the fuzzy logic controller is able to generate a new path for mobile robot to avoid the obstacle when mobile robot detects the obstacle in original planned path and distance error when mobile robot reaches the target is less than 0.025 meters.

Keywords: Mobile Robot, Obstacle Avoidance, Fuzzy Logic Controller