자기적 안내제어시스템을 이용하는 굴절차량의 위치 및 방위각 추정

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.