一种基于长条带多站点云的链式高精度拼接与平差方法技术

本发明专利技术提出了一种基于长条带多站点云的链式高精度拼接与平差方法，包括基于随机采样一致定理的扫描数据拼接、条带点云数据的配准及平差方法：然后利用平差后的旋转平移矩阵重新整体拼接。本发明专利技术采用的随机采样一致定理算法能自动寻找靶标对应点求解拼接模型矩阵方法，不需要点云模型之间的变换初始值，并可分析链式高精度拼接过程中的误差来源。随机采样一致定理方法点云的链式拼接算法具有很好的鲁棒性，能够利用靶标点实现多测站点云之间的链式自动拼接，利用闭合条件的整体平差方法可以很好的消除点云拼接累积的闭合差，在长条带激光扫描点云的高精度链式拼接中有很好的效果。

【技术实现步骤摘要】
一种基于长条带多站点云的链式高精度拼接与平差方法
本专利技术涉及计算机图像处理领域，尤其涉及一种基于长条带多站点云的链式高精度拼接与平差方法。
技术介绍
在点云链式拼接算法研究方面，自动点云拼接算法通常是利用点云本身特征进行拼接，其中最为常见的是ICP算法，但是该算法需要点云之间相对精确的初始位置关系，且存在计算量大的缺点，虽然国内外学者对其进行了一系列改进，但仍难以实现大数据量的地面激光扫描数据的配准。另一类点云配准算法是以点云中具有可描述性的点、线、面作为配准基元来实现点云的自动配准，但是目前对此类特征的描述缺乏统一的标准，且该算法要求待配准点云中有明显的特征，没有良好的鲁棒性。在多站点云拼接误差处理方面，有些算法给出了多站拼接中误差传播的模型并进行了验证，但是没有给出消除累积误差平差方法。也有些研究利用最终的累积拼接误差对所有测站进行了误差分配，但这并不是严格意义上的平差,可靠性和鲁棒性不够理想。
技术实现思路
为解决上述技术问题，本专利技术提出了一种减少累计误差平差影响、链式点云拼接平滑、稳定、可靠的基于长条带多站点云的链式高精度拼接与平差方法。本专利技术的技术方案是这样实现的：一种基于长条带多站点云的链式高精度拼接与平差方法，包括以下步骤：一种基于长条带多站点云的链式高精度拼接与平差方法，包括以下步骤：A)基于随机采样一致定理的扫描数据拼接：在地面三维扫描仪完成数据采集后，从中提取出扫描靶标点的坐标，然后利用随机采样一致定理从两组不同的靶标点之间的寻找靶标点之间的对应关系，实现两站点云之间的拼接；B)条带点云数据的配准及平差：对产生的误差进行配准与平差的主要过程包括：利用靶标进行点云配准；配准误差的传播规律；利用多余观测条件进行整体平差；首先，利用靶标进行点云配准，利用靶标的空间位置不变性，从不同角度扫描靶标，得到了靶标在不同扫描坐标系下的坐标，利用坐标信息进行刚体变换，完成拼接；然后配准误差的传播规律；最后，利用多余观测条件的整体平差；C)利用平差后的旋转平移矩阵重新整体拼接。在以上技术方案的基础上，优选的，两站点云之间的拼接的具体步骤为：给定两组点集A和B，随机挑选出3个点a1,a2,a3∈A，计算向量的模，并从点集B中寻找向量使得threshold1为值域；以同样的方式在点集B中寻找向量的对应关系，如果三组对应关系在点集B中恰好为三个点b1,b2,b3，那么即认为点集A1(a1,a2,a3)和点集B1(b1,b2,b3)为一组对应关系；利用以下公式：R0an+T0＝bn(n∈0,1,2)可求得两测站之间的旋转矩阵R和平移向量T的初值R0,T0，并同时计算点残差向量两站拼接的中误差计算公式为：利用上述得到的矩阵初值R0,V0计算点集A中所有的点在点集B坐标系中的映射C，再计算点集C中每个点cn在点集B中的最邻近点bn，如果threshold2为值域，则认为(an,bn)也为一组对应点，an为cn在点集A中的对应点；找到全部的对应点，更新点集A1(a1,a2,...,an),B1(b1,b2,...,bn)，从而得到新的旋转矩阵R1和T1；重复上述步骤，在第k次迭代时如果满足下列条件之一时即更新矩阵R和T：(1)点集A1,B1中对应点的个数nk>nk-1；(2)点集A1,B1中对应点的个数nk＝nk-1，但残差值mk＜mk-1；当对应点点数n＞nthreshold，且拼接中误差m＜mthreshold终止迭代，nthershold为对应点点数n的阈值，mthershold为中误差m的阈值，获得最终的旋转矩阵R和平移向量T。在以上技术方案的基础上，优选的，配准误差的传播规律的方法如下：建立点云配准的数学模型：其中(XA,YA,ZA)和(XB,YB,ZB)分别为同一靶标点在两次扫描中的坐标；(y,p,r)为旋转坐标系中的三个旋转角度，(tx,ty,tz)平移向量，数学模型简写为B＝RA+T，其中A,B为模型点坐标，R为旋转矩阵，T为平移向量；选(y,p,r,tx,ty,tz)作为独立量，则可以建立间接平差模型；按照非线性平差模型的原则，将上述非线性方程组微分处理，得到方程组：其中L向量是将(y,p,r,tx,ty,tz)初值带入后的结果；将方程组简写为即得到间接平差的误差函数；令P为(y,p,r,tx,ty,tz)的权矩阵，用最小二乘的方法求解，单位权方差其中n为对应点的个数；由协因数传播定律知，(y,p,r,tx,ty,tz)的方差为其中Qxx为六参数的协因数阵Qxx＝(BTB)-1，为单位全方差。在以上技术方案的基础上，优选的，利用多余观测条件的整体平差的方法如下：在三维扫描数据的拼接中多余观测条件方程如下：在该方程中，(XA,YA,ZA)和(XB,YB,ZB)为同一靶标点在两个扫描坐标系下的坐标；而Q1Q2...Qn和Q'1Q'2...Q'n代表从两条不同的线路拼接至基站的旋转平移矩阵，可得到平差方程组：在前n个必要观测中，Ai(i∈1,2,...,n)为第i测站与后一测站(i+1测站)配准时的对应点，Bi(i∈1,2,...,n)为第i测站与前一测站(i-1测站)配准时的对应点集，M0为单位矩阵，Mi＝Q1Q2...Qi，即第i个测站到统一坐标系的旋转平移矩阵，每一个方程代表相邻两测站的对应点在归入统一坐标系后坐标相等；在m个多余观测中，Aki(i∈1,2,...m)为第i个测量站与后一测站配准时的对应点；Bli(i∈1,2,...m)第i测站与前一测站配准时的对应点集，Mki和Mli(i∈1,2,...,m)为同一组靶标点沿两条不同的线路拼接至基站的旋转平移矩阵；将该非线性方程组线性化处理，按照最小二乘的方法求解得到平差后的每一站的旋转平移矩阵Mi。在以上技术方案的基础上，优选的，值域threshold1、threshold2是根据点云密度平均间距的0.3-3倍来确定的。在以上技术方案的基础上，优选的，对应点点数n的阈值3＜nthreshold＜100。在以上技术方案的基础上，优选的，中误差m的阈值3＜mthreshold＜100。本专利技术一种基于长条带多站点云的链式高精度拼接与平差方法，相比现有技术，具有如下优点：(1)采用的随机采样一致定理(RANSAC)算法能自动寻找靶标对应点求解拼接模型矩阵方法，不需要点云模型之间的变换初始值，并可分析链式高精度拼接过程中的误差来源，具有很好的鲁棒性；(2)能够利用靶标点实现多测站点云之间的链式自动拼接，利用闭合条件的整体平差方法可以很好的消除点云拼接累积的闭合差，保证最终链式拼接结果的正确性与可靠性；(3)本专利技术在隧道、桥梁、道路等城市三维可视化建模、条带状地形图测量和矿山测量、森林及农业资源调查、地面景观形体测量、复杂工业设备的测量与建模等长条带激光扫描点云的高精度链式拼接中有很好的效果。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1为本专利技术的条带点云数据的配准的流程图；图2为本专利技术实施例的扫描场景示意图；图3本文档来自技高网...

