Towards High-Resolution Seafloor 3D Mapping from Underwater Flash LiDAR and ICP Registration