Mapping And Localization With Heterogeneous Robots