submap localisation improved