visual odometry implemented with rgbdtools lib, but not tested