Abstract:This work presents a multiplicative extended Kalman filter (MEKF) for estimating the relative state of a multirotor vehicle operating in a GPS-denied environment. The filter fuses data from an inertial measurement unit and altimeter with relative-pose updates from a keyframe-based visual odometry or laser scan-matching algorithm. Because the global position and heading states of the vehicle are unobservable in the absence of global measurements such as GPS, the filter in this article estimates the state with respect to a local frame that is colocated with the odometry keyframe. As a result, the odometry update provides nearly direct measurements of the relative vehicle pose, making those states observable. Recent publications have rigorously documented the theoretical advantages of such an observable parameterization, including improved consistency, accuracy, and system robustness, and have demonstrated the effectiveness of such an approach during prolonged multirotor flight tests. This article complements this prior work by providing a complete, self-contained, tutorial derivation of the relative MEKF, which has been thoroughly motivated but only briefly described to date. This article presents several improvements and extensions to the filter while clearly defining all quaternion conventions and properties used, including several new useful properties relating to error quaternions and their Euler-angle decomposition. Finally, this article derives the filter both for traditional dynamics defined with respect to an inertial frame, and for robocentric dynamics defined with respect to the vehicle’s body frame, and provides insights into the subtle differences that arise between the two formulations.

Consensus-based Quaternion Estimation for Aggregated Spacecraft System with Multiple Sensors

Multiplicative Quaternion Extended Consensus Kalman Filter for Attitude and Augmented State Estimation

Distributed Dual Quaternion Extended Kalman Filtering for Spacecraft Pose Estimation

Kalman-filter-based Attitude and Parameters Estimation for Noncooperative Spacecraft

Quaternion-based algorithm for orientation estimation from MARG sensors

Stirling's Interpolation Filtering and Extended Kalman Filtering for Orientation Estimation

A novel Gaussian sum quaternion constrained cubature Kalman filter algorithm for GNSS/SINS integrated attitude determination and positioning system

Adaptive Cubature Kalman Filter with the Estimation of Correlation Between Multiplicative Noise and Additive Measurement Noise

QUATERNION-BASED FILTERING FOR GYROLESS ATTITUDE ESTIMATION WITHOUT AN ATTITUDE DYNAMICS MODEL

On generalized filtering methods for quaternion-based orientation estimation

Distributed Hybrid Consensus–based Square-Root Cubature Quadrature Information Filter and Its Application to Maneuvering Target Tracking

Novel Quaternion Kalman Filter for Gyro-less Attitude Determination

A novel adaptive Kalman filter for Euler-angle-based MEMS IMU/magnetometer attitude estimation

Spacecraft Attitude Estimation by Unscented Filtering

Adaptive pose and inertial parameters estimation of free-floating tumbling space objects using dual vector quaternions

Spacecraft Integrated Pose Determination with Unknown Noise Covariances

Cubature Kalman Hybrid Consensus Filter for Collaborative Localization of Unmanned Surface Vehicle Cluster with Random Measurement Delay

An Intelligent Quaternion SVDCKF AHRS Estimation with Variable Adaptive Methods in Complex Conditions

Improved Maximum Correntropy Unscented Kalman Filter for Spacecraft Attitude Estimation

Relative multiplicative extended Kalman filter for observable GPS-denied navigation

Improved Mixture Correntropy Cubature Kalman Filter for Attitude Estimation