非合作空间圆目标的相对位姿测量方法转让专利

申请号 : CN201510854639.0

文献号 : CN105509733B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 刘玉陈凤王盈黄建明叶飚

申请人 : 上海宇航系统工程研究所

摘要 :

本发明提出一种非合作空间圆目标的相对位姿测量方法,包括提供左右相机拍摄空间圆目标形成的左图像和右图像,空间圆目标分别成像为左椭圆、右椭圆;采用非线性最小二乘法拟合,检测出其中的椭圆或近似椭圆,作为候选椭圆;根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;根据拟合左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解。可解决传统的方法在姿态解算过程中存在二义性问题。

权利要求 :

1.一种非合作空间圆目标的相对位姿测量方法,其特征在于,包括以下步骤:

S1:提供左右相机拍摄空间圆目标形成的左图像和右图像,其中,空间圆目标在所述左图像、右图像的成像坐标系下分别成像为左椭圆、右椭圆;

S2:采用非线性最小二乘法拟合所述左图像和右图像,检测出其中的椭圆或近似椭圆,所述椭圆或近似椭圆作为候选椭圆;

S3:根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;

S4:根据步骤S2中拟合所述左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;

S5:根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解;

在步骤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,从而确定两组θ和ψ,得到两个法向量解,作为一组空间圆姿态解。

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,空间圆法向量r3确定后根据公式(6)确定出偏航角 和俯仰角φ,作为空间圆目标的最优姿态解,

7.如权利要求6所述的非合作空间圆目标的相对位姿测量方法,其特征在于,还包括步骤S6:由公式(6)确定空间圆目标的圆心位置t与半径r比值,根据公式(7)和(8)确定空间圆目标相对于左相机或右相机的圆心位置矢量,作为相对位置信息,T

tl=r*[tlx tly tlz]

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所述的非合作空间圆目标的相对位姿测量方法,其特征在于,所述空间圆目标为非合作空间飞行器中具有空间圆特征的物体。

说明书 :

非合作空间圆目标的相对位姿测量方法

技术领域

[0001] 本发明涉及空间圆目标的测量技术,特别涉及的是非合作空间圆目标的相对位姿测量技术。

背景技术

[0002] 随着空间技术的发展,对故障或失效卫星的空间在轨服务和碎片清除等,非合作空间飞行器的近程操作活动的需求越来越多。其发展趋势是研制面向非合作目标的自主空间飞行器,通过自主接近非合作空间飞行器,以执行空间在轨服务或清除任务。目前,非合作空间飞行器中可供识别和对接抓捕的部位主要包括星箭对接环、远地点发动机喷管、太阳帆板、对地通信天线支架等。星箭对接环、发动机喷管等具有明显的空间圆特征,为自主完成空间服务任务,迫切需要针对这一类具有明显空间圆特征非合作空间飞行器的超近距离相对位姿测量技术。
[0003] 现有技术中,通过从二维图像中提取椭圆来估计空间圆的姿态。椭圆检测一般采用基于非线性最小二乘拟合法实现,椭圆方程的一般数学模型如公式(9)所示:
[0004] Ax2+2Bxy+Cy2+2Dx+2Ey+1=0  (9)
[0005] 其中要求AC-B2>0,A,B,C,D,E为待定的一般椭圆方程系数。将上式写成矩阵形式有:
[0006]
[0007] 假设(xi,yi),i=1,…,N为椭圆上的数据点即对应图像上二维坐标点,椭圆拟合即估计椭圆方程中的各个参数。如公式(11)所示,通过非线性最小二乘法即可解算出未知参数A,B,C,D,E。
[0008]
[0009] 令世界坐标系Ow-XwYwZw的原点位于圆心位置,其Z轴与圆所在平面的法向平行。参看图1,将世界坐标系中的圆投影到相机成像坐标系,世界坐标系Ow-XwYwZw与相机成像坐标系O-XYZ的变换关系如下:
[0010]
[0011] 其中,[u,v,1]T为成像平面上点的齐次坐标,P=[x,y,z,1]T为空间点的齐次坐标,H=K[r1 r2 r3 t]为平面单应矩阵,K为相机的内参数矩阵,R=[r1,r2,r3]为空间旋转矩阵,t为平移向量,s为比例因子。
[0012] 圆在世界坐标系下方程可表示为如(13)的矩阵形式:
[0013]
[0014] 其中,r为圆的半径。
[0015] 记Q=diag{1,1,-r2},于是,圆投影方程为
[0016] [u,v,1]H-TQH-1[u,v,1]T=0,则有
[0017] 记M-1=sH-TQH-1=s(HQ-1HT)-1,则有
[0018]
[0019] 其中,s为一比例因子。由方程(14)可知,圆投影方程中隐含了圆位姿参数,包括圆心的位置t及圆所在平面的法向量r3。
[0020] 将方程(14)写如下形式:
[0021]
[0022] 注意到等式左端矩阵秩≤2且等式右端矩阵为实对称矩阵,因此可作如下分解:I--1 -T TsK MK =Udiag{λ1,λ2,0}U
[0023] 其中,U为3×3正交矩阵。通过解算可得到圆的三维姿态参数如下:
[0024]
[0025]
[0026] 其中λ1,λ2为I-sK-1MK-T的特征值,U为3*3的正交矩阵,θ和ψ为方便表示r3和t/r而采用的数学符号,且满足UTU=I,θ+ψ=π/2,3π/2,由于 因此有如下等式成立:
[0027] λ1cos2θ+λ2cos2ψ=1,λ1cos2θ+λ2sin2θ=1
[0028] 根据上述两个等式可进一步得到:
[0029] sin2θ=(λ1-1)/(λ1-λ2)
[0030] 由上式可确定θ和ψ,从而进一步解算出姿态参数和位置参数。
[0031] 然而,在未引入其他辅助信息情况下,仅通过从二维图像中提取椭圆来估计空间圆的姿态,结果会产生歧义性,即会得到两组视觉上均存在合理解释的两个解(法向量和圆心位置)。其次,为获取空间圆位置信息,需要已知空间圆半径信息。然而在实际位姿测量过程中,由于目标为非合作目标,难以得到先验信息,因此,传统的方法在姿态解算过程中存在二义性问题;在位置解算过程中需要已知空间圆半径。

