A CLOSED FORM 3D SELF-POSITIONING ALGORITHM FOR A MOBILE ROBOT USING VISION AND GUIDE-MARKS

Abstract

In this paper, the 3D self-positioning problem of a mobile robot is investigated under the assumption that there are given a set of guide points along with camera vision as the detection mechanism. The minimal number of guide points is discussed to determine the position and orientation of a mobile robot via a single or multiple camera system. For practical application, a closed form 3D self-positioning algorithm is proposed using a stereo camera system with triple guide points. It is further shown that a double triangular pattern is an effective guide-mark that is robust against measurement noise in feature extraction. Then, by simulation, the sensitivity of positioning errors due to image errors are analyzed. It is experimentally shown that the proposed method with triple guide points works well for a walking robot equipped with a stereo camera in laboratory environment.