Scale-unambiguous relative pose estimation of space uncooperative targets based on the fusion of three-dimensional time-of-flight camera and monocular camera

摘要

An approach of scale-unambiguous relative pose estimation for space uncooperative targets based on the fusion of low resolution three-dimensional time-of-flight camera and monocular camera is proposed. No a priori knowledge about the targets is assumed. First, a modified range-intensity Markov random field model is presented to quickly reconstruct the range value for each feature point. Second, the scale-ambiguous relative pose estimation algorithm based on extended Kalman filter-unscented Kalman filter-particle filter combination filter is designed in vision simultaneous localization and mapping framework. Third, the overall scale factor estimation approach based on range-intensity fusion image, which takes the feature points' range reconstruction uncertainty as measurement noise, is proposed for the final scale-unambiguous pose estimation. Finally, some simulations demonstrate the validity and capability of the proposed approach.