Riccati Observer Design for Pose, Linear Velocity and Gravity Direction Estimation Using Landmark Position and IMU Measurements

摘要

This paper revisits the problem of estimating the pose (i.e. position and attitude) of a robotic vehicle by combining landmark position measurements provided by a stereo camera with measurements of an Inertial Measurement Unit. The distinguished features with respect to similar works on the topic are two folds: First, the vehicle's linear velocity is not measured neither in the body frame nor in the inertial frame; Second, no prior knowledge on the gravity direction expressed in the inertial frame is required. Instead both the linear velocity and the gravity direction are estimated together with the pose. Another innovative feature of the paper relies on the idea of over-parametrizing the gravity direction vector evolving on the unit 2-sphere S