一种基于视觉测量的空间目标旋转轴识别方法与流程

本发明涉及空间目标运动状态辨识技术领域，尤其涉及一种基于视觉测量的空间目标旋转轴识别方法。

背景技术：

随着空间技术的发展，以空间交会对接、碎片规避、轨道与姿态重置、在轨释放有效载荷、在轨维修等为内容的空间操作技术成为现在和未来空间活动的重要内容。对于空间操作而言，对空间目标运动状态，包括位置和速度、姿态和转速的精确识别，是任务成功的必要条件。

视觉测量系统由于其质量轻便、价格便宜，且方便对被动目标进行观察，被广泛用于空间目标的识别。对于空间合作目标的测量，通过在合作的目标上安装标志信息或者通过接收目标自身的测量信息(如gps)等，采用卡曼滤波及其扩展方法较容易完成目标运动状态的识别。对于非合作目标，由于没有合作信息提供，运动状态的估计变得非常困难。到目前为止，大量对非合作目标识别的研究仅限于对空间静止目标的状态识别，对于非合作旋转目标的转速和姿态的识别，仅有少数文献涉及到。但目前这些文献的研究成果是基于这样的假设进行的：假定目标的惯量主轴已知，沿惯量主轴建立目标本体坐标系，从而定义目标与测量航天器的相对运动状态作为滤波状态，完成目标航天器运动状态的估值。但在现实世界中，非合作目标的惯量主轴往往难以预知。但没有现有技术针对这个问题进行研究。

技术实现要素：

为解决现有技术中存在的问题，本发明的目的在于提供一种基于视觉测量的空间目标旋转轴识别方法，通过图像测量方法识别非合作目标的旋转主轴(即最大惯量轴)，从而在主惯量轴坐标系下完成目标相对位置、姿态和转速的辨识。

为实现上述目的，本发明采用以下技术手段：

一种基于视觉测量的空间目标旋转轴识别方法，包括：

通过视觉系统对空间目标进行连续采样，采用无味卡曼滤波框架对目标旋转的方向和转速进行估值，从而对目标旋转轴识别。

作为本发明的进一步改进，包括以下步骤：

1)对测量航天器进行调整，使其与目标相对位置保持不变，确保目标保持在相机视场中；

2)设置滤波初值；

3)设置航天器转速、姿态和旋转轴与本体坐标系方向估计初值；

4)选择无味变换采样点；

5)根据无味卡曼滤波框架计算状态先验均值与方差；

6)对视觉测量图像进行特征点提取和识别；

7)计算特征点在目标本体坐标系位置；

8)根据5)计算的转速、姿态和旋转轴，及7)中计算的特征点位置，求解特征点在相机成像平面投影；

9)将6)中提取的特征点位置与8)中同一特征点的估值进行比较，计算偏差信息，获得滤波所需方差；

10)根据5)和8)中结果计算滤波增益；

11)如果滤波增益小于给定阈值，则已经估计出当前的转速、姿态和旋转轴方向；否则，根据滤波增益修正航天器转速、姿态和旋转轴与本体坐标系方向估值，重新开始第4)步，进行新一轮采样滤波。

作为本发明的进一步改进，步骤3)中，以目标惯量轴建立惯量轴坐标系，设z轴为最大惯量轴方向，则有：

使用符号ω^(pc),q^(pc)代表目标主惯量轴坐标系相对于相机坐标系的相对转速和姿态四元素，q^(pb)代表主惯量轴坐标系与本体坐标系姿态四元素；

假定观测卫星自身不旋转，则目标在转轴坐标系下的转速相对于观测卫星也不变：

目标的旋转轴相对目标本体的方向不变：

姿态与转速关系如下：

其中，ω定义如下：

其中，ω＝[ω1ω2ω3]代表刚体转速及其在空间坐标系三个方向的分量。

作为本发明的进一步改进，步骤4)中，选择无味变换采样点具体步骤为：

根据上一步得到的估值，在状态空间中均匀选择2n+1个采样点，n为状态变量个数，选择采样点方法如下：

其中，为上一步得到的估值，pt为上一步得到的协方差矩阵；λ取-2到+5之间的任意数。

作为本发明的进一步改进，步骤5)中，根据无味卡曼滤波框架计算状态先验均值与方差具体步骤如下：

首先，对每个采样点计算先验值；

f为状态方程；

然后，计算其均值和方差：

其中，w为样本点权值系数，qt为时刻t状态模型噪声矩阵。

