"3D Localization for a Mars Rover Prototype"
In this paper we consider the problem of localizing a mo bile robot on uneven terrain. The localization problem is decomposed into two stages; attitude estimation followed by position estimation. The innovation of our method is the use of a smoother, in the attitude estimation loop that outperforms other Kalman filter based techniques in esti mate accuracy. The smoother exploits the special nature of the data fused; high frequency inertial sensor (gyroscope) data and low frequency absolute orientation data (from a compass or sun sensor). Two Kalman filters form the smoother. During each time interval one of them prop agates the attitude estimate forward in time until it is up dated by an absolute orientation sensor. At this time, the second filter propagates the recently renewed estimate back in time. The smoother optimally exploits the limited ob servability of the system by combining the outcome of the two filters. The system model uses gyro modeling which relies on integrating the kinematic equations to propagate the attitude estimates and obviates the need for complex dynamic modeling. The Indirect (error state) form of the Kalman filter is developed for both parts of the smoother. The proposed approach is independent of the robot struc ture and the morphology of the ground. It can easily be transfered to another robot which has an equivalent set of sensors. Quaternions are used for the 3D attitude rep resentation, mainly for practical reasons discussed in the paper. The proposed innovative algorithm is tested in sim ulation and the overall improvement in position estimation is demonstrated.