Stereo based visual odometry