A Low-Cost Integrated Navigation System of Quadrotor Aerial Vehicle: Design, Development and Performance
Zebo Zhou,Jianfeng Zhang,Yong Zeng,Jinping Bai,Ling Yang
2013-01-01
Abstract:This paper proposes a low-cost multi-sensor integrated navigation system of QAV, emphasis on the design, development and its performance. Firstly, the overview of QAV and its platform of integrated navigation system is established and detailedly discussed. It consists of heterogeneous sensors including GPS receiver unit, 3-axis gyroscope/accelerometer, 3-axis digital magnetic compass (MC), digital barometric altimeter, navigation computer unit (NCU) and the STM32 micro-processer. The data from different sensor modules has been well time-synchronized by pulse-per-second (PPS) signal from GPS. An efficient integration algorithm is proposed and developed with dual filters architecture to fuse the navigation data, which involves three stages: (i) to weaken the noises of sensors, the position/velocity (PV) from GPS are pre-processed with 1st Kalman filtering (KF) and the outputs of gyroscope/accelerometer are pre-filtered with a five-order finite impulse response low-pass filter. (ii) A 15-state error state model is established in the navigation frame. In order to improve fusion accuracy, both the heading and height information from magnetic compass and barometric altimeter are combined with the PV solutions of 1st KF to generate the observation model of 2nd centralized KF. (iii) The final integration solution is reversely used as the feedback for position, velocity and attitude (PVA) outputs from gyroscope/accelerometer. Finally, the real flight experiment is carried out to evaluate the efficiency and performance of our proposed low-cost integrated navigation system of QAV. The result indicates that the navigation system performs well in real time and significantly improves the flight accuracy and reliability. With the aid of our low-cost navigation platform, the navigation results coincides with the real flight very well and can be implemented in many potential application fields.