This is a branched version of hector_mapping, hector_localize