Visual Odometry

New paper accepted at RA-L and ICRA!