Geintra

In this paper a system capable of obtaining the 3D pose of a mobile robot using a ring of calibrated cameras attached to the environment is proposed. The system robustly tracks point fiducials in the image plane of the set of cameras generated by the robot’s rigid shape in motion. Each fiducial is identified with a point belonging to a sparse 3D geometrical model of robot’s structure. Such model allows direct pose estimation from image measurements and it can be easily enriched at each iteration with new points as the robot motion evolves. The process is divided in an initialization step, where the structure of the robot is obtained and an online step, which is solved using sequential Bayesian inference. The approach allows to model properly uncertainty in measurements and estimations, at the same time it serves as a regularization step in pose estimation. The proposed system is verified using simulated and real data.