发明内容

[0032] 本发明所要解决的技术问题是提供一种非合作空间圆目标的相对位姿测量方法,可解决传统的方法在姿态解算过程中存在二义性问题。
[0033] 此外,本发明的方法无需非合作空间圆目标的先验信息即可实现其位置解算。
[0034] 为解决上述问题,本发明提出一种非合作空间圆目标的相对位姿测量方法,包括以下步骤:
[0035] S1:提供左右相机拍摄空间圆目标形成的左图像和右图像,其中,空间圆目标在所述左图像、右图像的成像坐标系下分别成像为左椭圆、右椭圆;
[0036] S2:采用非线性最小二乘法拟合所述左图像和右图像,检测出其中的椭圆或近似椭圆,所述椭圆或近似椭圆作为候选椭圆;
[0037] S3:根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;
[0038] S4:根据步骤S2中拟合所述左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;
[0039] S5:根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解。
[0040] 根据本发明的一个实施例,还包括步骤S6:根据所述最优姿态解确定空间圆目标的相对位置信息。
[0041] 根据本发明的一个实施例,在步骤S3中,所述极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下具有的确定位置关系。
[0042] 根据本发明的一个实施例,在步骤S1中,左右相机拍摄空间圆目标形成的左图像和右图像时,左右相机处于同一水平高度,左右相机之间保持一定基线长度,左右相机光轴分别内倾相同角度,形成一拍摄夹角,所述拍摄夹角小于90度。
[0043] 根据本发明的一个实施例,在步骤S3中,所述极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下的y轴上的数值相同。
[0044] 根据本发明的一个实施例,在步骤S4中,确定任意一组空间圆姿态解的方法包括:根据相应投影方程推算出用以投影的空间圆所在平面的法向量r3及圆心位置t与半径r比值,公式如(1)和(2):
[0045]
[0046]
[0047] 其中,λ1,λ2为矩阵特征值,U为3×3正交矩阵,θ和ψ为用以表示r3和t/r而采用的参数符号,且θ+ψ=π/2,3π/2, UTU=I,因而λ1cos2θ+λ2cos2ψ=1,λ1cos2θ+λ2sin2θ=1,从而确定两组θ和ψ,得到两个法向量解,作为一组空间圆姿态解。
[0048] 根据本发明的一个实施例,将根据空间圆左投影方程获得的空间圆姿态解记为rl1,rl2,将根据空间圆右投影方程获得的空间圆姿态解记为rr1,rr2,在步骤S5中,将其中一组空间圆姿态解的法向量转换到另一组空间圆姿态解的空间坐标系下的公式如(4):
[0049] rlr1=R0rl1
[0050] rlr2=R0rl2  (4)
[0051] 根据两组最优法向量之间的夹角最小原则,如公式(5),确定一组最优法向量,记为r3,
[0052]
[0053] 空间圆法向量r3确定后根据公式(6)确定出偏航角 和俯仰角φ,作为空间圆目标的最优姿态解,
[0054]
[0055] 还包括步骤S6:由公式(6)确定空间圆目标的圆心位置t与半径r比值,根据公式(7)和(8)确定空间圆目标相对于左相机或右相机的圆心位置矢量,作为相对位置信息,[0056]
[0057]
[0058]
[0059]
[0060] tl=r*[tlx tly tlz]T
[0061] tr=r*[trx try trz]T  (8)
[0062] 其中,rij(i=0,1,2,j=0,1,2)为旋转矩阵R0中的元素,[tlx tly tlz]T为左相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,[trx try trz]T为右相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,tl为左相机空间坐标系下的空间圆目标的圆心位置矢量,tr为右相机空间坐标系下的空间圆目标的圆心位置矢量。
[0063] 根据本发明的一个实施例,左右相机空间坐标系下空间点三维坐标Xr,Xl之间满足公式(3),
[0064] Xr=R0Xl+t0  (3)
[0065] 其中,R0为旋转矩阵,t0为平移量。
[0066] 根据本发明的一个实施例,所述空间圆目标为非合作空间飞行器中具有空间圆特征的物体。
[0067] 采用上述技术方案后,本发明相比现有技术具有以下有益效果:采用双目相机作为光学测量设备,左右相机进行图像采集,获得两幅具有确定极线约束关系的二维投影图,检测其中的空间圆的二维投影椭圆,然后根据极线约束识别出空间圆投影的俩椭圆,分别估计空间圆的姿态,通过双目视觉融合所估计的俩空间圆,从而唯一确定空间圆姿态,可实现星箭对接环、发动机喷管等具有明显空间圆特征的非合作目标相对位姿测量,不存在二义性问题。
[0068] 此外,根据本发明的方法还可进一步解算空间圆的相对位置关系,无需任何关于星箭对接环、发动机喷管等具有明显空间圆特征的非合作航天器的先验信息,具有自适应性能力强、鲁棒性好、测量精度高的有益效果。

