CN105509733B - 非合作空间圆目标的相对位姿测量方法 - Google Patents
非合作空间圆目标的相对位姿测量方法 Download PDFInfo
- Publication number
- CN105509733B CN105509733B CN201510854639.0A CN201510854639A CN105509733B CN 105509733 B CN105509733 B CN 105509733B CN 201510854639 A CN201510854639 A CN 201510854639A CN 105509733 B CN105509733 B CN 105509733B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- space
- mtd
- mover
- 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
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/04—Interpretation of pictures
- G01C11/06—Interpretation of pictures by comparison of two or more pictures of the same area
- G01C11/08—Interpretation of pictures by comparison of two or more pictures of the same area the pictures not being supported in the same relative position as when they were taken
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Multimedia (AREA)
- Image Analysis (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明提出一种非合作空间圆目标的相对位姿测量方法,包括提供左右相机拍摄空间圆目标形成的左图像和右图像,空间圆目标分别成像为左椭圆、右椭圆;采用非线性最小二乘法拟合,检测出其中的椭圆或近似椭圆,作为候选椭圆;根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;根据拟合左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解。可解决传统的方法在姿态解算过程中存在二义性问题。
Description
技术领域
本发明涉及空间圆目标的测量技术,特别涉及的是非合作空间圆目标的相对位姿测量技术。
背景技术
随着空间技术的发展,对故障或失效卫星的空间在轨服务和碎片清除等,非合作空间飞行器的近程操作活动的需求越来越多。其发展趋势是研制面向非合作目标的自主空间飞行器,通过自主接近非合作空间飞行器,以执行空间在轨服务或清除任务。目前,非合作空间飞行器中可供识别和对接抓捕的部位主要包括星箭对接环、远地点发动机喷管、太阳帆板、对地通信天线支架等。星箭对接环、发动机喷管等具有明显的空间圆特征,为自主完成空间服务任务,迫切需要针对这一类具有明显空间圆特征非合作空间飞行器的超近距离相对位姿测量技术。
现有技术中,通过从二维图像中提取椭圆来估计空间圆的姿态。椭圆检测一般采用基于非线性最小二乘拟合法实现,椭圆方程的一般数学模型如公式(9)所示:
Ax2+2Bxy+Cy2+2Dx+2Ey+1=0 (9)
其中要求AC-B2>0,A,B,C,D,E为待定的一般椭圆方程系数。将上式写成矩阵形式有:
假设(xi,yi),i=1,…,N为椭圆上的数据点即对应图像上二维坐标点,椭圆拟合即估计椭圆方程中的各个参数。如公式(11)所示,通过非线性最小二乘法即可解算出未知参数A,B,C,D,E。
令世界坐标系Ow-XwYwZw的原点位于圆心位置,其Z轴与圆所在平面的法向平行。参看图1,将世界坐标系中的圆投影到相机成像坐标系,世界坐标系Ow-XwYwZw与相机成像坐标系O-XYZ的变换关系如下:
其中,[u,v,1]T为成像平面上点的齐次坐标,P=[x,y,z,1]T为空间点的齐次坐标,H=K[r1 r2 r3 t]为平面单应矩阵,K为相机的内参数矩阵,R=[r1,r2,r3]为空间旋转矩阵,t为平移向量,s为比例因子。
圆在世界坐标系下方程可表示为如(13)的矩阵形式:
其中,r为圆的半径。
记Q=diag{1,1,-r2},于是,圆投影方程为
[u,v,1]H-TQH-1[u,v,1]T=0,则有
记M-1=sH-TQH-1=s(HQ-1HT)-1,则有
其中,s为一比例因子。由方程(14)可知,圆投影方程中隐含了圆位姿参数,包括圆心的位置t及圆所在平面的法向量r3。
将方程(14)写如下形式:
注意到等式左端矩阵秩≤2且等式右端矩阵为实对称矩阵,因此可作如下分解:I-sK-1MK-T=Udiag{λ1,λ2,0}UT
其中,U为3×3正交矩阵。通过解算可得到圆的三维姿态参数如下:
其中λ1,λ2为I-sK-1MK-T的特征值,U为3*3的正交矩阵,θ和ψ为方便表示r3和t/r而采用的数学符号,且满足UTU=I,θ+ψ=π/2,3π/2,由于因此有如下等式成立:
λ1cos2θ+λ2cos2ψ=1,λ1cos2θ+λ2sin2θ=1
根据上述两个等式可进一步得到:
sin2θ=(λ1-1)/(λ1-λ2)
由上式可确定θ和ψ,从而进一步解算出姿态参数和位置参数。
然而,在未引入其他辅助信息情况下,仅通过从二维图像中提取椭圆来估计空间圆的姿态,结果会产生歧义性,即会得到两组视觉上均存在合理解释的两个解(法向量和圆心位置)。其次,为获取空间圆位置信息,需要已知空间圆半径信息。然而在实际位姿测量过程中,由于目标为非合作目标,难以得到先验信息,因此,传统的方法在姿态解算过程中存在二义性问题;在位置解算过程中需要已知空间圆半径。
发明内容
本发明所要解决的技术问题是提供一种非合作空间圆目标的相对位姿测量方法,可解决传统的方法在姿态解算过程中存在二义性问题。
此外,本发明的方法无需非合作空间圆目标的先验信息即可实现其位置解算。
为解决上述问题,本发明提出一种非合作空间圆目标的相对位姿测量方法,包括以下步骤:
S1:提供左右相机拍摄空间圆目标形成的左图像和右图像,其中,空间圆目标在所述左图像、右图像的成像坐标系下分别成像为左椭圆、右椭圆;
S2:采用非线性最小二乘法拟合所述左图像和右图像,检测出其中的椭圆或近似椭圆,所述椭圆或近似椭圆作为候选椭圆;
S3:根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;
S4:根据步骤S2中拟合所述左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;
S5:根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解。
根据本发明的一个实施例,还包括步骤S6:根据所述最优姿态解确定空间圆目标的相对位置信息。
根据本发明的一个实施例,在步骤S3中,所述极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下具有的确定位置关系。
根据本发明的一个实施例,在步骤S1中,左右相机拍摄空间圆目标形成的左图像和右图像时,左右相机处于同一水平高度,左右相机之间保持一定基线长度,左右相机光轴分别内倾相同角度,形成一拍摄夹角,所述拍摄夹角小于90度。
根据本发明的一个实施例,在步骤S3中,所述极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下的y轴上的数值相同。
根据本发明的一个实施例,在步骤S4中,确定任意一组空间圆姿态解的方法包括:根据相应投影方程推算出用以投影的空间圆所在平面的法向量r3及圆心位置t与半径r比值,公式如(1)和(2):
其中,λ1,λ2为矩阵特征值,U为3×3正交矩阵,θ和ψ为用以表示r3和t/r而采用的参数符号,且θ+ψ=π/2,3π/2,UTU=I,因而λ1cos2θ+λ2cos2ψ=1,λ1cos2θ+λ2sin2θ=1,从而确定两组θ和ψ,得到两个法向量解,作为一组空间圆姿态解。
根据本发明的一个实施例,将根据空间圆左投影方程获得的空间圆姿态解记为rl1,rl2,将根据空间圆右投影方程获得的空间圆姿态解记为rr1,rr2,在步骤S5中,将其中一组空间圆姿态解的法向量转换到另一组空间圆姿态解的空间坐标系下的公式如(4):
rlr1=R0rl1
rlr2=R0rl2 (4)
根据两组最优法向量之间的夹角最小原则,如公式(5),确定一组最优法向量,记为r3,
空间圆法向量r3确定后根据公式(6)确定出偏航角和俯仰角φ,作为空间圆目标的最优姿态解,
还包括步骤S6:由公式(6)确定空间圆目标的圆心位置t与半径r比值,根据公式(7)和(8)确定空间圆目标相对于左相机或右相机的圆心位置矢量,作为相对位置信息,
tl=r*[tlx tly tlz]T
tr=r*[trx try trz]T (8)
其中,rij(i=0,1,2,j=0,1,2)为旋转矩阵R0中的元素,[tlx tly tlz]T为左相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,[trx try trz]T为右相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,tl为左相机空间坐标系下的空间圆目标的圆心位置矢量,tr为右相机空间坐标系下的空间圆目标的圆心位置矢量。
根据本发明的一个实施例,左右相机空间坐标系下空间点三维坐标Xr,Xl之间满足公式(3),
Xr=R0Xl+t0 (3)
其中,R0为旋转矩阵,t0为平移量。
根据本发明的一个实施例,所述空间圆目标为非合作空间飞行器中具有空间圆特征的物体。
采用上述技术方案后,本发明相比现有技术具有以下有益效果:采用双目相机作为光学测量设备,左右相机进行图像采集,获得两幅具有确定极线约束关系的二维投影图,检测其中的空间圆的二维投影椭圆,然后根据极线约束识别出空间圆投影的俩椭圆,分别估计空间圆的姿态,通过双目视觉融合所估计的俩空间圆,从而唯一确定空间圆姿态,可实现星箭对接环、发动机喷管等具有明显空间圆特征的非合作目标相对位姿测量,不存在二义性问题。
此外,根据本发明的方法还可进一步解算空间圆的相对位置关系,无需任何关于星箭对接环、发动机喷管等具有明显空间圆特征的非合作航天器的先验信息,具有自适应性能力强、鲁棒性好、测量精度高的有益效果。
附图说明
图1为空间坐标系中的圆投影到相机成像坐标系的示意图;
图2为本发明实施例的一种非合作空间圆目标的相对位姿测量方法的流程示意图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。
在下面的描述中阐述了很多具体细节以便于充分理解本发明。但是本发明能够以很多不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似推广,因此本发明不受下面公开的具体实施的限制。
参看图2,本发明实施例的一种非合作空间圆目标的相对位姿测量方法,包括以下步骤:
S1:提供左右相机拍摄空间圆目标形成的左图像和右图像,其中,空间圆目标在所述左图像、右图像的成像坐标系下分别成像为左椭圆、右椭圆;
S2:采用非线性最小二乘法拟合所述左图像和右图像,检测出其中的椭圆或近似椭圆,所述椭圆或近似椭圆作为候选椭圆;
S3:根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;
S4:根据步骤S2中拟合所述左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;
S5:根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解。
本发明可首先采用双目相机作为光学测量设备进行图像采集,捕获空间的两幅图像,识别出两幅图像中的非合作空间圆目标的二维椭圆,解析空间圆最优姿态解,可以实现星箭对接环、发动机喷管等具有空间圆特征的非合作目标的相对位姿测量。较佳的,可以应用在航天非合作空间圆检测技术中,空间圆目标为非合作空间飞行器中具有空间圆特征的物体。具体的,下面通过具体实施例对本发明的方法进行详细的描述。
在步骤S1中,左右相机进行图像采集,左右相机的相对关系可以预先设置,从而使得左右相机分别获得的左右图像具有确定的极线约束关系,获得的左图像和右图像中,空间圆目标会分别投影为相应的二维椭圆,分别称为左椭圆和右椭圆。
接着,在步骤S2中,采用非线性最小二乘法的方法拟合椭圆,将左图像和右图像中的所有可能椭圆识别出来,作为候选椭圆,非线性最小二乘法的方法拟合的具体算法可以参看背景技术中的描述,在此不再赘述。可以理解,椭圆识别步骤之后,可以从各个方程系数中获得左椭圆方程系数和右椭圆方程系数,两个方程系数是相对于各自相机的成像坐标系而言的。
接着,在步骤S3中,基于左右相机的极线约束关系,左图像和右图像同样具备极线约束关系,根据该极线约束关系可以从候选椭圆中识别出左图像和右图像中的左椭圆和右椭圆,从而相应确定左椭圆方程系数和右椭圆方程系数。
在一个实施例中,执行步骤S1的时候,也就是左右相机拍摄空间圆目标形成的左图像和右图像时,左右相机处于同一水平高度,左右相机之间保持一定基线长度,左右相机光轴分别内倾相同角度,形成一拍摄夹角,拍摄夹角最好小于90度。则相应的,在步骤S3中,极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下的y轴上的数值相同,从步骤S2中的候选椭圆,选择图像像素坐标系下的y轴上的数值相同的椭圆,即为左椭圆和右椭圆。
需要说明的是,左右相机间的极线约束关系是可调整的,根据图像采集时预先布置的左右相机的相对位置关系确定相应极线约束关系,因此,极线约束关系可以为左椭圆和右椭圆的圆心在图像像素坐标系下具有的任意确定位置关系,该位置关系是可预先配置的,因此是可确定的。
接着,在步骤S4中,由于在步骤S2中已经根据非线性最小二乘法拟合过椭圆,因此根据拟合左椭圆和右椭圆生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,该投影方程的确定方法可参看背景技术中的空间投影方程确定方式,如图1中示出的,将空间坐标系下的空间圆投影到相机成像坐标系下,该空间坐标系可以为世界坐标系,接着,基于SVD(奇异值分解)原理解算空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解。空间圆姿态解可包括用以投影的空间圆所在平面的法向量。
接着,在步骤S5中,根据左右相机之间已知的位置姿态关系(图像采集前预先配置),将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据左右各自用以投影的空间圆所在平面的法向量之间夹角最小原则,确定空间圆目标的最优姿态解,也就是双目视觉融合原理获得一组最优的空间圆姿态解,该最优姿态解便是空间圆目标的姿态。
在一个实施例中,步骤S5之后还包括步骤S6:根据获得的空间圆目标的最优姿态解态解,可以进一步解算,确定空间圆目标的相对位置信息,空间圆所在平面的法向量和圆心位置、半径之间具有可解算关系,从法向量可以直接解算出空间圆目标的圆心位置和半径。
下面结合具体公式对本发明的方法进行进一步的说明,但是,可以理解的是,解决同一问题的公式可以不仅为一个,公式在一定程度上是可以发生变化的,以下示出的公式仅是实现本发明的具体实施方式,不能用来限制本发明。
具体的,在步骤S4中,确定任意一组空间圆姿态解的方法包括:根据相应投影方程推算出用以投影的空间圆所在平面的法向量r3及圆心位置t与半径r比值,公式如(1)和(2):
其中,λ1,λ2为矩阵特征值,U为3×3正交矩阵,θ和ψ为用以表示r3和t/r而采用的参数符号,且θ+ψ=π/2,3π/2,UTU=I,因而λ1cos2θ+λ2cos2ψ=1,λ1cos2θ+λ2sin2θ=1,进一步化简可得:sin2θ=(λ1-1)/(λ1-λ2),从而确定两组θ和ψ,得到两个法向量解,作为一组空间圆姿态解。
根据公式(1)和(2),可以根据空间圆左投影方程获得的空间圆姿态解,记为rl1,rl2,以及根据空间圆右投影方程获得的空间圆姿态解,记为rr1,rr2。
在一个实施例中,假定左右相机空间坐标系下空间点三维坐标Xr,Xl之间满足公式(3),
Xr=R0Xl+t0 (3)
其中,R0为旋转矩阵,t0为平移量。
在步骤S5中,将其中一组空间圆姿态解的法向量转换到另一组空间圆姿态解的空间坐标系下公式如(4):
rlr1=R0rl1
rlr2=R0rl2 (4),
则根据rr1,rr2中有一组最优解,rlr1,rlr2中也存在一组最优解,且最优解之间具有高度的相似性,可确定如公式(5)所示的筛选准则,也就是两组最优法向量之间的夹角最小原则,其中,||表示对矢量求模值,即两组最优法向量之间的夹角最小原则确定唯一一组最优解,记为r3,此时t/r也可唯一确定,
空间圆法向量r3确定后根据公式(6)确定出偏航角和俯仰角φ,作为空间圆目标的最优姿态解,
进一步的,获得空间圆目标的最优姿态解后,还包括步骤S6:由公式(6)确定的空间圆目标的圆心位置t与半径r比值,空间圆法向量r3及圆心位置t与半径r比值之间的关系可以参看背景技术中的公式(15)和(16),根据公式(7)和(8)进一步确定空间圆目标相对于左相机或右相机的圆心位置矢量,作为相对位置信息,
tl=r*[tlx tly tlz]T
tr=r*[trx try trz]T (8)
其中,rij(i=0,1,2,j=0,1,2)为旋转矩阵R0中的元素,[tlx tly tlz]T为左相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,[trx try trz]T为右相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,tl为左相机空间坐标系下的空间圆目标的圆心位置矢量,tr为右相机空间坐标系下的空间圆目标的圆心位置矢量。
下面结合实施例具体说明本发明的方法及其实现效果。
以某飞行器发动机喷管目标为例,进行仿真试验,结合图表对本发明作进一步详细说明。根据步骤S1,设计双目相机参数和发动机喷管目标参数,如表1所示,然后根据动力学方程仿真双目相机成像,已知左右相机相(双目相机)对发动机喷管目标的位置和姿态,然后识别出空间圆,最后确定出唯一的姿态和位置,表2所示为在不同作用距离(相机和目标之间的距离)下位置姿态解算结果与误差值,从结果中可以看出,本发明提供的非合作空间圆目标相对位置姿态测量方法,无需任何先验信息即可实现位置姿态测量,且测量结果精度较高。
仿真参数 | 数值 |
发动机喷管直径 | 86mm |
发动机喷管锥度 | 26° |
双目相机基线 | 300mm |
图像分辨率 | 1360×1024 |
视场角 | 36.8°×28.7° |
焦距 | 11mm |
探测器尺寸 | 5.5μm |
表1仿真参数设计结果
表2不同作用距离下相对位置姿态解算结果
本发明虽然以较佳实施例公开如上,但其并不是用来限定权利要求,任何本领域技术人员在不脱离本发明的精神和范围内,都可以做出可能的变动和修改,因此本发明的保护范围应当以本发明权利要求所界定的范围为准。
Claims (9)
1.一种非合作空间圆目标的相对位姿测量方法,其特征在于,包括以下步骤:
S1:提供左右相机拍摄空间圆目标形成的左图像和右图像,其中,空间圆目标在所述左图像、右图像的成像坐标系下分别成像为左椭圆、右椭圆;
S2:采用非线性最小二乘法拟合所述左图像和右图像,检测出其中的椭圆或近似椭圆,所述椭圆或近似椭圆作为候选椭圆;
S3:根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;
S4:根据步骤S2中拟合所述左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;
S5:根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解;
在步骤S4中,确定任意一组空间圆姿态解的方法包括:根据相应投影方程推算出用以投影的空间圆所在平面的法向量r3及圆心位置t与半径r比值,公式如(1)和(2):
<mrow>
<msub>
<mi>r</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mi>U</mi>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msqrt>
<msub>
<mi>&lambda;</mi>
<mn>1</mn>
</msub>
</msqrt>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>,</mo>
<msqrt>
<msub>
<mi>&lambda;</mi>
<mn>2</mn>
</msub>
</msqrt>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&psi;</mi>
<mo>,</mo>
<mn>0</mn>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,λ1,λ2为矩阵特征值,U为3×3正交矩阵,θ和ψ为用以表示r3和t/r而采用的参数符号,且θ+ψ=π/2,3π/2,UTU=I,因而λ1cos2θ+λ2cos2ψ=1,λ1cos2θ+λ2sin2θ=1,从而确定两组θ和ψ,得到两个法向量解,作为一组空间圆姿态解。
2.如权利要求1所述的非合作空间圆目标的相对位姿测量方法,其特征在于,还包括步骤S6:根据所述最优姿态解确定空间圆目标的相对位置信息。
3.如权利要求1所述的非合作空间圆目标的相对位姿测量方法,其特征在于,在步骤S3中,所述极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下具有的确定位置关系。
4.如权利要求1所述的非合作空间圆目标的相对位姿测量方法,其特征在于,在步骤S1中,左右相机拍摄空间圆目标形成的左图像和右图像时,左右相机处于同一水平高度,左右相机之间保持一定基线长度,左右相机光轴分别内倾相同角度,形成一拍摄夹角,所述拍摄夹角小于90度。
5.如权利要求4所述的非合作空间圆目标的相对位姿测量方法,其特征在于,在步骤S3中,所述极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下的y轴上的数值相同。
6.如权利要求1所述的非合作空间圆目标的相对位姿测量方法,其特征在于,将根据空间圆左投影方程获得的空间圆姿态解记为rl1,rl2,将根据空间圆右投影方程获得的空间圆姿态解记为rr1,rr2,R0为旋转矩阵,在步骤S5中,将其中一组空间圆姿态解的法向量转换到另一组空间圆姿态解的空间坐标系下的公式如(4):
rlr1=R0rl1
rlr2=R0rl2 (4)
根据两组最优法向量之间的夹角最小原则,如公式(5),确定一组最优法向量,记为r3,
<mrow>
<mi>max</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>&CenterDot;</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
</mrow>
<mrow>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>&CenterDot;</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
</mrow>
<mrow>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>&CenterDot;</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
</mrow>
<mrow>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>&CenterDot;</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
</mrow>
<mrow>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
<mo>|</mo>
<mover>
<msub>
<mi>r</mi>
<mrow>
<mi>l</mi>
<mi>r</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&RightArrow;</mo>
</mover>
<mo>|</mo>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
空间圆法向量r3确定后根据公式(6)确定出偏航角和俯仰角φ,作为空间圆目标的最优姿态解,
7.如权利要求6所述的非合作空间圆目标的相对位姿测量方法,其特征在于,还包括步骤S6:由公式(6)确定空间圆目标的圆心位置t与半径r比值,根据公式(7)和(8)确定空间圆目标相对于左相机或右相机的圆心位置矢量,作为相对位置信息,
<mrow>
<msub>
<mi>t</mi>
<mi>r</mi>
</msub>
<mo>=</mo>
<msub>
<mi>R</mi>
<mn>0</mn>
</msub>
<msub>
<mi>t</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<msub>
<mi>t</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>r</mi>
<mn>00</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>r</mi>
<mn>01</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>r</mi>
<mn>02</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>r</mi>
<mn>10</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>r</mi>
<mn>11</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>r</mi>
<mn>12</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>r</mi>
<mn>20</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>r</mi>
<mn>21</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>r</mi>
<mn>22</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<msub>
<mi>t</mi>
<mi>l</mi>
</msub>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mn>0</mn>
<mi>x</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mn>0</mn>
<mi>y</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mn>0</mn>
<mi>z</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<mfrac>
<msub>
<mi>t</mi>
<mi>l</mi>
</msub>
<mi>r</mi>
</mfrac>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mi>l</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mi>l</mi>
<mi>y</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mi>l</mi>
<mi>z</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
</mrow>
<mrow>
<mfrac>
<msub>
<mi>t</mi>
<mi>r</mi>
</msub>
<mi>r</mi>
</mfrac>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mi>r</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mi>r</mi>
<mi>y</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>t</mi>
<mrow>
<mi>r</mi>
<mi>z</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>r</mi>
<mo>=</mo>
<mfrac>
<msub>
<mi>t</mi>
<mrow>
<mn>0</mn>
<mi>x</mi>
</mrow>
</msub>
<mrow>
<msub>
<mi>t</mi>
<mrow>
<mi>r</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>r</mi>
<mn>00</mn>
</msub>
<mo>*</mo>
<msub>
<mi>t</mi>
<mrow>
<mi>l</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>r</mi>
<mn>01</mn>
</msub>
<mo>*</mo>
<msub>
<mi>t</mi>
<mrow>
<mi>l</mi>
<mi>y</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>r</mi>
<mn>02</mn>
</msub>
<mo>*</mo>
<msub>
<mi>t</mi>
<mrow>
<mi>l</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
tl=r*[tlx tly tlz]T
tr=r*[trx try trz]T (8)
其中,rij(i=0,1,2,j=0,1,2)为旋转矩阵R0中的元素,[tlx tly tlz]T为左相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,[trx try trz]T为右相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,tl为左相机空间坐标系下的空间圆目标的圆心位置矢量,tr为右相机空间坐标系下的空间圆目标的圆心位置矢量。
8.如权利要求6所述的非合作空间圆目标的相对位姿测量方法,其特征在于,左右相机空间坐标系下空间点三维坐标Xr,Xl之间满足公式(3),
Xr=R0Xl+t0 (3)
其中,R0为旋转矩阵,t0为平移量。
9.如权利要求1所述的非合作空间圆目标的相对位姿测量方法,其特征在于,所述空间圆目标为非合作空间飞行器中具有空间圆特征的物体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510854639.0A CN105509733B (zh) | 2015-11-30 | 2015-11-30 | 非合作空间圆目标的相对位姿测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510854639.0A CN105509733B (zh) | 2015-11-30 | 2015-11-30 | 非合作空间圆目标的相对位姿测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105509733A CN105509733A (zh) | 2016-04-20 |
CN105509733B true CN105509733B (zh) | 2018-04-06 |
Family
ID=55717890
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510854639.0A Active CN105509733B (zh) | 2015-11-30 | 2015-11-30 | 非合作空间圆目标的相对位姿测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105509733B (zh) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106323271B (zh) * | 2016-08-01 | 2019-03-22 | 北京理工大学 | 基于特征奇异值的航天器相对姿态测量矢量选取方法 |
CN106903665A (zh) * | 2017-04-18 | 2017-06-30 | 中国科学院重庆绿色智能技术研究院 | 一种基于立体视觉的主从式遥操作手术机器人控制系统 |
CN107218930B (zh) * | 2017-05-05 | 2020-01-03 | 山东大学 | 基于单目手眼系统的空间圆六维位置-姿态主动式测量方法 |
CN109307512B (zh) * | 2017-07-27 | 2021-05-14 | 杭州海康威视数字技术股份有限公司 | 一种车辆定位方法、装置及设备 |
CN107621266B (zh) * | 2017-08-14 | 2020-12-15 | 上海宇航系统工程研究所 | 基于特征点跟踪的空间非合作目标相对导航方法 |
CN108534784B (zh) * | 2018-03-13 | 2019-06-18 | 北京控制工程研究所 | 一种基于空间圆轨迹的非合作航天器自旋角速度估计方法 |
CN108694713B (zh) * | 2018-04-19 | 2022-07-05 | 北京控制工程研究所 | 一种基于立体视觉的星箭对接环局部环段识别与测量方法 |
CN108562274B (zh) * | 2018-04-20 | 2020-10-27 | 南京邮电大学 | 一种基于标志器的非合作目标位姿测量方法 |
CN109059866B (zh) * | 2018-08-03 | 2020-12-18 | 中国科学院国家天文台 | 基于图像的行星近景摄影测量相机安装参数的测量方法 |
CN109059902B (zh) | 2018-09-07 | 2021-05-28 | 百度在线网络技术(北京)有限公司 | 相对位姿确定方法、装置、设备和介质 |
CN109631912B (zh) * | 2019-01-10 | 2022-08-23 | 中国科学院光电技术研究所 | 一种深空球形目标被动测距方法 |
CN110009680B (zh) * | 2019-02-28 | 2022-04-22 | 中国人民解放军国防科技大学 | 基于圆特征及异面特征点的单目图像位置、姿态测量方法 |
CN110223355B (zh) * | 2019-05-15 | 2021-01-05 | 大连理工大学 | 一种基于双重极线约束的特征标志点匹配方法 |
CN110530397A (zh) * | 2019-08-08 | 2019-12-03 | 北京首贝科技发展有限公司 | 一种基于九轴imu的磁场自动标定方法 |
CN110647156B (zh) * | 2019-09-17 | 2021-05-11 | 中国科学院自动化研究所 | 基于目标物对接环的对接设备位姿调整方法、系统 |
CN111784766B (zh) * | 2020-06-08 | 2024-05-24 | 易思维(杭州)科技股份有限公司 | 一种含螺纹目标物位姿的计算方法 |
CN112381884B (zh) * | 2020-11-12 | 2022-04-19 | 北京航空航天大学 | 基于rgbd相机的空间圆目标位姿测量方法 |
CN112381880B (zh) * | 2020-11-27 | 2024-10-29 | 航天科工智能机器人有限责任公司 | 一种基于圆特征的双目视觉位姿估计方法 |
CN113052905B (zh) * | 2021-03-31 | 2022-07-19 | 中国人民解放军63920部队 | 基于双目逆投影变换的圆形目标位姿测量方法和装置 |
CN114596355B (zh) * | 2022-03-16 | 2024-03-08 | 哈尔滨工业大学 | 一种基于合作目标的高精度位姿测量方法及系统 |
CN115131433B (zh) * | 2022-06-16 | 2024-10-18 | 西北工业大学 | 一种非合作目标位姿的处理方法、装置及电子设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102589530A (zh) * | 2012-02-24 | 2012-07-18 | 合肥工业大学 | 基于二维相机和三维相机融合的非合作目标位姿测量方法 |
CN103994755A (zh) * | 2014-05-29 | 2014-08-20 | 清华大学深圳研究生院 | 一种基于模型的空间非合作目标位姿测量方法 |
CN104048648A (zh) * | 2014-05-27 | 2014-09-17 | 清华大学深圳研究生院 | 大尺寸非合作目标的相对位姿测量方法 |
CN104101331A (zh) * | 2014-07-24 | 2014-10-15 | 合肥工业大学 | 基于全光场相机的非合作目标位姿测量 |
CN104236528A (zh) * | 2013-06-06 | 2014-12-24 | 上海宇航系统工程研究所 | 一种非合作目标相对位姿测量方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8188919B2 (en) * | 2009-06-16 | 2012-05-29 | L3 Communications Integrated Systems, L.P. | Globally-convergent geo-location algorithm |
-
2015
- 2015-11-30 CN CN201510854639.0A patent/CN105509733B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102589530A (zh) * | 2012-02-24 | 2012-07-18 | 合肥工业大学 | 基于二维相机和三维相机融合的非合作目标位姿测量方法 |
CN104236528A (zh) * | 2013-06-06 | 2014-12-24 | 上海宇航系统工程研究所 | 一种非合作目标相对位姿测量方法 |
CN104048648A (zh) * | 2014-05-27 | 2014-09-17 | 清华大学深圳研究生院 | 大尺寸非合作目标的相对位姿测量方法 |
CN103994755A (zh) * | 2014-05-29 | 2014-08-20 | 清华大学深圳研究生院 | 一种基于模型的空间非合作目标位姿测量方法 |
CN104101331A (zh) * | 2014-07-24 | 2014-10-15 | 合肥工业大学 | 基于全光场相机的非合作目标位姿测量 |
Also Published As
Publication number | Publication date |
---|---|
CN105509733A (zh) | 2016-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105509733B (zh) | 非合作空间圆目标的相对位姿测量方法 | |
Pizarro et al. | Large area 3-D reconstructions from underwater optical surveys | |
CN104616292B (zh) | 基于全局单应矩阵的单目视觉测量方法 | |
Saurer et al. | Homography based visual odometry with known vertical direction and weak manhattan world assumption | |
CN101435704B (zh) | 一种星敏感器高动态下的星跟踪方法 | |
CN103759670B (zh) | 一种基于数字近景摄影的物体三维信息获取方法 | |
CN103065323B (zh) | 一种基于单应性变换矩阵的分段空间对准方法 | |
CN107808362A (zh) | 一种基于无人机pos信息与图像surf特征结合的图像拼接方法 | |
CN103759716A (zh) | 基于机械臂末端单目视觉的动态目标位置和姿态测量方法 | |
CN102096923A (zh) | 鱼眼标定方法和装置 | |
CN110849331B (zh) | 基于三维点云数据库模型的单目视觉测量与地面试验方法 | |
CN105809706B (zh) | 一种分布式多像机系统的全局标定方法 | |
CN106157322B (zh) | 一种基于平面镜的像机安装位置标定方法 | |
CN111524174B (zh) | 一种动平台动目标双目视觉三维构建方法 | |
CN109115184A (zh) | 基于非合作目标协同测量方法及系统 | |
CN105043250A (zh) | 一种基于至少两个公共标记点的双视角数据对齐方法 | |
CN109635824A (zh) | 一种图像匹配深度学习方法及系统 | |
Perdigoto et al. | Calibration of mirror position and extrinsic parameters in axial non-central catadioptric systems | |
Huang et al. | Vision pose estimation from planar dual circles in a single image | |
CN109931925A (zh) | 基于序列图像轴线的空间翻滚卫星自旋姿态优化估计方法 | |
CN116740187A (zh) | 一种无重叠视场多相机联合标定方法 | |
CN106251337A (zh) | 一种空中加油锥套空间定位方法及系统 | |
CN113808273B (zh) | 一种船行波数值模拟的无序式增量稀疏点云重构方法 | |
KR102361133B1 (ko) | 이동체의 전방향에 위치한 적어도 하나의 물체에 대한 거리를 획득하는 방법 및 이를 이용한 비전 장치 | |
CN111738971B (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 |