Trajectory Tracking and Fault Detection Algorithm for Automatic Guided Vehicle Based on Multiple Positioning Modules

摘要

This paper presents an implementation and experimental validation of trajectory tracking and fault detection algorithm for sensors and actuators of Automatic Guided Vehicle (AGV) system based on multiple positioning modules. Firstly, the system description and the mathematical modeling of the differential drive AGV system are described. Secondly, a trajectory tracking controller based on the backstepping method is proposed to track the given trajectory. Thirdly, a fault detection algorithm based on the multiple positioning modules is proposed. The AGV uses encoders, laser scanner, and laser navigation system to obtain the position information. To understand the characteristics of each positioning module, their modeling are explained. The fault detection method uses two or more positioning systems and compares them using Extended Kalman Filter (EKF) to detect an unexpected deviation effected by fault. The pairwise differences between the estimated positions obtained from the sensors are called as residue. When the faults occur, the residue value is greater than the threshold value. Fault isolation is obtained by examining the biggest residue. Finally, to demonstrate the capability of the proposed algorithm, it is applied to the differential drive AGV system. The simulation and experimental results show that the proposed algorithm successfully detects the faults when the faults occur.