附图说明

[0069] 图1为空间坐标系中的圆投影到相机成像坐标系的示意图;
[0070] 图2为本发明实施例的一种非合作空间圆目标的相对位姿测量方法的流程示意图。

具体实施方式

[0071] 为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。
[0072] 在下面的描述中阐述了很多具体细节以便于充分理解本发明。但是本发明能够以很多不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似推广,因此本发明不受下面公开的具体实施的限制。
[0073] 参看图2,本发明实施例的一种非合作空间圆目标的相对位姿测量方法,包括以下步骤:
[0074] S1:提供左右相机拍摄空间圆目标形成的左图像和右图像,其中,空间圆目标在所述左图像、右图像的成像坐标系下分别成像为左椭圆、右椭圆;
[0075] S2:采用非线性最小二乘法拟合所述左图像和右图像,检测出其中的椭圆或近似椭圆,所述椭圆或近似椭圆作为候选椭圆;
[0076] S3:根据所述左椭圆和右椭圆之间的极线约束关系,从所述候选椭圆中识别出所述左椭圆和右椭圆;
[0077] S4:根据步骤S2中拟合所述左椭圆和右椭圆而生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解;
[0078] S5:根据左右相机之间的位置姿态关系,将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据夹角最小原则确定空间圆目标的最优姿态解。
[0079] 本发明可首先采用双目相机作为光学测量设备进行图像采集,捕获空间的两幅图像,识别出两幅图像中的非合作空间圆目标的二维椭圆,解析空间圆最优姿态解,可以实现星箭对接环、发动机喷管等具有空间圆特征的非合作目标的相对位姿测量。较佳的,可以应用在航天非合作空间圆检测技术中,空间圆目标为非合作空间飞行器中具有空间圆特征的物体。具体的,下面通过具体实施例对本发明的方法进行详细的描述。
[0080] 在步骤S1中,左右相机进行图像采集,左右相机的相对关系可以预先设置,从而使得左右相机分别获得的左右图像具有确定的极线约束关系,获得的左图像和右图像中,空间圆目标会分别投影为相应的二维椭圆,分别称为左椭圆和右椭圆。
[0081] 接着,在步骤S2中,采用非线性最小二乘法的方法拟合椭圆,将左图像和右图像中的所有可能椭圆识别出来,作为候选椭圆,非线性最小二乘法的方法拟合的具体算法可以参看背景技术中的描述,在此不再赘述。可以理解,椭圆识别步骤之后,可以从各个方程系数中获得左椭圆方程系数和右椭圆方程系数,两个方程系数是相对于各自相机的成像坐标系而言的。
[0082] 接着,在步骤S3中,基于左右相机的极线约束关系,左图像和右图像同样具备极线约束关系,根据该极线约束关系可以从候选椭圆中识别出左图像和右图像中的左椭圆和右椭圆,从而相应确定左椭圆方程系数和右椭圆方程系数。
[0083] 在一个实施例中,执行步骤S1的时候,也就是左右相机拍摄空间圆目标形成的左图像和右图像时,左右相机处于同一水平高度,左右相机之间保持一定基线长度,左右相机光轴分别内倾相同角度,形成一拍摄夹角,拍摄夹角最好小于90度。则相应的,在步骤S3中,极线约束关系为所述左椭圆和右椭圆的圆心在图像像素坐标系下的y轴上的数值相同,从步骤S2中的候选椭圆,选择图像像素坐标系下的y轴上的数值相同的椭圆,即为左椭圆和右椭圆。
[0084] 需要说明的是,左右相机间的极线约束关系是可调整的,根据图像采集时预先布置的左右相机的相对位置关系确定相应极线约束关系,因此,极线约束关系可以为左椭圆和右椭圆的圆心在图像像素坐标系下具有的任意确定位置关系,该位置关系是可预先配置的,因此是可确定的。
[0085] 接着,在步骤S4中,由于在步骤S2中已经根据非线性最小二乘法拟合过椭圆,因此根据拟合左椭圆和右椭圆生成的左椭圆方程系数和右椭圆方程系数,分别确定空间坐标系到成像坐标系的空间圆左投影方程和空间圆右投影方程,该投影方程的确定方法可参看背景技术中的空间投影方程确定方式,如图1中示出的,将空间坐标系下的空间圆投影到相机成像坐标系下,该空间坐标系可以为世界坐标系,接着,基于SVD(奇异值分解)原理解算空间圆左投影方程和空间圆右投影方程,从而获得两组空间圆姿态解。空间圆姿态解可包括用以投影的空间圆所在平面的法向量。
[0086] 接着,在步骤S5中,根据左右相机之间已知的位置姿态关系(图像采集前预先配置),将其中一组空间圆姿态解转换到另一组空间圆姿态解的空间坐标系下,根据左右各自用以投影的空间圆所在平面的法向量之间夹角最小原则,确定空间圆目标的最优姿态解,也就是双目视觉融合原理获得一组最优的空间圆姿态解,该最优姿态解便是空间圆目标的姿态。
[0087] 在一个实施例中,步骤S5之后还包括步骤S6:根据获得的空间圆目标的最优姿态解态解,可以进一步解算,确定空间圆目标的相对位置信息,空间圆所在平面的法向量和圆心位置、半径之间具有可解算关系,从法向量可以直接解算出空间圆目标的圆心位置和半径。
[0088] 下面结合具体公式对本发明的方法进行进一步的说明,但是,可以理解的是,解决同一问题的公式可以不仅为一个,公式在一定程度上是可以发生变化的,以下示出的公式仅是实现本发明的具体实施方式,不能用来限制本发明。
[0089] 具体的,在步骤S4中,确定任意一组空间圆姿态解的方法包括:根据相应投影方程推算出用以投影的空间圆所在平面的法向量r3及圆心位置t与半径r比值,公式如(1)和(2):
[0090]
[0091]
[0092] 其中,λ1,λ2为矩阵特征值,U为3×3正交矩阵,θ和ψ为用以表示r3和t/r而采用的参T 2 2 2 2数符号,且θ+ψ=π/2,3π/2, UU=I,因而λ1cosθ+λ2cosψ=1,λ1cosθ+λ2sinθ=1,进一步化简可得:sin2θ=(λ1-1)/(λ1-λ2),从而确定两组θ和ψ,得到两个法向量解,作为一组空间圆姿态解。
[0093] 根据公式(1)和(2),可以根据空间圆左投影方程获得的空间圆姿态解,记为rl1,rl2,以及根据空间圆右投影方程获得的空间圆姿态解,记为rr1,rr2。
[0094] 在一个实施例中,假定左右相机空间坐标系下空间点三维坐标Xr,Xl之间满足公式(3),
[0095] Xr=R0Xl+t0  (3)
[0096] 其中,R0为旋转矩阵,t0为平移量。
[0097] 在步骤S5中,将其中一组空间圆姿态解的法向量转换到另一组空间圆姿态解的空间坐标系下公式如(4):
[0098] rlr1=R0rl1
[0099] rlr2=R0rl2  (4),
[0100] 则根据rr1,rr2中有一组最优解,rlr1,rlr2中也存在一组最优解,且最优解之间具有高度的相似性,可确定如公式(5)所示的筛选准则,也就是两组最优法向量之间的夹角最小原则,其中,||表示对矢量求模值,即两组最优法向量之间的夹角最小原则确定唯一一组最优解,记为r3,此时t/r也可唯一确定,
[0101]
[0102] 空间圆法向量r3确定后根据公式(6)确定出偏航角 和俯仰角φ,作为空间圆目标的最优姿态解,
[0103]
[0104] 进一步的,获得空间圆目标的最优姿态解后,还包括步骤S6:由公式(6)确定的空间圆目标的圆心位置t与半径r比值,空间圆法向量r3及圆心位置t与半径r比值之间的关系可以参看背景技术中的公式(15)和(16),根据公式(7)和(8)进一步确定空间圆目标相对于左相机或右相机的圆心位置矢量,作为相对位置信息,
[0105]
[0106]
[0107]
[0108]
[0109] tl=r*[tlx tly tlz]T
[0110] tr=r*[trx try trz]T  (8)
[0111] 其中,rij(i=0,1,2,j=0,1,2)为旋转矩阵R0中的元素,[tlx tly tlz]T为左相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,[trx try trz]T为右相机空间坐标系下的空间圆目标的圆心位置坐标与半径之比之后的三维坐标,tl为左相机空间坐标系下的空间圆目标的圆心位置矢量,tr为右相机空间坐标系下的空间圆目标的圆心位置矢量。
[0112] 下面结合实施例具体说明本发明的方法及其实现效果。
[0113] 以某飞行器发动机喷管目标为例,进行仿真试验,结合图表对本发明作进一步详细说明。根据步骤S1,设计双目相机参数和发动机喷管目标参数,如表1所示,然后根据动力学方程仿真双目相机成像,已知左右相机相(双目相机)对发动机喷管目标的位置和姿态,然后识别出空间圆,最后确定出唯一的姿态和位置,表2所示为在不同作用距离(相机和目标之间的距离)下位置姿态解算结果与误差值,从结果中可以看出,本发明提供的非合作空间圆目标相对位置姿态测量方法,无需任何先验信息即可实现位置姿态测量,且测量结果精度较高。
[0114]仿真参数 数值
发动机喷管直径 86mm
发动机喷管锥度 26°
双目相机基线 300mm
图像分辨率 1360×1024
视场角 36.8°×28.7°
焦距 11mm
探测器尺寸 5.5μm
[0115] 表1仿真参数设计结果
[0116]
[0117]
[0118] 表2不同作用距离下相对位置姿态解算结果
[0119] 本发明虽然以较佳实施例公开如上,但其并不是用来限定权利要求,任何本领域技术人员在不脱离本发明的精神和范围内,都可以做出可能的变动和修改,因此本发明的保护范围应当以本发明权利要求所界定的范围为准。