PCL使用RANSAC拟合三位平面

Wesley13
• 阅读 671

1、使用PCL工具

 1 //创建一个模型参数对象,用于记录结果
 2 pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients);
 3 //inliers表示误差能容忍的点,记录点云序号
 4 pcl::PointIndices::Ptr inliers(new pcl::PointIndices);
 5 //创建一个分割器
 6 pcl::SACSegmentation<pcl::PointXYZ> seg;
 7 //Optional,设置结果平面展示的点是分割掉的点还是分割剩下的点
 8 seg.setOptimizeCoefficients(true);
 9 //Mandatory-设置目标几何形状
10 seg.setModelType(pcl::SACMODEL_PLANE);
11 //分割方法:随机采样法
12 seg.setMethodType(pcl::SAC_RANSAC);
13 //设置误差容忍范围,也就是阈值
14 seg.setDistanceThreshold(0.01);
15 //输入点云
16 seg.setInputCloud (cloud);
17 //分割点云
18 seg.segment (*inliers, *coefficients);

2、RANSAC拟合平面代码

while ((iterNum < iter_maxNum) && inPlaneNum_max <= RSample_pointsNum)
{
    inPlaneNum_t = 3;//当前拟合平面中点个数

    //随机抽3个点,验证不在一条直线上
    /*A(x1,y1)、B(x2,y2)、C(x3,y3)
    AB斜率:kAB=(y2-y1)/(x2-x1)
    BC斜率:kBC=(y3-y2)/(x3-x2)
    计算结果可得:kAB=kBC
    因为kAB=kBC,且共点B
    所以直线AB与直线BC共线。*/
    do {
        rand_i_1 = real(gen);
        rand_i_2 = real(gen);
        if (rand_i_1 == rand_i_2)continue;
        rand_i_3 = real(gen);
        if (rand_i_1 == rand_i_3 || rand_i_2 == rand_i_3)continue;

        x1 = r_sample[rand_i_1].x; x2 = r_sample[rand_i_2].x; x3 = r_sample[rand_i_3].x;
        y1 = r_sample[rand_i_1].y; y2 = r_sample[rand_i_2].y; y3 = r_sample[rand_i_3].y;

    } while (((y2 - y1)*(x3 - x2)) == ((y3 - y2)*(x2 - x1)));

    //x1 = r_sample[rand_i_1].x; x2 = r_sample[rand_i_2].x; x3 = r_sample[rand_i_3].x;
    //y1 = r_sample[rand_i_1].y; y2 = r_sample[rand_i_2].y; y3 = r_sample[rand_i_3].y;
    z1 = r_sample[rand_i_1].z; z2 = r_sample[rand_i_2].z; z3 = r_sample[rand_i_3].z;
    //求平面方程
    A_t = (y2 - y1)*(z3 - z1) - (z2 - z1)*(y3 - y1);
    B_t = (x3 - x1)*(z2 - z1) - (x2 - x1)*(z3 - z1);
    C_t = (x2 - x1)*(y3 - y1) - (x3 - x1)*(y2 - y1);
    D_t = -(A_t * x1 + B_t * y1 + C_t * z1);

    //求在平面内的点的个数
    temp = sqrt(A_t*A_t + B_t*B_t + C_t*C_t);//点到平面距离参数

    for (int i = 0; i < RSample_pointsNum; i++)
    {
        temp_D = abs(A_t*r_sample[i].x + B_t*r_sample[i].y + C_t*r_sample[i].z + D_t) / temp;//点到平面距离
        if (temp_D < maxD)
        {
            inPlaneNum_t++;
        }
    }
    //与最优(最大)个数比较,保留最优个数的平面公式
    if (inPlaneNum_t > inPlaneNum_max)
    {
        A_best = A_t;
        B_best = B_t;
        C_best = C_t;
        D_best = D_t;
        inPlaneNum_max = inPlaneNum_t;
    }
    iterNum++;//迭代次数+1
}

 3、多点情况迭代次数的计算(转载于https://www.cnblogs.com/littlepear/p/10129861.html

PCL使用RANSAC拟合三位平面

4、关于RANSAC算法https://blog.csdn.net/weixin_43795395/article/details/90751650讲得很好,可以参考

5、自适应阈值https://blog.csdn.net/hanshuobest/article/details/73718440

点赞
收藏
评论区
推荐文章
blmius blmius
3年前
MySQL:[Err] 1292 - Incorrect datetime value: ‘0000-00-00 00:00:00‘ for column ‘CREATE_TIME‘ at row 1
文章目录问题用navicat导入数据时,报错:原因这是因为当前的MySQL不支持datetime为0的情况。解决修改sql\mode:sql\mode:SQLMode定义了MySQL应支持的SQL语法、数据校验等,这样可以更容易地在不同的环境中使用MySQL。全局s
皕杰报表之UUID
​在我们用皕杰报表工具设计填报报表时,如何在新增行里自动增加id呢?能新增整数排序id吗?目前可以在新增行里自动增加id,但只能用uuid函数增加UUID编码,不能新增整数排序id。uuid函数说明:获取一个UUID,可以在填报表中用来创建数据ID语法:uuid()或uuid(sep)参数说明:sep布尔值,生成的uuid中是否包含分隔符'',缺省为
待兔 待兔
4个月前
手写Java HashMap源码
HashMap的使用教程HashMap的使用教程HashMap的使用教程HashMap的使用教程HashMap的使用教程22
Jacquelyn38 Jacquelyn38
3年前
2020年前端实用代码段,为你的工作保驾护航
有空的时候,自己总结了几个代码段,在开发中也经常使用,谢谢。1、使用解构获取json数据let jsonData  id: 1,status: "OK",data: 'a', 'b';let  id, status, data: number   jsonData;console.log(id, status, number )
Stella981 Stella981
3年前
KVM调整cpu和内存
一.修改kvm虚拟机的配置1、virsheditcentos7找到“memory”和“vcpu”标签,将<namecentos7</name<uuid2220a6d1a36a4fbb8523e078b3dfe795</uuid
Wesley13 Wesley13
3年前
mysql设置时区
mysql设置时区mysql\_query("SETtime\_zone'8:00'")ordie('时区设置失败,请联系管理员!');中国在东8区所以加8方法二:selectcount(user\_id)asdevice,CONVERT\_TZ(FROM\_UNIXTIME(reg\_time),'08:00','0
Wesley13 Wesley13
3年前
00:Java简单了解
浅谈Java之概述Java是SUN(StanfordUniversityNetwork),斯坦福大学网络公司)1995年推出的一门高级编程语言。Java是一种面向Internet的编程语言。随着Java技术在web方面的不断成熟,已经成为Web应用程序的首选开发语言。Java是简单易学,完全面向对象,安全可靠,与平台无关的编程语言。
Stella981 Stella981
3年前
Django中Admin中的一些参数配置
设置在列表中显示的字段,id为django模型默认的主键list_display('id','name','sex','profession','email','qq','phone','status','create_time')设置在列表可编辑字段list_editable
Wesley13 Wesley13
3年前
MySQL部分从库上面因为大量的临时表tmp_table造成慢查询
背景描述Time:20190124T00:08:14.70572408:00User@Host:@Id:Schema:sentrymetaLast_errno:0Killed:0Query_time:0.315758Lock_
Python进阶者 Python进阶者
10个月前
Excel中这日期老是出来00:00:00,怎么用Pandas把这个去除
大家好,我是皮皮。一、前言前几天在Python白银交流群【上海新年人】问了一个Pandas数据筛选的问题。问题如下:这日期老是出来00:00:00,怎么把这个去除。二、实现过程后来【论草莓如何成为冻干莓】给了一个思路和代码如下:pd.toexcel之前把这