Navigation and Mapping in Large Scale Space