Method and apparatus for adaptive filter based attitude updating

摘要

A six state Kalman filter is adapted based on a current acceleration mode of an INS device. Gyro measurements are used to determine the acceleration mode and the Kalman filter estimates bias and small angle error of the measurements based on the acceleration mode. The bias error corrects the gyro measurement and the small angle error is used along with the corrected gyro measurement to update an attitude sensed by the gyro.