Title |
Position and Orientation Estimation of a Maneticalluy Guided-Articulated Vehicle |
Authors |
윤경한(Yun, Kyong-Han) ; 김영철(Kim, Young-Chol) ; 민경득(Min, Kyung-Deuk) ; 변윤섭(Byun, Yeun-Sub) |
DOI |
https://doi.org/10.5370/KIEE.2011.60.10.1915 |
Keywords |
Magnetically guided-articulated vehicle ; Position estimation ; Orientation estimation |
Abstract |
For automated guidance control of a magnetically guided-all wheel steered vehicle, it is necessary to have information about position and orientation of the vehicle, and deviations from the reference path in real time. The magnet reference system considered here consists of three magnetic sensors mounted on the vehicle and magnetic markers, which are non-equidistantly buried in the road. This paper presents an observer to estimate such position and orientation at the center of gravity of the vehicle. This algorithm is based on the simple kinematic model of vehicle and uses the data of wheel velocity, steering angle, and the discrete measurements of marker positions. Since this algorithm requires the exact values of initial states, we have also proposed an algorithm of determining the initial position and orientation from the 16 successive magnet pole data, which are given by the magnetic measurement system(MMS). The proposed algorithm is capable of continuing to estimate for the case that the magnetic sensor fail to measure up to three successive magnets. It is shown through experimental data that the proposed algorithm works well within permissible error range. |