Added a new point cloud mapper to update the point cloud with the corrections from SLAM