基于圆和线特征非合作目标相对位姿双目视觉测量方法与流程

[0001]
本发明属于非合作航天器相对导航系统设计领域，特别涉及一种基于圆和线特征非合作目标相对位姿双目视觉测量方法。


背景技术：

[0002]
目前，针对空间非合作目标的空间任务越来越受关注，例如在轨加注、在轨维护与装配等工作，非合作目标相对位姿的精确测量是保障空间任务正常进行的前提。空间非合作目标具有无法彼此通讯、无法安装人工靶标的特点，如何利用有限的测量实现非合作目标的相对位姿测量是航天器导航系统的一个关键技术。
[0003]
在非合作目标导航任务中的接近段，通常可以利用喷嘴或者对接环等特征，实现对非合作目标的抓捕。而目前基于圆特征的位姿测量，由于圆的旋转不变性，导致此种测量方案的翻滚角姿态缺失，另外，受空间中光照、相对运动的影响，图像处理技术会存在一定的误差，从而导致位姿测量精度较差，这些往往会不利于空间非合作目标的抓捕任务实施。因此，如何利用非合作目标的有限结构信息和测量信息，实现对非合作目标六自由度位姿精确测量是当前航天器相对导航工程领域中亟待解决的问题。


技术实现要素：

[0004]
针对在实际的非合作目标导航的抓捕任务中，非合作目标相对位姿测量存在目标通信失效和缺乏人工靶标、翻滚角缺失与精度不足等问题，本发明提供了一种基于圆和线特征非合作目标相对位姿双目视觉测量方法，本方法考虑直线与圆特征平行约束和不同特征图像处理误差，设计了一种自适应系数下的位姿测量方法。本发明实现了基于圆姿态测量方法中缺失翻滚角的测量，同时提高了相对姿态的测量精度，保证了非合作目标抓捕的精确位姿测量任务。
[0005]
为实现上述目的，本发明提供了一种基于圆和线特征非合作目标相对位姿双目视觉测量方法，包括如下步骤：
[0006]
s1：通过图像处理算法，提取非合作目标的圆特征和直线特征，得到圆特征成像后椭圆参数和直线特征参数；
[0007]
s2：基于步骤s1中得到的椭圆参数，计算圆特征的圆心位置和圆法向量，然后利用双目视觉消除圆二义性，得到消除圆二义性后的圆法向量；
[0008]
s3：基于步骤s1中得到的直线特征参数，求得直线与相机原点构成线平面的法向量，并且基于步骤s2中得到的消除圆二义性后的圆法向量，定义圆和线特征图像处理算法下误差的自适应系数；
[0009]
s4：基于步骤s3定义的自适应系数以及非合作目标直线与圆平行的约束，实现非合作目标翻滚角姿态测量，同时对消除圆二义性后的圆法向量进行修正，提高非合作目标姿态测量精度。
[0010]
进一步，步骤s1中得到的圆特征成像后椭圆参数为：
[0011]
au2+bv2+cuv+du+ev+f＝0
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
[0012]
其中，[a,b,c,d,e,f]为椭圆方程参数，[u,v]为椭圆像素坐标；
[0013]
直线特征方程为：
[0014][0015]
其中，为直线对应的齐次坐标；k1，k2，k3为直线特征参数，且k1u+k2v+k3＝0等式成立。
[0016]
进一步，步骤s2中利用双目视觉消除圆二义性具体过程为：
[0017]
设定左目相机坐标系σ
l
为o
l-x
l
y
l
z
l
，右目相机坐标系σ
r
为o
r-x
r
y
r
z
r
，
[0018]
采用双目视觉得到4个圆法向量和对应的4个圆心坐标计算4个圆法向量的夹角：
[0019][0020]
其中，为左目相机坐标系σ
l
下的圆法向量，为右目相机坐标系σ
r
下的圆法向量，ψ1为圆法向量的夹角，ψ2为圆法向量为圆法向量的夹角，ψ3为圆法向量的夹角，ψ4为圆法向量的夹角；
[0021]
找到4个夹角中最小的夹角，从而消除圆的二义性，定义消除圆二义性后的左目相机坐标系σ
l
下的圆法向量为圆心坐标为右目相机坐标系σ
r
下的圆法向量为圆心坐标为
[0022]
将右目相机坐标系σ
r
下的圆心坐标从右目相机坐标系σ
r
转换到左目相机坐标系σ
l
，得到非合作目标圆特征的圆心位置o
e
为：
[0023][0024]
其中，
l
r
r
为双目视觉相对姿态矩阵，
l
t
r
为相对位置矩阵。
[0025]
进一步，步骤s3具体过程如下：
[0026]
计算两个圆法向量和的夹角ψ，并将其定义为圆图像处理算法的圆误差系数α：
[0027]
α＝ψ
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(15)
[0028]
定义非合作目标上有两条平行直线l1、l2，分别在双目中成像得到4个线平面法向量其中为左目相机坐标系σ
l
下的线平面法向量，为右目相机坐标系σ
r
下的线平面法向量，4个线平面法向量构成平面π0，推导得到平面π0的法向量
[0029][0030]
定义β表示直线图像处理算法的直线误差系数：
[0031][0032]
进一步，步骤s4具体过程如下：
[0033]
直线l1的方向向量满足下列条件：
[0034][0035]
其中，π1是直线l1与相机原点形成的线平面，定义π
q
表示圆平面，根据l1//π
q
得到：
[0036][0037]
其中，n
e
为非合作目标圆特征的圆法向量，
[0038]
直线l1的方向向量为：
[0039][0040]
定义非合作目标坐标系σ
t
为o
t-x
t
y
t
z
t
，其中z
t
轴与圆法向方向重合，y
t
轴与直线方向重合，x
t
轴满足右手法则，直线l1的方向向量平行于非合作目标坐标系y
t
轴，因此，另外x
t
轴和z
t
轴两个坐标轴的方向向量分别为：
[0041][0042]
其中，分别为x
t
轴、y
t
轴、z
t
轴的方向向量，
[0043]
则非合作目标的姿态矩阵为
[0044]
本发明的有益效果：
[0045]
1)本发明考虑了不同特征提取的误差，设计了相应的自适应系数对提取精度进行了定量描述；
[0046]
2)本发明利用直线特征实现对翻滚角的测量，并且通过引用自适应系数提高了姿态的测量精度。
附图说明
[0047]
图1为本发明实施例的基于圆和线特征非合作目标相对位姿双目视觉测量方法流程图；
[0048]
图2为本发明实施例的双目视觉对非合作目标测量模型示意图；
[0049]
图3为本发明实施例的位置测量误差与相对误差仿真图；
[0050]
图4为本发明实施例的非合作目标姿态测量误差仿真图。
具体实施方式
[0051]
下面结合附图和实施例进一步描述本发明，应该理解，以下所述实施例旨在便于对本发明的理解，而对其不起任何限定作用。
[0052]
如图1所示，本实施例的基于圆和线特征非合作目标相对位姿双目视觉测量方法，包括如下步骤：
[0053]
s1：通过图像处理算法，提取非合作目标的圆特征和直线特征，得到圆特征成像后椭圆参数和直线特征参数；
[0054]
设定双目相机的焦距为16.1mm，像素为1024
×
1024，像元尺寸为14μm
×
14μm，基线为0.24m，并且两相机间的旋转矩阵为i3×3。在非合作目标空间抓捕中，喷嘴特征可以视为圆特征，多边形本体可以视为多条平行直线特征，并且喷嘴与多边形本体平面平行。设定目标圆半径为235mm，直线与圆心距离为470mm。圆心的位置设定为[t
z
×
tan(-10
°
),t
z
×
tan(-5
°
),t
z
]，t
z
为圆心的z坐标，其中考虑目标位置的变化，t
z
的范围为2-10m，非合作目标圆的姿态设定为翻滚角30deg，俯仰角φ0＝0，偏航角θ0＝-15deg。如图2所示，左目相机坐标系σ
l
为o
l-x
l
y
l
z
l
，右目相机坐标系σ
r
为o
r-x
r
y
r
z
r
，两个相机系的齐次转换矩阵为
l
t
r
，u
l-v
l
和u
r-v
r
分别为左右目相机的像素坐标系，x
l-y
l
和x
r-y
r
分别为左右目相机的相平面π
l
、π
r
坐标系，l1、l2为空间中两条平行的直线，q为圆特征，q为圆特征q在左目相平面的投影，π
q
为圆平面，目标坐标系σ
t
为o
t-x
t
y
t
z
t
，直线l1与左目原点o
l
构成平面π1，直线l1为直线l1在左目相平面的投影，直线l'1、l'2为直线l1、l2在平面π
q
的投影。
[0055]
用椭圆图像处理算法，得到椭圆方程为：
[0056]
au2+bv2+cuv+du+ev+f＝0
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
[0057]
其中，[a,b,c,d,e,f]为检测到的椭圆方程参数，[u,v]为相应的像素坐标。
[0058]
将式(1)写成统一形式为：
[0059][0060]
其中，为椭圆方程参数的统一形式，x
c
＝[u v 1]
t
为像素坐标的统一形式。
[0061]
利用直线图像处理算法，得到空间直线两条平行直线l1和l2。直线l
i
对应的齐次坐标为：
[0062][0063]
其中，为直线特征参数，且等式成立。
[0064]
s2：基于步骤s1中得到的椭圆参数，计算圆特征的圆心位置和圆法向量，然后利用双目视觉消除圆二义性；
[0065]
两个相机系的齐次转换矩阵为：
[0066][0067]
其中，
l
r
r
为双目视觉相对姿态矩阵，
l
t
r
为相对位置矩阵。设定非合作目标坐标系σ
t
为o
t-x
t
y
t
z
t
，其中z
t
轴与圆法向方向重合，y
t
轴与直线方向重合，x
t
轴满足右手法则。
[0068]
对于空间中一个任意点p＝[x y z]
t
投影到相机平面上：
[0069]
z[u v 1]
t
＝k[x y z]
t
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(5)
[0070]
其中，k为相机的标定内参矩阵。则椭圆的边缘点满足：
[0071]
[x y z]k
t
ak[x y z]
t
＝0
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(6)
[0072]
定义γ为椭圆边缘和相机中心构成的非标准圆锥曲面，其中q＝k
t
ak为曲面γ的数学统一形式，通过对q矩阵正交变换：
[0073]
u-1
qu＝diag(λ
1 λ
2 λ2)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(7)
[0074]
其中，u是q的正交矩阵，λ
i
和v
i
(i＝1,2,3)是相应的特征值和特征向量，并且λ
i
满足条件λ1≥λ2＞0＞λ3。定义u＝[e
1 e
2 e3]，如果[v3]3>0，那么e3＝v3，否则e3＝-v3；此外e2＝v2,e1＝(e2×
e3)/‖e2×
e3‖。
[0075]
在标准椭圆坐标系o
c-x'y'z'中，标准椭圆的圆心位置和法向量分别为：
[0076][0077]
其中，o'
i
为标准椭圆的圆心，n'
i
为标准椭圆的法向量，r为圆特征的半径。
[0078]
通过将标准椭圆的圆心和法向量转换到相机参考坐标系中，得到圆的圆心位置和法向量为：
[0079][0080]
其中，为圆的圆心位置，为圆的圆法向量。
[0081]
通过分析，基于圆的位姿测量方法有两种位姿解，这意味着圆位姿求解存在二义性。通过式(7)(9)，采用双目视觉可以得到4个圆法向量其中
为坐标系σ
l
下的法向量，为坐标系σ
r
下的法向量，并且通过姿态转移矩阵
l
r
r
进行了变换。计算4个法向量的夹角：
[0082][0083]
其中，ψ1为圆法向量的夹角，ψ2为圆法向量的夹角，ψ3为圆法向量的夹角，ψ4为圆法向量的夹角。
[0084]
通过对比，找到4个夹角中最小的角，从而消除圆的二义性。定义消除二义性后的两个圆法向量为和圆心坐标为将右目相机圆心坐标从坐标系σ
r
转换到坐标系σ
l
，圆特征的圆心坐标在坐标系σ
l
中为：
[0085][0086]
s3：基于步骤s1中得到的直线特征参数，求得直线与相机原点构成线平面的法向量，并且基于步骤s2利用双目视觉下圆法向量，定义圆和线特征图像处理算法下误差的自适应系数；
[0087]
在左相机坐标系σ
l
中，π1和π2是两条平行直线l1,l2分别和相机原点o
l
构成的线平面，并且投影矩阵m
l
为：
[0088][0089]
其中，k
l
为左目相机事先标定的内参矩阵。
[0090]
因此，两个线平面π1和π2的齐次坐标为：
[0091][0092]
其中，[π
1x
,π
1y
,π
1z
,π
1w
]为线平面π1的齐次坐标，以及[π
2x
,π
2y
,π
2z
,π
2w
]为线平面π2的齐次坐标。
[0093]
两个线平面π1和π2的法向量分别为：
[0094]
[0095]
根据公式(4)(14)，可以得到4个线平面的法向量其中为坐标系σ
l
下的线平面法向量，为坐标系σ
r
下的线平面法向量，并且已通过姿态转移矩阵
l
r
r
进行了变换。
[0096]
首先，计算两个圆法向量和的夹角，并将其定义为圆图像处理算法的误差系数：
[0097]
α＝ψ
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(15)
[0098]
其次，如果直线图像处理算法没有误差，那么4个线平面法向量是共面的，因此线平面法向量不共面特性反映直线图像处理算法的误差。4个向量构成平面π0，推导得到，平面π0的法向量为
[0099][0100]
然后，β表示直线图像处理算法的误差系数：
[0101][0102]
s4：基于步骤s3定义的自适应系数以及直线与圆平行的约束，实现非合作目标翻滚角姿态测量，同时对圆法向量进行修正，提高非合作目标姿态测量精度。
[0103]
直线l1的方向向量满足下列条件：
[0104][0105]
其中π1是直线l1与相机原点形成的线平面，定义π
q
表示圆平面，根据l1//π
q
得到：
[0106][0107]
其中，n
e
为圆特征的圆法向量。
[0108]
因此，直线l1的方向向量为：
[0109][0110]
直线方向向量平行于y
t
轴，因此，另外两个坐标轴的方向向量为：
[0111][0112]
其中，分别为x
t
轴、y
t
轴、z
t
轴的方向向量。
[0113]
最后，非合作目标的姿态矩阵为
[0114]
采用本实施例的方法获得的非合作目标位置误差和姿态仿真结果分别如图3以及
图4所示。由图3可知，目标相对位置误差始终小于2％；同时，根据图4可知，三轴姿态角误差均在1.4deg以内。
[0115]
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
[0116]
对于本领域的普通技术人员来说，在不脱离本发明创造构思的前提下，还可以对本发明的实施例做出若干变型和改进，这些都属于本发明的保护范围。