Nonlinear Observer for Tightly Coupled Integrated Inertial Navigation Aided by RTK-GNSS Measurements

摘要

A modular nonlinear observer is considered for tightly coupled integration of inertial measurements with global satellite measurements. A real-time-kinematic (RTK) approach is utilized where the rover and base station measure pseudoranges, carrier-phase, and carrier-phase derived Doppler, to be used in a dual receiver configuration. The modular observer design consists of a nonlinear attitude observer and a translational motion observer (TMO). The attitude observer represents the vehicle attitude as unit quaternions and estimates the gyro bias. A TMO based on the double-differenced measurements between the rover and base station receiver is proposed. The ambiguities introduced by the carrier-phase measurements are included in the state vector and are initially considered real valued, later to be resolved to integer values. The advantages of the nonlinear observer compared with a Kalman filter are reduced computational load, no linearization requirement of the model, and proven stability. The proposed observer is verified using experimental data from flights with an unmanned aerial vehicle, where the position estimates are shown to be within 2-4 cm of a global positioning system L-1-based RTK reference solution.