Robust loop closures in 3D mapping systems