Added code for visual odometry