Integration of a stereo vision system and a laser range finder for 3-D construction

In this article, we investigate the problem of integrating a binocular stereo vision system and a laser range finder to construct a 3-D map of the environment. The proposed scheme is realized by using the alignment parameters obtained in the 2-D map construction of the laser range finder for the 3-D data generated by the stereo vision system. The 2-D map alignment task is formulated as an optimization problem of minimizing the alignment errors between local maps and selected parts of the developing global map. The problem is then solved using the Simplex method. To increase the robustness of the searching process, multiple initial guesses are provided in the Simplex method. The performance of the proposed architecture is verified by experimental results from a mobile vehicle for obstacle avoidance.