Riccati Observers for the Non-Stationary PnP Problem

Abstract : This paper revisits the problem of estimating the pose (position and orientation) of a body in 3D space with respect to (w.r.t.) an inertial frame by using i) the knowledge of source points positions in the inertial frame, ii) the measurements of the body angular velocity expressed in the body's frame iii) the measurements of the body translational velocity, either in the body frame or in the inertial frame, and iv) source points bearing measurements performed in the body frame. An important difference with the much studied static Perspective-n-Point (PnP) problem addressed with iterative algorithms is that body motion is not only allowed but also used as a source of information that improves the estimation possibilities. With respect to the probabilistic framework commonly used in other studies that develop Extended Kalman filter (EKF) solutions, the deterministic approach here adopted is better suited to point out the observability conditions, that involve the number and disposition of the source points in combination with body motion characteristics, under which the proposed observers ensure robust estimation of the body pose. These observers are here named Riccati observers because of the instrumental role played by the Continuous Riccati equation (CRE) in the design of the observers and in the Lyapunov stability and convergence analysis that we develop independently of the well-known complementary (either deterministic or probabilistic) optimality properties associated with Kalman filtering. The set of these observers also encompasses Extended Kalman filter solutions. Another contribution of the present study is to show the importance of using body motion to improve the observers performance and, when this is possible, of measuring the body translational velocity in the inertial frame rather than in the body frame to allow for the body pose estimation from a single source point taken as the origin of the inertial frame. This latter possibility finds a natural extension in the Simultaneous Localization and Mapping (SLAM) problem in Robotics.
Document type :
Journal articles
Liste complète des métadonnées

Cited literature [16 references]  Display  Hide  Download

https://hal.archives-ouvertes.fr/hal-01629138
Contributor : Claude Samson <>
Submitted on : Monday, November 6, 2017 - 10:03:50 AM
Last modification on : Tuesday, November 6, 2018 - 2:20:32 PM
Document(s) archivé(s) le : Wednesday, February 7, 2018 - 1:07:21 PM

File

TAC-final-version.pdf
Files produced by the author(s)

Identifiers

Collections

Citation

Tarek Hamel, Claude Samson. Riccati Observers for the Non-Stationary PnP Problem. IEEE Transactions on Automatic Control, Institute of Electrical and Electronics Engineers, 2018, 63 (3), pp.726-741. ⟨10.1109/TAC.2017.2726179⟩. ⟨hal-01629138⟩

Share

Metrics

Record views

244

Files downloads

115