Fast Iterative 3D Mapping for Large-Scale Outdoor Environments with Local Minima Escape Mechanism. Issue 22 (2018)