CN104537655B - 一种基于普吕克直线的成像几何模型的定位方法 - Google Patents
一种基于普吕克直线的成像几何模型的定位方法 Download PDFInfo
- Publication number
- CN104537655B CN104537655B CN201410809663.8A CN201410809663A CN104537655B CN 104537655 B CN104537655 B CN 104537655B CN 201410809663 A CN201410809663 A CN 201410809663A CN 104537655 B CN104537655 B CN 104537655B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- msubsup
- straight line
- lvke
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/10—Segmentation; Edge detection
- G06T7/13—Edge detection
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10032—Satellite or aerial image; Remote sensing
Abstract
本发明公开了一种基于普吕克直线的成像几何模型方法,属于测绘科学与技术领域。它包括以下步骤:像方和物方提取同名直线;将像方直线螺旋运动到与物方直线共面,得到共面条件方程;利用共面条件方程可以建立强几何条件的普吕克直线成像几何模型;采用最小二乘平差法计算出外方位元素。本发明利用了普吕克直线可以直观明了地表示空间矢量的螺旋运动,而且模型简洁,几何意义明确。相比传统方法,基于普吕克直线的成像几何模型的几何定位精度更高、结果更稳定。
Description
技术领域
本发明涉及一种成像几何模型方法,属于测绘科学与技术领域。
背景技术
摄影测量的核心问题是建立成像几何模型,即从地物空间各种要素的关系入手,确定各种空间要素从三维物方空间到二维像方的映射关系,以及从二维影像恢复三维空间要素的对应关系。传统的成像几何模型主要存在两个问题:一是大多数遥感影像中明显点(交点和角点)较少,以及摄影目标相互遮挡以及目标自身遮挡等原因,要提取足够并且精确的特征点很难实现;二是点摄影测量在进行成像几何模型平差时,由于偶然误差的不断累积,影像外方位元素尤其是是Zs及φ很容易弯曲变形。在现实世界中,大量存在的是直线特征,相比点而言,直线更容易提取,而且允许部分遮挡情况,不要求同名直线段端点是同名点,更重要的是直线具有更强的几何拓扑性和几何约束性,能有效控制由于偶尔误差二次积累等原因造成的区域网扭曲变形。因此,利用影像上存在的大量直线作为控制要素构建成像几何模型,具有重要的实际应用价值。
发明内容
发明目的:为了克服现有技术中存在的不足,本发明提供一种基于普吕克直线的成像几何模型的定位方法,该方法与传统的基于点的成像几何模型相比,具有同名直线特征更容易提取和几何模型约束力更强的优点。
为实现上述目的,本发明采用的技术方案为:一种基于普吕克直线的成像几何模型的定位方法,包括以下步骤:
第1步,获取地物的物方数据和像方数据,选取物方数据中不重合的两点确定初始物方直线,选取像方数据中不重合的两点确定初始像方直线;对初始物方直线进行普吕克坐标变换得到以普吕克坐标变换表示的物方直线;对初始像方直线进行普吕克坐标变换得到以普吕克坐标变换表示的像方直线;
第2步,将以普吕克坐标变换表示的像方直线螺旋运动到与以普吕克坐标变换表示的物方直线共面,构建普吕克直线成像几何模型;
第3步,将第2步中构建普吕克直线成像几何模型的每对物方直线和其对应的像方直线组成误差方程式并法化,计算未知数改正数,计算改正后的外方位元素,判断未知数改正数是否小于设定的限差;
第4步,重复第3步骤,直到未知数改正数小于设定的限差,得出外方位元素的解,实现通过第2步中普吕克直线成像几何模型进行几何定位。
所述第1步中对初始物方直线进行普吕克坐标变换得到以普吕克坐标变换表示的物方直线的方法如下:
由物方数据中不重合的两个点(X1,Y1,Z1)和(X2,Y2,Z2)确定初始物方直线,则以普吕克坐标表示的物方直线如下:式中:ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1;
L=X2-X1,M=Y2-Y1,N=Z2-Z1;
L0=Y1Z2-Y2Z1,M0=X2Z1-X1Z2,N0=X1Y2-X2Y1;
所述第1步中对初始像方直线进行普吕克坐标变换得到以普吕克坐标变换表示的像方直线的方法如下:
由像方数据中不重合的两个点(x1,y1,z1)和(x2,y2,z2)确定初始像方直线,则以普吕克坐标表示的像方直线如下:式中:ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1;
L1=x2-x1,M1=y2-y1,N1=z2-z1;
L10=y1z2-y2z1,M10=x2z1-x1z2,N10=x1y2-x2y1。
所述第2步中构建普吕克直线成像几何模型的方法,包括以下步骤:
第21步,将以普吕克坐标变换表示的像方直线围绕单位对偶矢量螺旋运动对偶角后,可得到直线
直线的普吕克坐标:
普吕克直线螺旋运动方程为:
式中,为单位对偶四元数,且 为的共轭;则的普吕克坐标中的L2,L20,M2,M20,N2,N20为:
第22步,以普吕克坐标变换表示的像方直线螺旋运动后得到的直线与其对应物方上的同名直线L共面,此时的对偶部为零,由此构建出普吕克直线成像几何模型:
F=L20L+M20M+N20N+L2L0+M2M0+N2N0=0。
所述第3步中判断未知数改正数是否小于设定的限差的方法,包括以下步骤:
第31步,将第22步中构建出的普吕克直线成像几何模型用泰勒公式按未知数展开至一次项,并将该式改写为误差方程式的矩阵形式;
第32步,对改写后的误差方程式的矩阵形式根据最小二乘间接平差原理,得出其法方程式,进而得到该法方程式解,从而可求出外方位元素的近似值改正数;
所述第4步实现通过第2步中普吕克直线成像几何模型进行几何定位的方法,每次迭代时用未知数近似值与上次迭代计算的改正数之和作为新的近似值,重复第32步的计算过程,求出新的改正数,这样反复趋近,直到改正数小于限差为止,最后得出外方位元素的解,实现通过普吕克直线成像几何模型进行几何定位。
本发明提供的基于普吕克直线的成像几何模型的定位方法,相比现有技术,具有以下有益效果:由于以普吕克坐标变换表示的物方直线螺旋运动到与以普吕克坐标变换表示的像方直线共面,构建普吕克直线成像几何模型,因此相比于传统的成像几何模型,本分发明的同名直线特征更容易提取,而且几何模型约束力更强;同时采用物方直线和像方直线构建普吕克直线成像几何模型能够提高外方位元素的解算精度,减少了偶然误差的累积,防止影像外方位元素弯曲变形,使得本发明几何定位后的投影点与影像的实际边缘套合得很准确,而且由于本发明对直线的约束性更强,对高程值较高的建筑物的定位效果也很理想。
附图说明
图1为基于普吕克直线的成像几何模型的定位方法流程图。
图2为本发明实例的航空影像图。
图3为本发明实例的LiDAR点云示意图。
图4为本发明实例的几何定位效果图,其中图4a为区域1配准前示意图,图4b为区域1配准后示意图,图4c为区域2配准前示意图,图4d为区域1配准后示意图,。
具体实施方式
下面结合附图对本发明作更进一步的说明。
一种基于普吕克直线的成像几何模型的定位方法,如图1所示,包括以下步骤:
第1步,获取地物的物方数据和像方数据,选取物方数据中不重合的两点确定初始物方直线,选取像方数据中不重合的两点确定初始像方直线;对初始物方直线进行普吕克坐标变换得到以普吕克坐标变换表示的物方直线;对初始像方直线进行普吕克坐标变换得到以普吕克坐标变换表示的像方直线;
所述第1步中对初始物方直线进行普吕克坐标变换得到以普吕克坐标变换表示的物方直线的方法如下:
由物方数据中不重合的两个点(X1,Y1,Z1)和(X2,Y2,Z2)确定初始物方直线,则以普吕克坐标表示的物方直线如下:式中:ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1;
L=X2-X1,M=Y2-Y1,N=Z2-Z1;
L0=Y1Z2-Y2Z1,M0=X2Z1-X1Z2,N0=X1Y2-X2Y1;
所述第1步中对初始像方直线进行普吕克坐标变换得到以普吕克坐标变换表示的像方直线的方法如下:
由像方数据中不重合的两个点(x1,y1,z1)和(x2,y2,z2)确定初始像方直线,则以普吕克坐标表示的像方直线如下:式中:ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1;
L1=x2-x1,M1=y2-y1,N1=z2-z1;
L10=y1z2-y2z1,M10=x2z1-x1z2,N10=x1y2-x2y1。
第2步,将以普吕克坐标变换表示的像方直线螺旋运动到与以普吕克坐标变换表示的物方直线共面,构建普吕克直线成像几何模型;
所述第2步中构建普吕克直线成像几何模型的方法,包括以下步骤:
第21步,将以普吕克坐标变换表示的像方直线围绕单位对偶矢量螺旋运动对偶角后,可得到直线
直线的普吕克坐标:
普吕克直线螺旋运动方程为:
式中,为单位对偶四元数,且 为的共轭;则的普吕克坐标中的L2,L20,M2,M20,N2,N20为:
第22步,以普吕克坐标变换表示的像方直线螺旋运动后得到的直线与其对应物方上的同名直线L共面,此时的对偶部为零,由此构建出普吕克直线成像几何模型:
F=L20L+M20M+N20N+L2L0+M2M0+N2N0=0。
第3步,将第2步中构建普吕克直线成像几何模型的每对物方直线和其对应的像方直线组成误差方程式并法化,计算未知数改正数,计算改正后的外方位元素,判断未知数改正数是否小于设定的限差;
所述第3步中判断未知数改正数是否小于设定的限差的方法,包括以下步骤:
第31步,将第22步中构建出的普吕克直线成像几何模型用泰勒公式按未知数展开至一次项,并将该式改写为误差方程式的矩阵形式;
第32步,对改写后的误差方程式的矩阵形式根据最小二乘间接平差原理,得出其法方程式,进而得到该法方程式解,从而可求出外方位元素的近似值改正数。
第4步,重复第3步骤,直到未知数改正数小于设定的限差,得出外方位元素的解,实现通过第2步中普吕克直线成像几何模型进行几何定位。
每次迭代时用未知数近似值与上次迭代计算的改正数之和作为新的近似值,重复第32步的计算过程,求出新的改正数,这样反复趋近,直到改正数小于限差为止,最后得出外方位元素的解,实现通过普吕克直线成像几何模型进行几何定位。
本发明的原理:
如图1所示,本发明基于普吕克直线的成像几何模型的定位方法流程图。
第一步:普吕克坐标变换
①获取地物空间的物方数据和像方数据,由物方不重合的两个点(X1,Y1,Z1)和
(X2,Y2,Z2)可以确定物方直线,以普吕克坐标表示的物方直线如下:
其中
L=X2-X1,M=Y2-Y1,N=Z2-Z1
L0=Y1Z2-Y2Z1,M0=X2Z1-X1Z2,N0=X1Y2-X2Y1 (1)
式中,ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1。
②同样地,由像方不重合的两个点(x1,y1,z1)和(x2,y2,z2)可以确定像方直线 的普吕克坐标表示方法如下:其中
L1=x2-x1,M1=y2-y1,N1=z2-z1
L10=y1z2-y2z1,M10=x2z1-x1z2,N10=x1y2-x2y1 (2)
式中,ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1。
第二步:构建普吕克直线成像几何模型
①将像方直线围绕单位对偶矢量(螺旋轴)螺旋运动(对偶角)后,可得到直线 的普吕克坐标为则普吕克直线螺旋运动方程为:
式中,为单位对偶四元数,且 为的共轭;则由(3)式可得到的普吕克坐标中的L2,L20,M2,M20,N2,N20公式为:
②像方直线螺旋运动后的直线与其对应物方上的同名直线L共面,此时的对偶部为零,由此构建出普吕克直线成像几何模型:
F=L20L+M20M+N20N+L2L0+M2M0+N2N0=0 (4)
③为了便于计算,将(4)式用泰勒公式按未知数展开至一次项:
F=F0+a1dq1+a2dq2+a3dq3+a4dq4+a5dq01+a6dq02+a7dq03+a8dq04 (5)
式中,
a1=2q1(L0L1+M0M1+N0N1+L10L+M10M+N10N)
+2q2(M10N-N10M+M1N0-N1M0)+2q3(-L10N+N1L0-L1N0+N10L)
+2q4(L10M-M10L+L1M0-M1L0)+2q01(L1L+M1M+N1N)
+2q02(M1N-N1M)+2q03(N1L-L1N)+2q04(L1M-M1L);
a2=2q1(M10N-N10M+M1N0-N1M0)+2q2(L10L-M10M-N10N+L1L0-M1M0-N1N0)
+2q3(LM10+ML10+L0M1+M0L1)+2q4(L1N0+N1L0+L10N+N10L)
+2q01(M1N-N1M)+2q02(L1L-M1M-N1N)+2q03(M1L+L1M)+2q04(L1N+N1L)
a3=2q1(-L10N+N10L-L1N0+N1L0)+2q2(LM10+ML10+L0M1+M0L1)
+2q3(-LL10+MM10-NN10-L1L0+M1M0-N1N0)
+2q4(MN10+NM10+M0N1+N0M1)+2q01(-L1N+N1L)
+2q02(LM1+ML1)+2q03(-L1L+M1M-N1N)+2q04(M1N+N1M)
a4=2q1(L10M-M10L+L1M0-M1L)+2q2(LN10+NL10+L0N1+N0L1)
+2q3(MN10+NM10+M0N1+N0M1)
+2q4(-L0L1-M0*M1+N0N1-L10L-M10M+N10N)+2q01(L1M-M1L)
+2q02(L1N+N1L)+2q03(M1N+N1M)+2q04(-L1L-M1M+N1N)
a5=2q1(L1L+M1M+N1N)+2q2(M1N-N1M)+2q3(-L1N+N1L)+2q4(N1L-NL1)
a6=2q1(M1N-N1M)+2q2(L1L-M1M-N1N)+2q3(L1M+M1L)+2q4(L1N+N1L)
a7=2q1(-L1N+N1L)+2q2(L1M+M1L)+2q3(-L1L+M1M-N1N)+2q4(M1N+N1M)
a8=2q1(L1M-M1L)+2q2(L1N+N1L)+2q3(M1N+N1M)+2q4(-L1L-M1M+N1N)
第三步:对每对物方直线和对应像方直线分别组成误差方程式并法化,计算未知数改正数和改正后的外方位元素。
①将(5)式改写为误差方程式的矩阵形式:
V=AX+F (6)
式中:A=[a1 a2 a3 a4 a5 a6 a7 a8],X=[dq1 dq2 dq3 dq4 dq01 dq02 dq03 dq04]T
②根据最小二乘间接平差原理,可列出法方程式:
ATAX=ATL (7)
由此得到法方程式解的表达式:
X=(ATA)-1ATL (8)从而可求出外方位元素的近似值改正数ΔXS,ΔYS,ΔZS,Δω,Δκ。
③每次迭代时用未知数近似值与上次迭代计算的改正数之和作为新的近似值,重复计算过程,求出新的改正数,这样反复趋近,直到改正数小于某一限差为止,最后得出外方位元素的解,实现几何定位。
由上述可知,本发明通过像方和物方提取同名直线;将像方直线螺旋运动到与物方直线共面,得到共面条件方程;利用共面条件方程可以建立强几何条件的普吕克直线成像几何模型;采用最小二乘平差法计算出外方位元素。本发明利用了普吕克直线可以直观明了地表示空间矢量的螺旋运动,而且模型简洁,几何意义明确。相比传统方法,基于普吕克直线的成像几何模型的几何定位精度更高、结果更稳定。
实例
根据某城市的机载LiDAR点云对航空影像进行几何定位,航空影像由Vexcel公司的UltraCam-D(UCD)大幅片数码相机获取,UCD相机焦距为101.4mm,CCD像元大小为9μm,航高约为1600m,影像地面分辨率为15cm,辐射分辨率为8位,像幅大小为7500×11500个像元,如图2所示。LiDAR点云由Optech公司的ALTM ORION M超小型机载激光雷达采集,平均飞行高度为650m,时速120海里,点云密度约为6.0点/m2。如图3所示。在图2和图3中,分别选取像方直线和对应物方直线,分别10条,用白色表示,且用数字标志出图中像方直线和对应物方直线,坐标如表1所示。
表1像方直线和对应物方直线坐标
根据表1中像方直线和对应物方直线的坐标,分别利用公式(1)和公式(2)可以得到普吕克直线,如表2所示。
表2像方直线和对应物方直线的普吕克坐标
利用本发明的成像几何模型,可求解出图2所示航空影像的定位参数为:q1=-298222.828979,q2=1257213.993143,r3=103197.794481,q4=2909103.362917,q01=0.914235,q02=-0.030335,q03=0.393226,q04=0.092882。再将其转换为外方位元素,转换后定位参数分别为Xs=4549387.291195m,Ys=833271.851117m,Zs=4379606.998539m,phi=-45.999395°,omiga=-7.383712°,kapa=8.464432°。图4分别显示了几何定位前后两个局部区域的效果,由于外方位元素并不准确,LiDAR点云的投影点与屋顶的实际位置存在较大的偏差,而从几何定位后的投影结果可以看到投影点与屋顶的实际边缘套合得很准确,由于本发明对直线的约束性更强,对高程值较高的建筑物的定位效果也很理想。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (4)
1.一种基于普吕克直线的成像几何模型的定位方法,其特征在于,包括以下步骤:
第1步,获取地物的物方数据和像方数据,选取物方数据中不重合的两点确定初始物方直线,选取像方数据中不重合的两点确定初始像方直线;对初始物方直线进行普吕克坐标变换得到以普吕克坐标变换表示的物方直线;对初始像方直线进行普吕克坐标变换得到以普吕克坐标变换表示的像方直线;
所述第1步中对初始物方直线进行普吕克坐标变换得到以普吕克坐标变换表示的物方直线的方法如下:
由物方数据中不重合的两个点(X1,Y1,Z1)和(X2,Y2,Z2)确定初始物方直线,则以普吕克坐标表示的物方直线如下:式中:ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1;
L=X2-X1,M=Y2-Y1,N=Z2-Z1;
L0=Y1Z2-Y2Z1,M0=X2Z1-X1Z2,N0=X1Y2-X2Y1;
所述第1步中对初始像方直线进行普吕克坐标变换得到以普吕克坐标变换表示的像方直线的方法如下:
由像方数据中不重合的两个点(x1,y1,z1)和(x2,y2,z2)确定初始像方直线,则以普吕克坐标表示的像方直线如下:式中:ε为对偶单位,满足:ε2=0,ε≠0,i,j,k为虚数单位,满足i2=j2=k2=ijk=-1;
L1=x2-x1,M1=y2-y1,N1=z2-z1;
L10=y1z2-y2z1,M10=x2z1-x1z2,N10=x1y2-x2y1;
第2步,将以普吕克坐标变换表示的像方直线螺旋运动到与以普吕克坐标变换表示的物方直线共面,构建普吕克直线成像几何模型;
第3步,将第2步中构建普吕克直线成像几何模型的每对物方直线和其对应的像方直线组成误差方程式并法化,计算未知数改正数,计算改正后的外方位元素,判断未知数改正数是否小于设定的限差;
第4步,重复第3步骤,直到未知数改正数小于设定的限差,得出外方位元素的解,实现通过第2步中普吕克直线成像几何模型进行几何定位。
2.根据权利要求1所述的基于普吕克直线的成像几何模型的定位方法,其特征在于:所述第2步中构建普吕克直线成像几何模型的方法,包括以下步骤:
第21步,将以普吕克坐标变换表示的像方直线围绕单位对偶矢量螺旋运动对偶角后,可得到直线
直线的普吕克坐标:
普吕克直线螺旋运动方程为:
式中,为单位对偶四元数,且 为的共轭;则的普吕克坐标中的L2,L20,M2,M20,N2,N20为:
<mrow>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>M</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>M</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
1
<mrow>
<msub>
<mi>N</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>N</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>L</mi>
<mn>20</mn>
</msub>
<mo>=</mo>
<msub>
<mi>L</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>M</mi>
<mn>20</mn>
</msub>
<mo>=</mo>
<msub>
<mi>M</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>N</mi>
<mn>20</mn>
</msub>
<mo>=</mo>
<msub>
<mi>N</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>q</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>q</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>q</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>10</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>M</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>N</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
<msub>
<mi>q</mi>
<mn>03</mn>
</msub>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>01</mn>
</msub>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
<msub>
<mi>q</mi>
<mn>04</mn>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mn>02</mn>
</msub>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
第22步,以普吕克坐标变换表示的像方直线螺旋运动后得到的直线与其对应物方上的同名直线L共面,此时的对偶部为零,由此构建出普吕克直线成像几何模型:
F=L20L+M20M+N20N+L2L0+M2M0+N2N0=0。
3.根据权利要求2所述的基于普吕克直线的成像几何模型的定位方法,其特征在于:所述第3步中判断未知数改正数是否小于设定的限差的方法,包括以下步骤:
第31步,将第22步中构建出的普吕克直线成像几何模型用泰勒公式按未知数展开至一次项,并将该式改写为误差方程式的矩阵形式;
第32步,对改写后的误差方程式的矩阵形式根据最小二乘间接平差原理,得出其法方程式,进而得到该法方程式解,从而可求出外方位元素的近似值改正数。
4.根据权利要求3所述的基于普吕克直线的成像几何模型的定位方法,其特征在于:所述第4步实现通过第2步中普吕克直线成像几何模型进行几何定位的方法,每次迭代时用未知数近似值与上次迭代计算的改正数之和作为新的近似值,重复第32步的计算过程,求出新的改正数,这样反复趋近,直到改正数小于限差为止,最后得出外方位元素的解,实现通过普吕克直线成像几何模型进行几何定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410809663.8A CN104537655B (zh) | 2014-12-22 | 2014-12-22 | 一种基于普吕克直线的成像几何模型的定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410809663.8A CN104537655B (zh) | 2014-12-22 | 2014-12-22 | 一种基于普吕克直线的成像几何模型的定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104537655A CN104537655A (zh) | 2015-04-22 |
CN104537655B true CN104537655B (zh) | 2017-10-31 |
Family
ID=52853174
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410809663.8A Active CN104537655B (zh) | 2014-12-22 | 2014-12-22 | 一种基于普吕克直线的成像几何模型的定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104537655B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105628052B (zh) * | 2015-12-24 | 2020-02-14 | 武汉大学 | 基于控制直线的光学卫星传感器在轨几何定标方法及系统 |
CN106441591B (zh) * | 2016-09-28 | 2019-01-01 | 南京航空航天大学 | 一种星载高分辨率热红外影像几何定位方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102620656A (zh) * | 2012-04-16 | 2012-08-01 | 南京航空航天大学 | 一种航天器交会对接相对位姿测量方法 |
-
2014
- 2014-12-22 CN CN201410809663.8A patent/CN104537655B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102620656A (zh) * | 2012-04-16 | 2012-08-01 | 南京航空航天大学 | 一种航天器交会对接相对位姿测量方法 |
Non-Patent Citations (2)
Title |
---|
MOTOR METHOD OF ROBOT END EFFECTOR PATH GENERATION;Zha Xuanfang等;《Journal of Southeast University》;19920630;第8卷(第1期);116-123 * |
基于成像几何模型的火星探测器定位研究;刘微微;《万方学位论文数据库》;20130731;正文第32-42页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104537655A (zh) | 2015-04-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107160395A (zh) | 地图构建方法及机器人控制系统 | |
CN105203084B (zh) | 一种无人机3d全景视觉装置 | |
CN106204443A (zh) | 一种基于多目复用的全景无人机系统 | |
US8315477B2 (en) | Method and apparatus of taking aerial surveys | |
CN109801374B (zh) | 一种通过多角度图像集重构三维模型的方法、介质及系统 | |
CN104376596B (zh) | 一种基于单幅图像的三维场景结构建模与注册方法 | |
CN103456038A (zh) | 一种井下环境三维场景重建方法 | |
US20150172628A1 (en) | Altering Automatically-Generated Three-Dimensional Models Using Photogrammetry | |
CN104034305B (zh) | 一种单目视觉实时定位的方法 | |
CN101329771A (zh) | 一种基于图像序列的城市街区的快速建模方法 | |
CN102509354B (zh) | 一种与影像同步变化的投影数字高程模型制作方法 | |
JP6238101B2 (ja) | 数値表層モデル作成方法、及び数値表層モデル作成装置 | |
CN105004337B (zh) | 基于直线匹配的农用无人机自主导航方法 | |
JP7273927B2 (ja) | 画像ベースの測位方法及びシステム | |
CN102436676A (zh) | 一种智能视频监控的三维重建方法 | |
CN108876828A (zh) | 一种无人机图像批处理三维重建方法 | |
CN104537655B (zh) | 一种基于普吕克直线的成像几何模型的定位方法 | |
Haala et al. | High density aerial image matching: State-of-the-art and future prospects | |
Liu et al. | A new approach to fast mosaic UAV images | |
Peng et al. | Automatic registration of optical images with airborne LiDAR point cloud in urban scenes based on line-point similarity invariant and extended collinearity equations | |
JP2020008802A (ja) | 三次元マップ生成装置および三次元マップ生成方法 | |
Jin et al. | Shipborne Mobile photogrammetry for 3D mapping and landslide detection of the water-level fluctuation zone in the three gorges reservoir area, China | |
JP2007271869A (ja) | 画像処理による地図作成方法、その装置及びそのコンピュータプログラム | |
CN102110290B (zh) | 一种利用正三棱柱靶标求解摄像机内参数方法 | |
CN105389819A (zh) | 一种鲁棒的半标定下视图像极线校正方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230411 Address after: Room 201, Room 101, Building 1, No. 18, Daoyuan Road, High-tech Zone, Suzhou City, Jiangsu Province, 215000 Patentee after: SUZHOU ZHONGKETIANQI REMOTE SENSING TECHNOLOGY CO.,LTD. Address before: No. 29, Qinhuai District, Qinhuai District, Nanjing, Jiangsu Patentee before: Nanjing University of Aeronautics and Astronautics |