Nine-axis quaternion sensor fusion using modified kalman filter

摘要

A system for determining and correcting a calculated orientation of a computing device based on data from an accelerometer and a gyroscope. The system utilizes a modified Kalman filter that updates covariance to reduce decay over time based on a residual of the filter. Gyroscope bias is tracked and offset based on the updated covariance and the residual. The residual is based on an observational orientation determined from an angle between a measured acceleration vector and an expected acceleration vector, rotating a predicted frame based on the angle.