A LiDAR SLAM system for dense forest mapping with iterated motion distortion correction