Local map update for large scale SLAM