3D Laser scan registration of dual-robot system using vision

This paper presents a novel technique to register a set of two 3D laser scans obtained from a ground robot and a wall-climbing robot which operates on the ceiling to construct a complete map of the indoor environment. Traditional laser scan registration methods like the Iterative Closest Point (ICP) algorithm will not converge to a global minimum without a good initial estimate of the transformation matrix. Our technique uses an overhead camera on the wall-climbing robot to keep line of sight with the ground robot and solves the Perspective Three Point (P3P) Problem to obtain the transformation matrix between the wall-climbing robot and the ground robot, which serves as a good initial estimate for the ICP algorithm to further refine the transformation matrix. We propose a novel particle filter algorithm to identify the real pose of the wall-climbing robot out of up to four possible solutions to P3P problem using Grunert´s algorithm. The initial estimate ensures convergence of the ICP algorithm to a global minimum at all times. The simulation and experimental results indicate that the resulting composite laser map is accurate. In addition, the vision-based approach increases the efficiency by reducing the number of iterations of the ICP algorithm.