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) × ℝ
⁶
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.