目录 一、算法原理 二、代码实现 三、结果展示 四、测试数据 一、算法原理 算法来自本人自创,具体实现原理见代码。 二、代码实现 #include <iostream> #include <pcl/io/pcd_io.h> #include <pcl/point_types.h>