Major modifications: re-structured the matcher, added a starting graph-slam algorithm,
changes also to the map_viewer