Combined constraint matching algorithm for stereo visual odometry based on local interest points

In this paper, we describe a new approach which uses scale-invariant image features to estimate the motion of a stereo head. These point features are matched between pairs of frames and linked into image trajectories at video rate, generating what it is called visual odometry, i.e. motion estimates from visual input alone. With respect to previously proposed approaches, the main novelty of our proposal is that the matching between sets of features associated to stereo pairs and between sets of image features associated to consecutive frames are conducted by means of a fast combined constraint matching algorithm. Besides, the efficiency of the approach is increased by using a closed-form solution to estimate the final robot displacement between consecutive acquired frames. We have tested the proposed approach for navigational purposes in a real environment. Experimental results demonstrate the performance of the proposal.