Robust Visual Odometry for Complex Urban Environments

Abstract — This paper describes a new approach for estimat-ing the vehicle motion trajectory in complex urban environ-ments by means of visual odometry. A new strategy for robust feature extraction and data post-processing is developed and tested on-road. Scale-invariant Image Features (SIFT) are used in order to cope with the complexity of urban environments. The obtained results are discussed and compared to previous works. In the prototype system, the ego-motion of the vehicle is computed using a stereo-vision system mounted next to the rear view mirror of the car. Feature points are matched between pairs of frames and linked into 3D trajectories. The distance between estimations is dynamically adapted based on re-projection and estimation errors. Vehicle motion is estimated us-ing the non-linear, photogrametric approach based on RANSAC (RAndom SAmple Consensus). The obvious application of the method is to provide on-board driver assistance in navigation tasks, or to provide a means of autonomously navigating a vehicle. The method has been tested in real traffic conditions without using prior knowledge about the scene or the vehicle motion. An example of how to estimate a vehicle’s trajectory is provided along with suggestions for possible further improve-ment of the proposed odometry algorithm. I