Selective submap joining SLAM for autonomous vehicles