NDT RC: Normal Distribution Transform Occupancy 3D Mapping With Recentering

TheNormal Distribution Transform Occupancy Map (NDT OM) is a mapping algorithm able to represent a dynamic 3D environment. The resulting map has fixed boundaries, thus a robot with unbounded displacement might fall outside of the map due to memory limitation. In this paper, a recentering algorithm called NDT RC is proposed to avoid this issue. NDT RC extends the use of NDT OM for vehicles with unbounded displacements. NDT RC provides a seamless translation of the map as the robot gets far from the center of the previous map. The influence of NDT RC on the precision of the estimated trajectory of the robot, or odometry, is examined on two publicly available datasets, the KITTI and Ford datasets. An analysis of the sensitivity of the NDT RC to its tuning parameters is carried out using the Ford dataset, while the KITTI dataset is used to measure the influence of the density of the input point cloud. The results show that the proposed recentering strategy improves the accuracy of the odometry calculated by registering the latest lidar scan on the generated map compared to other NDT based approaches (NDT OM, NDT OM Fusion, SE-NDT). In particular, the proposed method, which does not perform loop closure, reduces the mean absolute translation error by 16% and the runtime by 88% compared to the NDT OM Fusion on the Ford dataset.