Fast 3D Mapping in Highly Dynamic Environments using Normal Distributions Transform Occupancy Maps

Abstract — Autonomous vehicles operating in real-world in-dustrial environments have to overcome numerous challenges, chief among which is the creation and maintenance of consis-tent 3D world models. This paper focuses on a particularly important challenge, i.e., mapping in dynamic environments. We introduce several improvements to the recently proposed Normal Distributions Transform Occupancy Map (NDT-OM) aimed for efficient mapping in dynamic environments. A careful consistency analysis is given based on convergence and similarity metrics specifically designed for evaluation of NDT maps in dynamic environments. We show that in context of mapping with known poses the proposed method results in improved consistency and in superior runtime performance, when compared against 3D occupancy grids at same size and resolution. Additionally, we demonstrate that NDT-OM features real-time performance in highly dynamic 3D mapping and tracking scenario with centimeter accuracy over 1.5km trajectory. I