A method for navigation comprises constructing a current map that includes two-dimensional or three dimensional representations of an area, detecting one or more edge features on the current map, and generating a first fine-edge map based on the edge features. The method further comprises retrieving a historical map that includes two-dimensional or three dimensional representations of the area, detecting one or more edge features on the historical map, and generating a second fine-edge map based on the edge features. Thereafter, a coarse version of the current map is generated from the first fine-edge map, and a coarse version of the historical map is generated from the second fine-edge map. The coarse versions of the current and historical maps are then correlated to determine a first position and orientation. The first fine-edge map is then correlated with the second fine-edge map to determine a second, more accurate, position and orientation.