平面最近点对问题详解

算法:   

 0:把所有的点按照横坐标排序   

1:用一条竖直的线L将所有的点分成两等份  

 2:递归算出左半部分的最近两点距离d1,右半部分的最近两点距离d2,取d=min(d1,d2)   

3:算出“一个在左半部分,另一个在右半部分”这样的点对的最短距离d3。

  4:结果=min(d1,d2,d3)    

关键就是这第3步。貌似这需要n^2的时间,把左边每个点和右边每个点都对比一下。其实不然。秘密就在这里。    首先,两边的点,与分割线L的距离超过d的,都可以扔掉了。   其次,即使两个点P1,P2(不妨令P1在左边,P2在右边)与分割线L的距离(水平距离)都小于d,如果它们的纵坐标之差大于d,也没戏。  就是这两点使得搜索范围大大减小:   对于左半部分的,与L的距离在d之内的,每个P1来说:右半部分内,符合以上两个条件的点P2最多只有6个!  原因就是:   d是两个半平面各自内,任意两点的最小距离,因此在同一个半平面内,任何两点距离都不可能超过d。   我们又要求P1和P2的水平距离不能超过d,垂直距离也不能超过d,在这个d*2d的小方块内,最多只能放下6个距离不小于d的点。    因此,第3步总的比较距离的次数不超过n*6。   

 第3步的具体做法是:    

3.1 删除所有到L的距离大于d的点。 O(n)  

 3.2 把右半平面的点按照纵坐标y排序。 O(nlogn)  

 3.3 对于左半平面内的每个点P1,找出右半平面内纵坐标与P1的纵坐标的差在d以内的点P2,计算距离取最小值,算出d3。 O(n*6) = O(n)    因为3.2的排序需要O(nlogn),   所以整个算法的复杂度就是O(n((logn)^2))。    


 改进:    我们对3.2这个排序的O(nlogn)不太满意。  既然整个算法是递归的,我们可以利用第2步的子递归中已经排好序的序列,在第3.2部归并这两个子列,这样3.2的复杂度变成了O(n)。    这样,整个算法就是O(nlogn)的。 

在二维平面上的n个点中,如何快速的找出最近的一对点,就是最近点对问题。

    一种简单的想法是暴力枚举每两个点,记录最小距离,显然,时间复杂度为O(n^2)。

    在这里介绍一种时间复杂度为O(nlognlogn)的算法。其实,这里用到了分治的思想。将所给平面上n个点的集合S分成两个子集S1和S2,每个子集中约有n/2个点。然后在每个子集中递归地求最接近的点对。在这里,一个关键的问题是如何实现分治法中的合并步骤,即由S1和S2的最接近点对,如何求得原集合S中的最接近点对。如果这两个点分别在S1和S2中,问题就变得复杂了。

    为了使问题变得简单,首先考虑一维的情形。此时,S中的n个点退化为x轴上的n个实数x1,x2,...,xn。最接近点对即为这n个实数中相差最小的两个实数。显然可以先将点排好序,然后线性扫描就可以了。但我们为了便于推广到二维的情形,尝试用分治法解决这个问题。

    假设我们用m点将S分为S1和S2两个集合,这样一来,对于所有的p(S1中的点)和q(S2中的点),有p<q。

    递归地在S1和S2上找出其最接近点对{p1,p2}和{q1,q2},并设

d = min{ |p1-p2| , |q1-q2| }

    由此易知,S中最接近点对或者是{p1,p2},或者是{q1,q2},或者是某个{q3,p3},如下图所示。



 

    如果最接近点对是{q3,p3},即|p3-q3|<d,则p3和q3两者与m的距离都不超过d,且在区间(m-d,d]和(d,m+d]各有且仅有一个点。这样,就可以在线性时间内实现合并。

    此时,一维情形下的最近点对时间复杂度为O(nlogn)。

    在二维情形下,类似的,利用分治法,但是难点在于如何实现线性的合并?



 

    由上图可见,形成的宽为2d的带状区间,最多可能有n个点,合并时间最坏情况下为n^2,。但是,P1和P2中的点具有以下稀疏的性质,对于P1中的任意一点,P2中的点必定落在一个d X 2d的矩形中,且最多只需检查六个点(鸽巢原理)。

    这样,先将带状区间的点按y坐标排序,然后线性扫描,这样合并的时间复杂度为O(nlogn),几乎为线性了。


/**
最近点对问题,时间复杂度为O(n*logn*logn)
*/
#include <iostream>
#include <cstdio>
#include <cstring>
#include <cmath>
#include <algorithm>
using namespace std;
const double INF = 1e20;
const int N = 100005;

struct Point
{
    double x;
    double y;
}point[N];
int n;
int tmpt[N];

bool cmpxy(const Point& a, const Point& b)
{
    if(a.x != b.x)
        return a.x < b.x;
    return a.y < b.y;
}