作为本发明的进一步改进，步骤8)中，求解特征点在相机成像平面投影中，特征点在相机图像平面的投影关系如下：

其中，ρxi,ρyi,ρzi为第i个特征点在目标主惯量轴坐标系下的位置分量，fx,fz为相机在投影平面横坐标和纵坐标方向的焦距。

作为本发明的进一步改进，步骤10)中，滤波增益的计算公式如下：

其中：

其中，rt为时刻t的观测模型噪声矩阵，分别为t+1时刻的状态估计均值和观测估计均值，w为样本点权值系数。

作为本发明的进一步改进，步骤6)中，对视觉测量图像进行特征点提取的数量为3-6个。

与现有技术相比，本发明的有益效果是：

本发明通过视觉系统对空间目标进行连续采样，采用无味卡曼滤波框架对目标旋转的方向和转速进行估值，从而完成非合作目标的惯量主轴的预知。通过图像测量方法识别非合作目标的旋转主轴(即最大惯量轴)，从而在主惯量轴坐标系下完成目标相对位置、姿态和转速的辨识。通过使用该方法对不同转速的空间目标进行仿真验证，识别目标旋转轴的精度达到了工程满意的水平。完成空间旋转目标转轴的正确识别，即可以对目标的位置、速度、姿态和转速进行准确识别，从而为后续空间操控任务提供基础。该方法适用于空间合作目标、失效航天器和航天器碎片等空间非合作目标。

附图说明

图1为本发明基于视觉测量的空间目标旋转轴识别方法框架图；

图2为本发明视觉测量原理图；

图3为本发明目标旋转轴坐标与本体坐标关系。

具体实施方式

下面结合附图对本发明的结构和工作原理作进一步详细说明。

本发明一种基于视觉测量的空间目标旋转轴识别方法，通过视觉系统对空间目标进行连续采样，采用无味卡曼滤波框架对目标旋转的方向和转速进行估值，从而完成目标旋转轴识别。该方法适用于空间合作目标以及失效航天器的旋转轴识别。如图1所示，包括以下步骤：

1)对测量航天器进行调整，使其与目标相对位置保持不变，目标保持在相机视场中；

2)设置滤波初值；

3)设置航天器转速、姿态和旋转轴与本体坐标系方向估计初值；

4)选择无味变换采样点；

5)计算状态先验均值与方差；

6)对视觉测量图像进行特征点提取和识别；

7)计算特征点在目标本体坐标系位置；

8)根据5)计算的转速、姿态和旋转轴，及7)中计算的特征点位置，求解特征点在相机成像平面投影；

9)将6)中提取的特征点位置与8)中同一特征点的估值进行比较，计算偏差信息，获得滤波所需方差；

10)根据5)和8)中结果计算滤波增益；

11)如果滤波增益小于给定阈值(精度)，表明已经估计出当前的转速、姿态和旋转轴方向。否则，根据滤波增益修正航天器转速、姿态和旋转轴与本体坐标系方向估值，重新开始第4)步，进行新一轮采样滤波。

以下结合具体实施例对本发明的方法进行说明。

实施例

1)本过程实施的前提为：先完成测量航天器进行调整，使其与目标相对位置保持不变，目标保持在相机视场中。

2)滤波参数初始化

设置状态初值。

状态变量协方差矩阵：

p0|0＝e[(x0-x0|0)(x0-x0|0)^t]

＝diag(pw,pqp,pqb)(1)

其中，pw,pqp,pqb为ω^(pc),q^(pc),q^(bc)的协方差矩阵

状态模型噪声矩阵：q＝diag(qw,qqp,qqb)(2)

其中，qw,qqp,qqb分别为ω^(pc),q^(pc),q^(bc)的状态模型噪声矩阵

观测模型噪声矩阵：r＝diag(σw,σqp,σqb)(3)

其中，σw,σqp,σqb分别为ω^(pc),q^(pc),q^(bc)的观测模型噪声矩阵。

3)设置航天器转速、姿态和旋转轴与本体坐标系方向估计初值；

其中，分别为目标主惯量轴坐标系相对于相机坐标系的相对转速和姿态四元素初值，为目标本体坐标系相对于主惯量轴坐标系姿态四元素初值。4)选择无味变换采样点：根据上一步得到的估值，在状态空间中均匀选择2n+1个采样点，n为状态变量个数，从3)可知，n＝11。选择采样点方法如下：

其中，为上一步得到的估值，pt为上一步得到的协方差矩阵。λ可以取-2到+5之间的任意数。

5)根据其中的采样点计算状态先验均值与方差；

