IEEE Transactions on Automatic Control, Vol.64, No.8, 3399-3406, 2019
Hybrid Pose and Velocity-Bias Estimation on SE(3) Using Inertial and Landmark Measurements
This paper deals with the design of globally exponentially stable invariant observers on the Special Euclidian group SE(3). First, we propose a generic hybrid estimation scheme (depending on a generic potential function) evolving on SE(3) x R-6 for pose (orientation and position) and velocity-bias estimation. Thereafter, the proposed estimation scheme is formulated explicitly in terms of inertial vectors and landmark measurements. Interestingly, the proposed estimation scheme leads to a decoupled rotational error dynamics from the translational dynamics, which is an interesting feature in practical applications with noisy measurements and disturbances.