[发明专利]一种航天器交会对接相对位姿测量方法

说明书

技术领域

本发明涉及机器视觉、计算方法、数学、数值方法领域，特别涉及一种基于普吕克直线方程的航天器交会对接相对位姿测量方法，适用于航天器交会对接时相对位姿的测量。

背景技术

航天器交会对接技术是指宇宙飞船、航天飞机这两类航天器在轨会合并在结构上连成一个整体的技术。美国20世纪60年代初的双子星座计划主要是依靠航天员的视觉观测来确定航天器之间的相对位置和姿态，俄罗斯的交会对接测量系统主要采用的是微波雷达技术，欧空局从20世纪80年代初期就开始研究交会对接测量技术及敏感器，2011年11月3日凌晨，我国神舟八号飞船与天宫一号实现交会对接，中国载人航天首次空间交会对接试验获得成功。2012年4月，我国的天宫一号与神舟九号载人交会对接任务已经进入全面实施阶段。

在航天器交会对接中，基于双目视觉的方法主要是通过射影几何、齐次坐标等数学工具描述图像的成像原理。传统的方法是在追踪航天器上安装两个CCD传感器，通过对特征点在CCD上成像的分析和计算就可以确定追踪航天器和目标航天器之间的相对位置和姿态信息，本发明选取目标航天器上的两条非共面直线在CCD上的成像分析来计算两个航天器相对位姿的方法则更加简便。在航天器交会对接中，确定六个自由度的相对位姿信息是一个非常重要的问题。经典的卫星姿态描述方法有欧拉角法、四元数法等。欧拉角是由坐标系经过三次旋转得到的三参数描述方法；四参数的四元数通过绕旋转轴一次旋转得到，可以避免欧拉角在大角度时“奇异”以及复杂的三角函数运算，但是这种方法是将位置和姿态分开来测量的，普吕克直线的方法则可以使航天器的位置和姿态统一起来测量。

发明内容

本发明要解决的技术问题是：针对目前航天器交会对接时位置和姿态分开测量的不足，本发明提供一种能够兼顾位置和姿态的测量，得到更精确测量结果的双目立体视觉的测量方法。

为解决上述技术问题，本发明一种航天器交会对接相对位姿测量方法，包括以下步骤：

步骤1、采用双目视觉定位算法确定目标航天器中任意两条非共面直线在追踪航天器坐标系中的坐标值；

步骤2、采用普吕克直线法表示上述两条非共面直线在目标航天器坐标系下的坐标值；

步骤3、采用普吕克直线法表示步骤1中获得的坐标值；

步骤4、根据步骤2和步骤3获得普吕克直线法表示的坐标值，采用普吕克直线方程确定这两条直线在目标航天器和追踪航天器坐标系下的相对位姿关系；

步骤5、根据步骤4获得的上述两条非共面直线在目标航天器和追踪航天器坐标系下的相对位姿关系，采用奇异值分解的方法获得单位对偶四元数表示目标航天器和追踪航天器坐标系间的相对位姿，从而得到两个航天器间的相对位置和姿态信息。

进一步地，本发明航天器交会对接相对位姿测量方法中，所述步骤1中，采用双目视觉定位法确定目标航天器中任意两条非共面直线在追踪航天器坐标系中的坐标值具体如下：由追踪航天器两个摄像机C₁与C₂观察到的目标航天器上任意两条非共面直线和在摄像机C₁图像坐标下的值分别为在摄像机C₂图像坐标下的值分别为则直线为由摄像机C₁坐标系原点O₁与组成的平面S₁和由摄像机C₂坐标系原点O₂与组成的平面S₂的交线，直线为由摄像机C₁坐标系原点O₁与组成的平面S₁′和由摄像机C₂坐标系原点O₂与组成的平面S₂′的交线，则在追踪航天器坐标系下的坐标值可由下面两个公式联立得到：