Nonlinear Observer for Tightly Integrated Inertial Navigation Aided by Pseudo-Range Measurements

A modular nonlinear observer for inertial navigation aided by pseudo-range measurements is designed and analyzed. The attitude observer is based on a recent nonlinear complementary filter that uses magnetometer and accelerometer vector measurements to correct the quaternion attitude estimate driven by gyro measurements, including gyro bias estimation. A tightly integrated translational motion observer is driven by accelerometer measurements, employs the attitude estimates, and makes corrections using the pseudo-range and range-rate measurements. It estimates position, range bias errors, velocity and specific force in an earth-fixed Cartesian coordinate frame, where the specific force estimate is used as a reference vector for the accelerometer measurements in the attitude observer. The exponential stability of the feedback interconnection of the two observers is analyzed and found to have a semiglobal region of attraction with respect to the attitude observer initialization and local region of attraction with respect to translational motion observer initialization. The latter is due to linearization of the range measurement equations that is underlying the selection of injection gains by solving a Riccati equation. In typical applications, the pseudo-range equations admit an explicit algebraic solution that can be easily computed and used to accurately initialize the position and velocity estimates. Hence, the limited region of attraction is not seen as a practical limitation of the approach for many applications. Advantages of the proposed nonlinear observer are low computational complexity and a solid theoretical foundation.