Vision-only autonomous navigation using topometric maps
A method for registration of 3d shapes