【技术保护点】
1.一种基于长条带多站点云的链式高精度拼接与平差方法，包括以下步骤：A)基于随机采样一致定理的扫描数据拼接：在地面三维扫描仪完成数据采集后，从中提取出扫描靶标点的坐标，然后利用随机采样一致定理从两组不同的靶标点之间的寻找靶标点之间的对应关系，实现两站点云之间的拼接；B)条带点云数据的配准及平差：对产生的误差进行配准与平差的主要过程包括：利用靶标进行点云配准；配准误差的传播规律；利用多余观测条件的整体平差；首先，利用靶标进行点云配准，利用靶标的空间位置不变性，从不同角度扫描靶标，得到了靶标在不同扫描坐标系下的坐标，利用坐标信息进行刚体变换，完成拼接；然后配准误差的传播规律；最后，利用多余观测条件的整体平差，C)利用平差后的旋转平移矩阵重新整体拼接。

【技术特征摘要】
1.一种基于长条带多站点云的链式高精度拼接与平差方法，包括以下步骤：A)基于随机采样一致定理的扫描数据拼接：在地面三维扫描仪完成数据采集后，从中提取出扫描靶标点的坐标，然后利用随机采样一致定理从两组不同的靶标点之间的寻找靶标点之间的对应关系，实现两站点云之间的拼接；B)条带点云数据的配准及平差：对产生的误差进行配准与平差的主要过程包括：利用靶标进行点云配准；配准误差的传播规律；利用多余观测条件的整体平差；首先，利用靶标进行点云配准，利用靶标的空间位置不变性，从不同角度扫描靶标，得到了靶标在不同扫描坐标系下的坐标，利用坐标信息进行刚体变换，完成拼接；然后配准误差的传播规律；最后，利用多余观测条件的整体平差，C)利用平差后的旋转平移矩阵重新整体拼接。2.如权利要求1所述的一种基于长条带多站点云的链式高精度拼接与平差方法，其特征在于：两站点云之间的拼接的具体步骤为：给定两组点集A和B，随机挑选出3个点a1,a2,a3∈A，计算向量的模，并从点集B中寻找向量使得||a1a2|-|b1b2||＜threshold1，threshold1为值域；以同样的方式在点集B中寻找向量的对应关系，如果三组对应关系在点集B中恰好为三个点b1,b2,b3，那么即认为点集A1(a1,a2,a3)和点集B1(b1,b2,b3)为一组对应关系；利用以下公式：R0an+T0＝bn(n∈0,1,2)可求得两测站之间的旋转矩阵R和平移向量T的初值R0,T0，并同时计算点残差向量两站拼接的中误差计算公式为：利用上述得到的矩阵初值R0,V0计算点集A中所有的点在点集B坐标系中的映射C，再计算点集C中每个点cn在点集B中的最邻近点bn，如果threshold2为值域，则认为(an,bn)也为一组对应点，an为cn在点集A中的对应点；找到全部的对应点，更新点集A1(a1,a2,...,an),B1(b1,b2,...,bn)，从而得到新的旋转矩阵R1和T1；重复上述步骤，在第k次迭代时如果满足下列条件之一时即更新矩阵R和T：(1)点集A1,B1中对应点的个数nk>nk-1；(2)点集A1,B1中对应点的个数nk＝nk-1，但残差值mk＜mk-1；当对应点点数n＞nthreshold，且拼接中误差m＜mthreshold终止迭代，nthershold为对应点点数n的阈值，mthershold为中误差m的阈值，获得最终的旋转矩阵R和平移向量T。3.如权利要求1所述的一种基于长条带多站点云的链式高精度拼接与平差方法，其特征在于：配准误差的传播规律的方法如下：建立点云配准的数学模型...

【专利技术属性】
技术研发人员：季铮，
申请(专利权)人：武汉智觉空间信息技术有限公司，
类型：发明
国别省市：湖北,42