分割合并算法获取点云线特征数据(二维k、b,三维a、b、c)
1.将所有的点云数据放入list中
2.用其中若干点云数据拟合一条线
3.计算每个点到线的距离,当距离大于阈值,goto 4,小于则计算下一个点
4.以大于距离阈值的点分割点云数据,若当前所有线的所有点都通过了阈值计算,则goto 5,else goto 2
5.合并角度差距小于一定阈值的线
1.将所有的点云数据放入list中
2.用其中若干点云数据拟合一条线
3.计算每个点到线的距离,当距离大于阈值,goto 4,小于则计算下一个点
4.以大于距离阈值的点分割点云数据,若当前所有线的所有点都通过了阈值计算,则goto 5,else goto 2
5.合并角度差距小于一定阈值的线