首先，对每个采样点计算先验值。

f为状态方程，由公式(20)—(23)组成。

然后，计算其均值和方差：

其中，w为样本点权值系数，qt为时刻t状态模型噪声矩阵。

6)对视觉测量获得的图像进行特征点提取和识别，很多方法可以完成此项工作，特征点提取和识别方法不在本申请保护范围。

7)确定每个特征点在目标本体坐标系位置；

8)根据第5)步计算的转速、姿态和旋转轴，及6)中获得的特征点位置信息，采用公式(26)求解特征点在相机成像平面投影。

9)将6)中提取的特征点位置与8)中计算出的同一特征点的估值进行比较，计算估计偏差。

其中，zt+1(i)为t+1时刻采集的第i个特征点在相机平面的投影。为第7)步中求解的特征点的均值。

10)根据5)和8)中结果计算滤波增益

其中：

rt为时刻t的观测模型噪声矩阵，分别为t+1时刻的状态估计均值和观测估计均值，w为样本点权值系数。

11)如果滤波增益小于给定阈值(精度)，表明已经估计出当前的转速、姿态和旋转轴方向。

否则，根据滤波增益修正状态估计参数(航天器转速、姿态和旋转轴与本体坐标系方向估值)：

修改协方差矩阵：

其中，kt+1、的计算在第10)步中已经完成。

重新开始第4)步，进行新一轮采样滤波。

本方法主要依据是欧拉原理：对于刚体在空间中的运动，如果没有受到外力矩作用，在经过一段时间无序的翻滚后，将逐渐稳定，最终保持绕最大惯量轴方向旋转，其转速的度数保持不变。假定目标在惯性坐标系下的转速为ω＝[ω1ω2ω3]^t,则其转轴，又称欧拉轴，方向为：

依据上述原理，以目标惯量轴建立惯量轴坐标系(pacs:principalaxiscoordinatesystem)，设z轴为最大惯量轴方向，则有：

由于在视觉测量过程中难以获得目标的惯量轴，通常会以目标的对称轴或通过以获取的特征点构成向量建立坐标系，这个坐标系可以定义为本体坐标系，用(b)表示。

采用符号ω^(pc),q^(pc)表示目标主惯量轴坐标相对于测量航天器的转速和姿态(四元素表示)，q^(bp)表示目标本体坐标系相对主惯量轴坐标系姿态(四元素表示)。可定义状态参数：

状态方程：

根据欧拉原理，刚体的姿态与转速关系如下：

假定观测卫星自身不旋转，则目标在转轴坐标系下的转速相对于观测卫星也不变：

目标的旋转轴相对目标本体的方向不变：

观察方程：

已知特征点在本体坐标系的位置，由下式可以得到其在主轴坐标系下的位置。

其中pi^(b)和pi^(p)为分别为目标在本体坐标系和主轴坐标系下特征点位置，d(q^bp)为本体坐标系到主轴坐标系旋转矩阵。

已知主轴坐标系与测量航天器相对姿态d(q^pc)矩阵，可由下式计算特征点相对于观察卫星的位置：

ρi＝ρ0+d(q^pc)pi^(p)＝ρ0+d(q^pc)d(q^bp)pi^(b)+d(q^pc)b(25)

由此，可以计算特征点在相机图像平面的投影

其中，fx和fz分别为相机在水平和垂直方向的焦距。

加上观测噪声，观测方程可以写为：

zik＝hi(xk)+viki＝1,…,n(27)

vik为观察噪声，n为特征点个数。

以下对本发明的方法进行仿真模拟，已验证本发明的有效性。

仿真模拟

取相对距离25米，目标本体坐标系相对相机坐标系姿态[5,5,5]度，旋转轴相对本体坐标系姿态[[102520]度，目标物体尺寸3×3×3米，对不同转速的空间目标进行仿真验证，经过2000秒的滤波，获得了比较好的精度。目标旋转轴的精度及目标本体姿态和转速精度如表1所示。

表1

完成空间旋转目标转轴的正确识别，即可以对目标的位置、速度、姿态和转速进行准确识别，从而为后续空间操控任务提供基础。该方法适用于空间合作目标、失效航天器和航天器碎片等空间非合作目标。

以上实施例仅用于说明本发明的技术方案而非对其限制，尽管参照上述实施例对本发明进行了详细说明，所属领域的普通技术人员依然可以对本发明的具体实施方案进行修改或者等同替换，而这些并未脱离本发明精神和范围的任何修改或者等同替换，其均在本发明的权利要求保护范围之内。