CN105678088B - 一种靶标测头的平差优化算法 - Google Patents
一种靶标测头的平差优化算法 Download PDFInfo
- Publication number
- CN105678088B CN105678088B CN201610019132.8A CN201610019132A CN105678088B CN 105678088 B CN105678088 B CN 105678088B CN 201610019132 A CN201610019132 A CN 201610019132A CN 105678088 B CN105678088 B CN 105678088B
- Authority
- CN
- China
- Prior art keywords
- vector
- adjustment
- target
- weight
- value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 28
- 238000005457 optimization Methods 0.000 title claims abstract description 19
- 239000013598 vector Substances 0.000 claims abstract description 110
- 238000000034 method Methods 0.000 claims abstract description 26
- 238000003384 imaging method Methods 0.000 claims abstract description 22
- 238000012937 correction Methods 0.000 claims description 44
- 230000003287 optical effect Effects 0.000 claims description 42
- 239000011159 matrix material Substances 0.000 claims description 37
- 238000012795 verification Methods 0.000 claims description 5
- 239000003607 modifier Substances 0.000 claims description 4
- 238000012821 model calculation Methods 0.000 claims description 2
- 239000000523 sample Substances 0.000 claims 4
- 238000005259 measurement Methods 0.000 abstract description 15
- 238000007689 inspection Methods 0.000 abstract description 2
- 238000011156 evaluation Methods 0.000 abstract 1
- QLENKWFQUHHBKZ-UHFFFAOYSA-N 2,5-dimethoxy-4-(2-fluoroethyl)amphetamine Chemical compound COC1=CC(CC(C)N)=C(OC)C=C1CCF QLENKWFQUHHBKZ-UHFFFAOYSA-N 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000000605 extraction Methods 0.000 description 4
- 230000001154 acute effect Effects 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 239000006185 dispersion Substances 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000000513 principal component analysis Methods 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 230000001575 pathological effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16Z—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS, NOT OTHERWISE PROVIDED FOR
- G16Z99/00—Subject matter not provided for in other main groups of this subclass
Landscapes
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种靶标测头的平差优化算法:通过寻找向量在欧氏空间与摄影空间的不变量关系作为约束条件,即建立在不同位姿下手持靶标靶面特征点B到靶标测头A的空间向量及其在针孔相机模型下的成像规律,以该约束条件作为条件方程建立函数模型,采取Helmet验后方差估计作为随机模型,最后将差值带入条件方程,完成差值检验。本算法充分利用了每一个手持靶标靶面特征点的空间位置信息,鲁棒性好,稳定性高,提高了手持靶标测头的3D空间还原精度,为进一步提高双目立体视觉测量精度提供了有效的方法。
Description
【技术领域】
本发明属于视觉测量技术领域,是一种可以提高双目立体视觉系统测量精度,用于还原手持靶标测头空间3D坐标的一种平差优化算法。
【背景技术】
随着各种异形工件内腔外形检测需求的增多,以立体视觉测量为基础的便携式3D坐标测量技术得到越来越多的应用。双目立体视觉系统只需要两台摄像机、标定板、手持靶标和专用测头,就能完成对大型复杂型腔零件的在位/在线测量,不受现场环境影响,可靠性高、尤其是对复杂内腔、深长孔等测量有独特的优势。
在双目立体视觉系统中,手持靶标是一个重要的测量设备。手持靶标作为双目立体视觉系统中一个重要的坐标传递设备,是连接手持靶标LED特征点空间3D坐标和测头3D坐标的媒介。测量时,手持靶标的测头与待测物体表面接触,标定完成后的摄像机通过捕捉手持靶标靶面特征点,完成特征点的3D空间坐标还原,利用建立的靶标坐标系完成从靶面特征点的3D空间坐标到测头坐标转换,从而最终测得与测头接触的待测物体表面3D空间坐标。因此,从手持靶标靶面得到LED特征点的3D空间坐标后,如何建立靶标坐标系用来还原待测点,即手持靶标测头的空间3D坐标,是空间定位三维重建的一个难题。
目前,建立靶标测头坐标系的方法主要依靠靶标自标定技术,即将手持靶标的测头与一个标定块锥形内槽底部接触,标定块固定,转动手持靶标放置若干不同位姿,相当于靶标测头不动,靶面LED的特征点一直在变换空间3D坐标,利用靶面LED特征点与靶标测头相对位置不变的关系,列出方程求解测头与每一个LED特征点的距离,从而以某3个不共线的LED特征点建立的坐标系作为靶标坐标系时,就可以找出此坐标系下测头的坐标,还原出空间中测头的3D坐标,也就可以得到与测头接触的目标待测点的坐标。
然而,利用自标定技术建立靶标坐标系存在以下问题:
首先,如何设计靶面LED特征点的数目。要建立起一个完整的靶标坐标系,至少需要3个不共线的特征点,特征点数目较少的时候由于受偏心提取误差、镜头畸变等原因误差影响会相对较大;然而增加特征点的数目,利用LED特征点到靶标测头距离不变的条件所列出的超定方程的系数矩阵是一个病态矩阵,条件数大,受误差影响大,难以得到理想的解。
其次,每一次还原待测点的空间3D坐标时,利用有效的LED特征点的数目较少。在得出靶面每个LED特征点到测头的距离以后,只能利用其中的3个不共线特征点进行靶标坐标系的建立,如果靶面一共布置N个LED特征点,则一共可以建立个靶标坐标系(假设没有任意共线的3个LED特征点),利用靶标坐标系作为坐标传递的媒介可以得到个待测点的空间3D坐标,将这些3D坐标平均求和就可以得到最终的待测点空间3D坐标,虽然可以利用平均值减小误差,但是这些数据的方差相对较大。
最后,由于使用的是待测点的空间3D坐标的均值,每个数据在最终结果中所占的权重没有区别,每个数据的可靠程度无法有效的度量,因此有可能将误差放大。
以上问题正在越来越多的被国内外学者关注,目前很少有关此类问题的国内外相关文献,也没有完整的相对成熟的解决方法。因此,针对还原靶标测头坐标的问题,本发明提出了一种鲁棒的靶标测头的平差优化算法。
【发明内容】
本发明提出了一种靶标测头的平差优化算法,以提高手持靶标特征点计算靶标测头坐标的精度,即提高与测头接触的待测点的空间3D坐标精度。
本发明采用以下技术方案:
一种靶标测头平差优化算法,首先建立空间向量与其在CCD成像之间的关系,然后构建条件平差模型计算平差值,最后对该平差值进行验证;其中,构建条件平差模型的过程中,在确定了观测数之后,假定初始的各个参数的权值均为1,在此假定条件下计算平差值,如果最终的平差值未通过验证,则重新调整各个参数的权值重新计算直至通过验证。
空间向量与其在CCD成像之间的关系为:
其中,是有效焦距,fR是右相机的实际焦距,doef是主点与BAOR平面的距离,d是向量的模长,θ1是测头A与CCD摄像机光心o连线与向量的夹角,dT是两个相机光心OL OR之间的距离,α是向量与CCD摄像机光轴的夹角,β是右相机光轴与两个相机光心连线的夹角。
构建条件平差模型计算平差值的具体方法包括以下步骤:
(1)以空间向量与其在CCD成像之间的关系为条件式;
(2)对步骤(1)的条件式进行线性化;
(3)确定权阵:在初始权阵P中,假定各个参数的权值均为1;
(4)确定改正数向量V:
(5)确定闭合差W:W=A·(Δu,θ1,d)T,其中,
(6)确定随机模型并计算平差值。
在确定闭合差以后首先计算出改正数向量的一个初值,然后再确定随机模型计算平差值,计算改正数向量的方法包括以下步骤:
(A)将条件式改写为:
(B)构造联系数法方程:
(B1)利用拉格朗日条件极值构造乘系数向量K:
Φ=VTPV-2KT(AV-W)
其中,
AV-W=0
条件式为:V=P-1ATK,
AV-W=0
含K的改正数向量为:V=P-1ATK
则,法方程为:AP-1ATK-W=0;
(B2)令联系数法方程系数N为:N=AP-1AT,
则乘系数向量K为:
K=N-1W
(B3)利用以下公式计算改正数向量:
V=P-1ATK。
所述步骤(6)的具体步骤包括以下:
(6.1)将步骤(1)条件式中的所有观测值均用参数形式表示,具体如下:
令:则闭合差为:改正数向量为:
求解参数改正数向量x:x=(BTPB)-1BTPl,
则参数的修正值为:
观测值的修正值为:
利用Helmet方差分量估计严密式计算单位权方差,以对方差值进行验证,Helmet方差分量估计严密式为:
其中,
N=N1+N2,
若则认为所设定的权值合理。
重新调整权值采用以下公式:
与现有技术相比,本发明至少具有以下有益效果:本发明首先通过寻找向量在欧氏空间与摄影空间的不变量关系作为约束条件,即建立在不同位姿下手持靶标靶面特征点B到靶标测头A的空间向量及其在针孔相机模型下的成像规律,以该约束条件作为条件方程建立函数模型,最后进行验证结果,完成差值检验。本发明方法充分利用了每一个手持靶标靶面特征点的空间位置信息,鲁棒性好,稳定性高,提高了手持靶标测头的3D空间还原精度,为进一步提高双目立体视觉测量精度提供了有效方法。
【附图说明】
图1为双目系统中空间向量在针孔模型中成像的示意图。
其中OL为左相机光心,OR为右相机光心,为空间向量,其中A点为手持靶标的测头,B为靶面上LED特征点,θ1为与的夹角,θ2为与的夹角。
图2为在双目视觉系统中取单相机,在简单放置条件下,针孔模型中向量成像的示意图。其中(A)、(B)分别为向量不穿过摄像机光轴与穿过摄像机光轴两种位置情况的示意图。
其中,O1为相机的光心,CDEF所在平面为CCD成像平面,为空间向量,θ1为与的夹角,θ2为与的夹角。
图3为图2局部,(A)、(B)分别为向量不穿过摄像机光轴与穿过摄像机光轴两种位置情况的示意图。
其中,α为相机光轴与向量夹角所称的锐角,EF为向量在CCD相面所称的像,θ1为与的夹角,θ2为与的夹角。
图4为向量在空间一般位置情况下,在针孔相机模型下成像的示意图。
其中OR为相机光心,图中的虚线表示,过相机光心与向量平行的直线。
图5为图4的局部,表示在ABOR平面内向量成像的示意图。
图6为验后方差分量估计算法流程图。
图7为靶标测头平差优化算法流程图。
【具体实施方式】
本发明算法公开了两种方案,以下分别介绍:
方案一:
本算法是在使用以手持靶标的双目立体视觉系统测量空间定位时的优化算法,旨在提高以手持靶标靶面特征点作为空间特征点还原靶标测头时的精度,目的是提高双目立体视觉系统的测量精度。其具体实施操作存在于双目立体视觉系统测量过程。下面结合某一次测量过程对本发明作进一步详细说明。(本次测量使用的手持靶标以LED作为空间的特征点)
第一步:标定。
首先需要利用张正友棋盘格标定算法对搭建好的双目立体视觉系统进行标定,得到标定参数。
第二步:获取图像信息。
标定完成以后,利用手持靶标对待测的表面进行逐点测量。即移动手持靶标至需要测量的目标点,然后两个相机同时拍照,捕捉到手持靶标在左右两个不同位姿的相机的图像。虽然获取的是图像,但其有效信息是图像中手持靶标靶面上的LED空间特征点的像。本方案利用加权重心算法,将LED在2维平面的像点面(大约100-200个像素单位左右)拟合成一个亚像素的像素坐标。
第三步:匹配。
匹配的目的是将同一个LED在左右两个相机不同的像联系起来,形成一一对应的关系。能否正确的匹配决定了特征点三维还原的正确与否。由于LED在靶面分布的特殊性,本方案利用基于极径极角的匹配算法,其运算速度快,鲁棒性极好,保证了匹配的正确定。
第四步:三维还原。
1、LED光心偏差方向的确定
两个关键方向与能够确定偏差方向。其中,
(1)LED发光面的法线方向
(2)摄像机光心到LED发光中心的向量
LED光心偏差方向根据以下公式计算确定:
λ1,λ2分别代表校正方向在二维坐标系下的两个分量。
2、粗提取
利用加权重心算法对左右摄像机捕捉的手持靶标LED特征点灰度值图像进行光心坐标粗提取。
左相机光心坐标右相机光心坐标其中i=1,2,3,...n表示特征点个数。
3、降噪声
降噪的对象是左右相机内外参标定结果构造出来的基础矩阵F0。由于噪声、提取误差和随机误差的存在,利用标定结果构造出来的基础矩阵F0并不满足双目立体视觉中基础矩阵rank(F0)=2的性质,这为后面最佳校正位置的判断带来影响,所以对其进行降噪。
其中,利用左右相机内外参标定结果构造出来的基础矩阵F0为:
F0=K'-TSRK-T
其中K'右相机的内参,K是左相机的内参,R是外参的旋转矩阵,S是外参的平移矩阵T的反对称矩阵。
将F0进行奇异值分解
F0=U diag(λ1,λ2,λ3)VT
对最小的奇异值操作λ3=0得到
F=U diag(λ1,λ2,0)VT
4、粗定位
粗定位分为三步。
首先,将步骤2粗提取的左右图像平面光心坐标沿着步骤1中求得的各个点的校正方向依次移动步长Pj=ε1*j(0.01pixel≤ε1≤0.05pixel),(ε1为每次移动的步长,j为一共移动的步数),左或右图像平面所有点移动一个步长ε形成的图像称之为点位图,则左右图像平面可以形成j*j个点位图对。
然后,对粗提取出来的图像光心坐标进行归一化坐标变换,计算每一个点位图对对应的基础矩阵解除归一化变换得到原始点(原始点指未移动之前的坐标位置)对应基础矩阵Fi。
最后,将与j*j个点位图对相对应的j2个基础矩阵写成列向量的形式构造出一个9行j2列的矩阵M1,利用主成分分析(PCA)算法对M1进行特征空间重构,取前6个特征值及其对
应的特征向量,构成矩阵M′1。将矩阵M′1中所有列向量进行样本投影重构,将每一个基础矩阵(列向量)与均值向量的差值投影到特征空间。寻找样本空间中与目标欧氏距离最短、夹角最小的基础矩阵。
空间向量与目标欧式距离按照以下公式计算:
其中,f1为目标向量,fi是第i个空间向量。
空间向量与目标向量的夹角θi按照以下公式计算:
以此时筛选出的基础矩阵对应点位图对的左右图像平面光心坐标位置为粗定位的结果。
5、精定位
将单步步长变为ε2,ε2=ε1/10。其中,校正方向以粗定位结果为中心,沿着步骤1得到的校正方向直线,左右各移动n/2个步长ε2,则可以得到n*n个点位图对,也就是对应有n2个基础矩阵,重复步骤4,此时筛选出的基础矩阵对应点位图对的左右图像平面光心坐标位置为最终校正结果。
在获取精确的靶面LED特征点的3D空间位置坐标以后,就可以利用靶标测头平差优化算法还原测头的空间位置坐标。
6、利用约束条件建立空间向量在欧氏空间与摄影空间的关系,即建立空间向量(靶面LED特征点到测头)与其在CCD成像之间联系。
通过之前的推导可知,向量在CCD摄像机相面成像长度Δu与其模长d的关系可以表示为:
是修正以后的有效焦距,fR是右相机的实际焦距,doef是主点(图像平面的中点)与BAOR平面的距离,d是向量的模长,dT是两个相机光心OL OR之间的距离,β是右相机光轴与两个相机光心连线的夹角(取锐角值)。
7、构建函数模型
这里使用的函数模型是条件平差模型
1)确定必要的观测数
这里我们使用的条件方程就是在1中推导的约束条件:
方程中有8个未知数d,θ1,Δu和fR,doef,dT,α,β,其中fR,doef,dT,α,β可以通过标定得到,那么此条件方程得到d,θ1,Δu之间的关系。
2)确定条件方程并定权
A确定条件式
B将条件式线性化
Δu=f(θ1,d)取一阶偏导,得到
C确定权阵
初始权阵P中,各个参数权值都设为1
P=(Pd,Pθ1,PΔu)=(1,1,1)
Pd,Pθ1,PΔu分别为三个参数权值。
D确定改正数向量
用V表示改正数向量,则有:
其中vΔu表示
那么含有改正数向量的线性化方程可以表示为:
E确定闭合差
闭合差可以表示为:
写成矩阵的形式:
W=A·(Δu,θ1,d)T
其中
8、确定随机模型
这里使用的随机模型是验后方差分量估计,又称为赫尔默特方差分量估计。
平差前观测值向量的方差阵一般是未知的,因此平差时随机模型都是使用观测值向量的权阵。而权的确定往往都是采用经验定权,也称为随机模型的验前估计,对于同类观测值可按第一章介绍的常用定权方法定权;对于不同类的观测值,就很难合理地确定各类观测值的权。为了合理地确定不同类观测值的权,可以根据验前估计权进行预平差,用平差后得到的观测值改正数来估计观测值的方差,根据方差的估计值重新进行定权,以改善第一次平差时权的初始值,再依据重新确定的观测值的权再次进行平差,如此重复,直到不同类观测值的权趋于合理。
1)将平差方程写成含参数的形式
将条件方程Δu=f(θ1,d)中的所有观测值均用参数形式表示:
其中B为系数矩阵:
则闭合差可以表示为:
改正数向量可以表示为:
求解参数改正值向量x:
x=(BTPB)-1BTPl
则参数的修正值为:
观测值的修正值为:
2)利用Helmet方差分量估计严密式计算单位权方差
Helmet方差分量估计严密式为:
其中:
N=N1+N2,
n1、n2分别为第一类、第二类平差量的数目,B1、B2分别为第一类、第二类平差量的系数矩阵,P1、P2分别为第一类、第二类平差量权值矩阵,分别为第一类、第二类平差量单位权方差,V1、V2分别为第一类、第二类平差量该整数向量。第一类为角度,第二类为长度(即距离)。
3)判断此次的权值是否合理
利用之前所确定的权值计算出来的单位权方差进行判断,若则认为所设定的权值是合理的,否则需要对权值进行调整。
4)对权值进行调整
若单位权方差值比相差较大,需要重新定权:
重新定权以后按照Helmet方差分量估计严密式判断权值是否合理。
9、进行差值检验
将最终定权以后的差值结果回带条件方程中,看是否满足条件方程的要求。
方案二:
方案二与方案一的区别仅在于:利用靶标测头平差优化算法还原测头的空间位置坐标,具体地说,就是方案一的步骤6至步骤9,更具体地说,其区别在于:在确定随机模型之前,改正数向量V是提前计算出一个初值,还是不用计算,直接用随机模型计算。
因此,方案二仅针对平差优化算法进行阐述。
本发明提出的靶标测头平差优化算法主要包括以下几个步骤:
1、寻找约束条件
建立空间向量(靶面LED特征点到测头)与其在CCD成像之间联系。
1)简单放置下,针孔相机模型的空间向量成像规律,参见图1。
将手持靶标靶面LED特征点B到靶标测头点A相连接,就可以构建一个空间向量其在CCD相面成像为为了简化,首先假设此向量位于与通过CCD摄像机光轴的平面内。α是向量与CCD摄像机光轴的夹角,θ1是测头A与CCD摄像机光心o连线与向量的夹角,θ2是靶面LED特征点B与CCD摄像机光心o连线与向量的夹角,通过三角形正弦余弦定理消去θ2。
以右相机为例,向量在CCD摄像机相面成像长度Δu与其模长d的关系可以表示为:
fR是右相机的实际焦距,d是向量的模长,dT是两个相机光心OL OR之间的距离,β右相机光轴与两个相机光心连线的夹角(取锐角值)。
2)将简单放置推广到一般测量条件下,空间向量的成像规律。
简单放置条件是将空间向量限制于通过CCD摄像机光轴的平面内,一般条件下,空间向量与CCD摄像机光轴会有夹角,但是,总可以将摄像机光心与空间向量相连接形成一个三角形,如图4所示。再将其实际焦距fR转化成在此平面内的有效焦距即可,如图5所示。
以右相机为例,一般条件下,向量在CCD摄像机相面成像长度Δu与其模长d的关系可以表示为:
是修正以后的有效焦距,fR是右相机的实际焦距,doef是主点(图像平面的中点)与BAOR平面的距离,d是向量的模长,dT是两个相机光心OL OR之间的距离,β是右相机光轴与两个相机光心连线的夹角(取锐角值)。
2、构建函数模型
这里使用的函数模型是条件平差模型
1)确定必要的观测数
这里我们使用的条件方程就是在1中推导的约束条件:
方程中有8个未知数d,θ1,Δu和fR,doef,dT,α,β,其中fR,doef,dT,α,β可以通过标定得到,那么此条件方程得到d,θ1,Δu之间的关系。
2)确定条件方程并定权
A确定条件式
B将条件式线性化
Δu=f(θ1,d)取一阶偏导,得到
C确定权阵
初始权阵中,各个参数权值都设为1
P=(Pd,Pθ1,PΔu)=(1,1,1)
D确定改正数向量
用V表示改正数向量,则有:
其中vΔu表示
那么含有改正数向量的线性化方程可以表示为:
E确定闭合差
闭合差可以表示为:
写成矩阵的形式:
W=A·(Δu,θ1,d)T
其中
D确定条件方程
条件方程可以表示为:
3)构造法方程
未知数(改正数v)的个数比条件方程多,所以该方程的解不定,采用最小二乘法进行约束,利用拉格朗日条件极值构造乘系数向量K,
Φ=VTPV-2KT(AV-W)
其中条件极值和含K的改正向量分别表示为:
AV-W=0
V=P-1ATK
那么联系数法方程可以表示为:
AP-1ATK-W=0
4)求解联系数
由以上联系数法方程可知联系数法方程系数N:
N=AP-1AT
则K可以表示为:
K=N-1W
5)解算改正数
带入联系数法方程系数K就可以得到改正数向量:
V=P-1ATK
6)计算平差值
带入原数据向量,得到平差后的观测数值
3、确定随机模型
这里使用的随机模型是验后方差分量估计,又称为赫尔默特方差分量估计。
平差前观测值向量的方差阵一般是未知的,因此平差时随机模型都是使用观测值向量的权阵。而权的确定往往都是采用经验定权,也称为随机模型的验前估计,对于同类观测值可按第一章介绍的常用定权方法定权;对于不同类的观测值,就很难合理地确定各类观测值的权。为了合理地确定不同类观测值的权,可以根据验前估计权进行预平差,用平差后得到的观测值改正数来估计观测值的方差,根据方差的估计值重新进行定权,以改善第一次平差时权的初始值,再依据重新确定的观测值的权再次进行平差,如此重复,直到不同类观测值的权趋于合理。
1)将平差方程写成含参数的形式
将条件方程Δu=f(θ1,d)中的所有观测值均用参数形式表示:
其中B为系数矩阵:
则闭合差可以表示为:
改正数向量可以表示为:
求解参数改正值向量x:
x=(BTPB)-1BTPl
则参数的修正值为:
观测值的修正值为:
2)利用Helmet方差分量估计严密式计算单位权方差
Helmet方差分量估计严密式为:
其中:
N=N1+N2,
n1、n2分别为第一类、第二类平差量的数目,B1、B2分别为第一类、第二类平差量的系数矩阵,P1、P2分别为第一类、第二类平差量权值矩阵,分别为第一类、第二类平差量单位权方差,V1、V2分别为第一类、第二类平差量该整数向量。第一类为角度,第二类为长度(即距离)。
3)判断此次的权值是否合理
利用之前所确定的权值计算出来的单位权方差进行判断,若则认为所设定的权值是合理的,否则需要对权值进行调整。
4)对权值进行调整
若单位权方差值比相差较大,需要重新定权:
重新定权以后按照Helmet方差分量估计严密式判断权值是否合理。
4、进行差值检验
将最终定权以后的差值结果回带条件方程中,看是否满足条件方程的要求。
Claims (6)
1.一种靶标测头平差优化算法,其特征在于:首先建立空间向量与其在CCD成像之间的关系,然后构建条件平差模型计算平差值,最后对该平差值进行验证;其中,构建条件平差模型的过程中,在确定了观测数之后,假定初始的各个参数的权值均为1,在此假定条件下计算平差值,如果最终的平差值未通过验证,则重新调整各个参数的权值重新计算直至通过验证;空间向量与其在CCD成像之间的关系为:
其中,是有效焦距,fR是右相机的实际焦距,doef是主点与BAOR平面的距离,d是向量的模长,θ1是测头A与CCD摄像机光心o连线与向量的夹角,dT是两个相机光心OLOR之间的距离,α是向量与CCD摄像机光轴的夹角,β是右相机光轴与两个相机光心连线的夹角,Δu为CCD像面中所成像的实际大小。
2.根据权利要求1所述的一种靶标测头平差优化算法,其特征在于:构建条件平差模型计算平差值的具体方法包括以下步骤:
(1)以空间向量与其在CCD成像之间的关系为条件式;
(2)对步骤(1)的条件式进行线性化;
(3)确定权阵:在初始权阵P中,假定各个参数的权值均为1;
(4)确定改正数向量V:
(5)确定闭合差W:W=A·(Δu,θ1,d)T,其中,f=Δu为fR、d、θ1、dT、α、β的函数;
(6)确定随机模型并计算平差值。
3.根据权利要求2所述的一种靶标测头平差优化算法,其特征在于:在确定闭合差以后首先计算出改正数向量的一个初值,然后再确定随机模型计算平差值,计算改正数向量的方法包括以下步骤:
(A)将条件式改写为:
(B)构造联系数法方程:
(B1)利用拉格朗日条件极值构造乘系数向量K:
Φ=VTPV-2KT(AV-W),Φ是根据拉格朗日条件极值构造的公式,P初始权阵,各个参数的权值均为1;
其中,
AV-W=0
条件式为:V=P-1ATK,
AV-W=0
含K的改正数向量为:V=P-1ATK
则,法方程为:AP-1ATK-W=0;
(B2)令联系数法方程系数N为:N=AP-1AT,
则乘系数向量K为:
K=N-1W
(B3)利用以下公式计算改正数向量:
V=P-1ATK。
4.根据权利要求2或3所述的一种靶标测头平差优化算法,其特征在于:所述步骤(6)的具体步骤包括以下:
(6.1)将步骤(1)条件式中的所有观测值均用参数形式表示,具体如下:
令:则闭合差为:改正数向量为:
求解参数改正数向量x:x=(BTPB)-1BTPl,为t行1列的初始参数向量,为t行1列的参数改正数向量,x=(BTPB)-1BTPl,
则参数的修正值为:X为参数向量,
观测值的修正值为:L是观测值向量,
5.根据权利要求1所述的一种靶标测头平差优化算法,其特征在于:利用Helmet方差分量估计严密式计算单位权方差,以对方差值进行验证,Helmet方差分量估计严密式为:
其中,
n1是第一种类型的观测变量的数量;n2是第二种类型的观测变量的数量;N1是第一类观测变量联系数法方程系数:N1=A1P1 -1A1;N2是第二类观测变量联系数法方程系数:N2=A2P2 - 1A2;V1是第一类改正数向量:V1=P1 -1A1 TK1;V2是第二类改正数向量:V2=P2 -1A2 TK2;P1是第一类观测变量初始权阵,初始值为1;P2是第二类观测变量初始权阵,初始值为1;B1是第一类观测变量根据成像约束条件的转化为线性关系的系数,B2是第二类观测变量根据成像约束条件的转化为线性关系的系数,
若则认为所设定的权值合理,是第一类观测变量的单位权方差;是第二类观测变量的单位权方差。
6.根据权利要求5所述的一种靶标测头平差优化算法,其特征在于:重新调整权值采用以下公式:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610019132.8A CN105678088B (zh) | 2016-01-12 | 2016-01-12 | 一种靶标测头的平差优化算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610019132.8A CN105678088B (zh) | 2016-01-12 | 2016-01-12 | 一种靶标测头的平差优化算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105678088A CN105678088A (zh) | 2016-06-15 |
CN105678088B true CN105678088B (zh) | 2019-01-18 |
Family
ID=56300306
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610019132.8A Active CN105678088B (zh) | 2016-01-12 | 2016-01-12 | 一种靶标测头的平差优化算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105678088B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106530356B (zh) * | 2016-10-25 | 2019-10-15 | 成都通甲优博科技有限责任公司 | 一种全景视频摄像机组空间位姿标定方法 |
CN109059761B (zh) * | 2018-08-01 | 2020-06-19 | 西安交通大学 | 一种基于eiv模型的手持靶标测头标定方法 |
CN112304220B (zh) * | 2020-10-26 | 2022-04-08 | 中国人民解放军陆军装甲兵学院 | 一种基于测量平差的双目相机坐标系配准方法 |
CN114894094B (zh) * | 2022-07-14 | 2022-09-23 | 青岛环海海洋工程勘察研究院有限责任公司 | 一种空间多靶标布设的激光扫描仪指标评估方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102376089A (zh) * | 2010-12-09 | 2012-03-14 | 深圳大学 | 一种标靶校正方法及系统 |
CN102889882A (zh) * | 2012-09-03 | 2013-01-23 | 北京信息科技大学 | 一种基于光束平差的三维重建方法 |
CN104019799A (zh) * | 2014-05-23 | 2014-09-03 | 北京信息科技大学 | 一种利用局部参数优化计算基础矩阵的相对定向方法 |
CN105139411A (zh) * | 2015-09-24 | 2015-12-09 | 大连理工大学 | 基于四套共线约束标定尺的大视场相机标定方法 |
CN105180806A (zh) * | 2015-08-25 | 2015-12-23 | 大连理工大学 | 基于显微视觉的跨尺度几何参数测量方法 |
-
2016
- 2016-01-12 CN CN201610019132.8A patent/CN105678088B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102376089A (zh) * | 2010-12-09 | 2012-03-14 | 深圳大学 | 一种标靶校正方法及系统 |
CN102889882A (zh) * | 2012-09-03 | 2013-01-23 | 北京信息科技大学 | 一种基于光束平差的三维重建方法 |
CN104019799A (zh) * | 2014-05-23 | 2014-09-03 | 北京信息科技大学 | 一种利用局部参数优化计算基础矩阵的相对定向方法 |
CN105180806A (zh) * | 2015-08-25 | 2015-12-23 | 大连理工大学 | 基于显微视觉的跨尺度几何参数测量方法 |
CN105139411A (zh) * | 2015-09-24 | 2015-12-09 | 大连理工大学 | 基于四套共线约束标定尺的大视场相机标定方法 |
Non-Patent Citations (2)
Title |
---|
"一种有效的基于消失点的摄像机自标定方法";蒋中强等;《计算机技术与发展》;20140910;第24卷(第9期);第54-58页 |
"基于多像灭点进行相机标定的方法研究";谢文寒;《中国博士学位论文全文数据库 基础科学辑》;20061115(第 11 期);正文第47-52页 |
Also Published As
Publication number | Publication date |
---|---|
CN105678088A (zh) | 2016-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108510551B (zh) | 一种远距离大视场条件下相机参数的标定方法及系统 | |
CN104537707B (zh) | 像方型立体视觉在线移动实时测量系统 | |
CN109859272B (zh) | 一种自动对焦双目摄像头标定方法及装置 | |
CN102353340B (zh) | 缸盖毛坯加工尺寸识别方法及装置 | |
CN104374338B (zh) | 一种基于固定相机和单靶标的单轴旋转角的视觉测量方法 | |
CN104268876B (zh) | 基于分块的摄像机标定方法 | |
Chatterjee et al. | Algorithms for coplanar camera calibration | |
CN111192235B (zh) | 一种基于单目视觉模型和透视变换的图像测量方法 | |
CN111667536A (zh) | 一种基于变焦相机深度估计的参数标定方法 | |
CN105678088B (zh) | 一种靶标测头的平差优化算法 | |
CN108269289B (zh) | 一种相机参数标定的两步优化方法 | |
CN109974618B (zh) | 多传感器视觉测量系统的全局标定方法 | |
CN109579695B (zh) | 一种基于异构立体视觉的零件测量方法 | |
CN110009690A (zh) | 基于极线校正的双目立体视觉图像测量方法 | |
CN109961485A (zh) | 一种基于单目视觉进行目标定位的方法 | |
CN113920205B (zh) | 一种非同轴相机的标定方法 | |
WO2021129437A1 (zh) | 一种无需白图像的光场相机检校方法及系统 | |
CN105066962A (zh) | 一种多分辨率大视场角高精度摄影测量装置 | |
CN114001651B (zh) | 一种基于双目视觉测量和先验检测数据的大型细长筒类构件位姿原位测量方法 | |
CN105043250A (zh) | 一种基于至少两个公共标记点的双视角数据对齐方法 | |
CN104167001B (zh) | 基于正交补偿的大视场摄像机标定方法 | |
Perdigoto et al. | Calibration of mirror position and extrinsic parameters in axial non-central catadioptric systems | |
CN110487254B (zh) | 一种用于rov的水下目标尺寸快速测量方法 | |
CN112489141B (zh) | 车载摄像头单板单图带中继镜的产线标定方法及装置 | |
CN111127560B (zh) | 一种用于三维重建的三目视觉系统的标定方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |