摘要

In this paper we propose a simple non-linear observer for attitude estimation based only on output from a typical inertial measurement unit (IMU) and dynamic pressure sensor embarked on a low-cost unmanned aerial vehicle. In particular, we aim to provide a good quality attitude estimate in the absence of global positioning system (GPS) ground truth and with potential low-frequency bias and high-frequency noise in the IMU sensor measurements. In addition, the case where the IMU only provides gyrometer and accelerometer outputs is considered; that is, there is no magnetometer output or it cannot be used due to local magnetic disturbances such as are common on a vehicle with electric motors. The proposed observer uses a simple centripetal force model (based on gyrometer and dynamic pressure measurements), augmented by a first-order dynamic model for angle of attack, to estimate non-inertial components of the acceleration. This estimate is used to correct the accelerometer output to provide a low-frequency estimate of the gravitational direction. This inertial direction, along with the gyrometer output, is then used to drive a fully non-linear attitude observer posed on the orthogonal group of rotation matrices SO(3). The observer is augmented with an integral state that ensures compensation of gyrometer bias. The resulting observer is simple to implement and fully non-linear. Experimental results are provided on a real-world data set and the performance of the filter is evaluated against the output from a full GPS/inertial navigation system (INS) that was available for the data set.

  • 出版日期2011-8