This work presents a finite-time stable pose estimator (FTS-PE) for rigid bodies undergoing rotational and translational motion in three dimensions, using measurements from onboard sensors that provide position vectors to inertially-fixed points and body velocities. The FTS-PE is a full-state observer for the pose (position and orientation) and velocities and is obtained through a Lyapunov analysis that shows its stability in finite time and its robustness to bounded measurement noise. Further, this observer is designed directly on the state space, the tangent bundle of the Lie group of rigid body motions, SE(3), without using local coordinates or (dual) quaternion representations. Therefore, it can estimate arbitrary rigid body motions without encountering singularities or the unwinding phenomenon and be readily applied to autonomous vehicles. A version of this observer that does not need translational velocity measurements and uses only point clouds and angular velocity measurements from rate gyros, is also obtained. It is discretized using the framework of geometric mechanics for numerical and experimental implementations. The numerical simulations compare the FTS-PE with a dual-quaternion extended Kalman filter and our previously developed variational pose estimator (VPE). The experimental results are obtained using point cloud images and rate gyro measurements obtained from a Zed 2i stereo depth camera sensor. These results validate the stability and robustness of the FTS-PE.
University of Toronto Institute for Aerospace Studies (UTIAS)(多伦多大学航空航天研究所);Vector Institute for Artificial Intelligence(向量人工智能研究所);Munich Institute for Robotics and Machine Intelligence (MIRMI), Technical University of Munich(慕尼黑工业大学慕尼黑机器人与机器智能研究所)
DAP-Pose: Deep Temporal Alignment and Physics-aware Cross-modal Sensor Fusion for Robust Pose Estimation
Aerospace Information Research Institute, Chinese Academy of Sciences(中国科学院空天信息创新研究院);International Research Center of Big Data for Sustainable Development Goals(可持续发展大数据国际研究中心);University of Chinese Academy of Sciences(中国科学院大学);The University of Adelaide(阿德莱德大学)