bool cmpy(const int& a, const int& b)
{
    return point[a].y < point[b].y;
}

double min(double a, double b)
{
    return a < b ? a : b;
}

double dis(int i, int j)
{
    return sqrt((point[i].x-point[j].x)*(point[i].x-point[j].x)
                + (point[i].y-point[j].y)*(point[i].y-point[j].y));
}

double Closest_Pair(int left, int right)
{
    double d = INF;
    if(left==right)
        return d;
    if(left + 1 == right)
        return dis(left, right);
    int mid = (left+right)>>1;
    double d1 = Closest_Pair(left,mid);
    double d2 = Closest_Pair(mid+1,right);
    d = min(d1,d2);
    int i,j,k=0;
    //分离出宽度为d的区间
    for(i = left; i <= right; i++)
    {
        if(fabs(point[mid].x-point[i].x) <= d)
            tmpt[k++] = i;
    }
    sort(tmpt,tmpt+k,cmpy);
    //线性扫描
    for(i = 0; i < k; i++)
    {
        for(j = i+1; j < k && point[tmpt[j]].y-point[tmpt[i]].y<d; j++)
        {
            double d3 = dis(tmpt[i],tmpt[j]);
            if(d > d3)
                d = d3;
        }
    }
    return d;
}


int main()
{
    while(true)
    {
        scanf("%d",&n);
        if(n==0)
            break;
        for(int i = 0; i < n; i++)
            scanf("%lf %lf",&point[i].x,&point[i].y);
        sort(point,point+n,cmpxy);
        printf("%.2lf\n",Closest_Pair(0,n-1));
    }
    return 0;
}


  • 8
    点赞
  • 39
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
PCL(Point Cloud Library)是一个开源的云处理库,其中包含了许多常用的云处理算法,例如平面拟合算法RANSAC。RANSAC(Random Sample Consensus)是一种用于估计模型参数的迭代方法,它可以在存在噪声和离群的数据中找到最佳的模型参数。 下面我们来详细介绍一下PCL中的RANSAC算法在平面拟合中的应用。 1. 原理 平面拟合是指在云数据中找到最适合一组集的平面方程。假设我们有一个云数据集$P = \{p_1, p_2, ..., p_N\}$,其中每个$p_i$都有三个坐标$(x_i, y_i, z_i)$。我们的目标是在其中找到一个平面方程$ax + by + cz + d = 0$,其中$a, b, c$是平面的法向量,$d$是平面到原的距离。 PCL中的平面拟合算法RANSAC的基本思想是在数据集中随机选择一组,然后计算这些所代表的平面方程,将这个平面方程与其他的距离进行比较,判断哪些属于这个平面。如果有足够多的属于这个平面,那么这个平面就是一个好的拟合。如果选择的不够好,那么就重新随机选择一组,直到找到一个好的拟合。 2. 算法流程 具体来说,PCL中的RANSAC算法流程如下: 1) 从云数据集中随机选择$n$个,这些被称为内(inliers)。 2) 计算这$n$个所代表的平面方程。 3) 遍历数据集中的每个,计算该平面的距离,如果距离小于一定的阈值,那么将该标记为内。如果内的数目超过了一定比例,那么就认为这$n$个代表了一个好的拟合。 4) 重复上述步骤若干次,最终选择内数目最多的平面方程作为最终的拟合结果。 3. 代码实现 下面是一个简单的PCL平面拟合的代码实现,其中使用了RANSAC算法: ```cpp #include <pcl/point_types.h> #include <pcl/features/normal_3d.h> #include <pcl/sample_consensus/method_types.h> #include <pcl/sample_consensus/model_types.h> #include <pcl/segmentation/sac_segmentation.h> int main() { // 定义云数据 pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>); // 从文件中读取云数据 pcl::io::loadPCDFile<pcl::PointXYZ>("table_scene_lms400.pcd", *cloud); // 创建分割对象 pcl::SACSegmentation<pcl::PointXYZ> seg; // 设置分割参数 seg.setOptimizeCoefficients(true); seg.setModelType(pcl::SACMODEL_PLANE); seg.setMethodType(pcl::SAC_RANSAC); seg.setMaxIterations(1000); seg.setDistanceThreshold(0.01); // 创建模型系数和索引容器 pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients); pcl::PointIndices::Ptr inliers(new pcl::PointIndices); // 执行分割 seg.setInputCloud(cloud); seg.segment(*inliers, *coefficients); // 输出平面方程的系数 std::cerr << "Model coefficients: " << coefficients->values[0] << " " << coefficients->values[1] << " " << coefficients->values[2] << " " << coefficients->values[3] << std::endl; } ``` 其中,loadPCDFile函数用于读取云数据,SACSegmentation对象用于进行平面拟合,setModelType和setMethodType用于设置平面模型和拟合方法,setMaxIterations设置迭代次数,setDistanceThreshold设置距离阈值。最后,segment函数执行拟合,并返回拟合结果的系数和内索引。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值