An Attitude Estimation Algorithm for Mobile Robots Under Unknown Magnetic Disturbances

摘要

Attitude estimation is a crucial aspect for navigation and motion control of autonomous vehicles. This concept is particularly true in the case of unavailability of localization sensors when navigation and control rely on dead reckoning strategies; in this case, indeed, the orientation estimate is also used along with speed measurements to update the position estimate. Among the different approaches proposed in the literature, the de facto state of the art in this field is represented by nonlinear complementary filters: they fuse the measurements of angular rate obtained through gyroscopes, and a measurement of gravity and Earth's magnetic field vectors respectively obtained through accelerometers and magnetometers. This paper is focused on an attitude estimation strategy for autonomous underwater vehicles (AUV). The proposed novelty includes the identification of some critical issues that arise when AUV attitude estimation algorithms are applied in practice. They are mainly due to the use of low-accuracy low-cost microelectromechanical systems (MEMS) sensors and on different sources of magnetic disturbances. Some strategies to overcome the identified issues are proposed, including the integration of a single-axis fiber optic gyroscope (FOG) that ensures a considerable performance improvement with a moderate cost increase. The proposed strategies for detection of issues and sensor fusion have been experimentally tested and validated in a real application scenario estimating the attitude of an AUV performing a lawn mower path. The expected performance improvement is confirmed; the obtained results are described and analyzed in this paper.