-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.
서 론The articulated vehicle is a new type of public transportation to combine the advantage of commuter buses and railroad vehicles. To achieve good tracking performance similar to railroad vehicle, these vehicles have to be equipped with a lateral guidance system. Such a lateral guidance system requires informations about the vehicles position to calculate the tracking errors relative to the path to be followed. In most cases, the absolute position of the vehicle cannot be measured continuously. msec. It turns out that the information necessary for the guidance control should be estimated at the intermediate time when the magnetic sensors are moving from a marker to next marker, so that this is continuously available for guidance control. Furthermore, it is required to estimate the position and orientation without large errors for the case that the MMS fails to detect three markers consecutively.In this paper, we propose an observer of estimating the vehicle position and orientation. The estimator is composed of an integration algorithm based on vehicle kinematic model, EKF, position update algorithm and orientation angle compensation algorithm using the MMS data. The EKF is used to calculate the vehicle velocity and the side-slip angle at a reference point of the vehicle by using wheel encoders and steering angles data. This is the similar method as one in [5]. The MMS update algorithm is used for estimating the absolute position of vehicle and the orientation angle compensation algorithm