Stereo measurement of position and attitude of non-cooperative spacecraft

非合作航天器的立体视觉位姿测量 Stereo measurement of position and attitude of non-cooperative spacecraft 1 2 3 first-author 束　安（1994-），男，江苏淮安人，博士研究生，主要从事机器视觉和DSP图像处理方面的研究。E-mail：shuan@mail.sitp.ac.cn http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226667&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226669&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226668&type= 22.01333618 32.00403595 束　安 （1994-），男，江苏淮安人，博士研究生，主要从事机器视觉和DSP图像处理方面的研究。E-mail： shuan@mail.sitp.ac.cn shuan@mail.sitp.ac.cn 1 3 corresp E-mail： peihaodong@sina.com E-mail： peihaodong@sina.com peihaodong@sina.com 3 4 3 4 3 4 中国科学院 智能红外感知重点实验室，上海 200083 中国科学院 智能红外感知重点实验室，上海 200083 Key Laboratory of Intelligent Infrared Perception， Chinese Academy of Sciences， Shanghai 200083， China Key Laboratory of Intelligent Infrared Perception， Chinese Academy of Sciences， Shanghai 200083， China 中国科学院大学，北京 100049 中国科学院大学，北京 100049 University of Chinese Academy of Sciences， Beijing 100049， China University of Chinese Academy of Sciences， Beijing 100049， China 中国科学院 上海技术物理研究所，上海 200083 中国科学院 上海技术物理研究所，上海 200083 Shanghai Institute of Technical Physics， Chinese Academy of Sciences， Shanghai 200083， China Shanghai Institute of Technical Physics， Chinese Academy of Sciences， Shanghai 200083， China 中国科学院 红外探测与成像技术重点实验室，上海 200083 中国科学院 红外探测与成像技术重点实验室，上海 200083 Key Laboratory of Infrared System Detection and Imaging Technology， Chinese Academy of Sciences， Shanghai 200083， China Key Laboratory of Infrared System Detection and Imaging Technology， Chinese Academy of Sciences， Shanghai 200083， China 针对在轨服务中非合作航天器相对位姿测量的关键任务，提出了一种双目立体视觉方法。该方法利用两台大视场可见光相机获取高分辨率图像，用双边滤波方法对图像进行预处理，接着利用弧线段拟合法提取目标表面的对接环椭圆，用Hough变换法提取目标的矩形边框特征，并引入极线约束准则、对接环尺寸约束和光流跟踪的方法，提高算法的提取精度和效率。利用立体视觉构建非合作目标的对接环平面和边框角点，建立目标坐标系，解算与世界坐标系之间的位姿关系。暗室环境下的实验结果表明，双目相机系统逼近（12.0~2.0 m）实验中，相对位置精度优于1.0 cm，相对姿态精度优于0.41°；目标姿态转动实验中，相对位置精度优于1.3 cm，相对姿态精度优于0.88°，位姿解算精度较高，可以为追踪航天器提供连续的位姿导航信息。 For in-orbit servicing， a binocular stereo vision measurement method was proposed to precisely determine the relative position and attitude of non-cooperative spacecraft. First， two wide-field visible light cameras were used to capture high-resolution images； the images were then preprocessed via bilateral filtering. Next， the docking ring from the target surface was extracted using arc line segments. The rectangular border features of the target were extracted by Hough transform. Polar line constraints， the size constraint of the docking ring， and the optical flow method were introduced to improve the extraction accuracy and efficiency of the algorithm. The docking ring plane and the corner of the frame of the non-cooperative target were determined using stereo vision. Further， the target's coordinate system was established and its relative position was calculated using the world coordinate system. Accordingly， a binocular-camera system approximation （12.0-2.0 m） experiment performed in a dark room reveals that the accuracy of relative position exceeds 1.0 cm， whereas that of relative attitude exceeds 0.41°； the relative position accuracy exceeds 1.3 cm， whereas relative attitude accuracy exceeds 0.88° in the target attitude rotation experiment， which can provide continuous position and attitude navigation information for tracking spacecraft. 双目立体视觉 非合作目标 双边滤波 位姿测量 在轨服务 binocular stereo vision non-cooperative target bilateral filter attitude measurement on-orbit servicing 1 引　言 1 近年来随着人类对太空探索的深入及全球对空间资源的持续开发与利用，空间碎片的数量急剧增加。例如2019年印度进行了反卫星实验，美国国家航空航天局（NASA）表示该实验产生了约400多块碎片，其中有24块的轨道远地点超过了国际空间站所在轨道高度，给国际空间站和在轨卫星的正常工作造成了巨大的风险 ［ 1 1 ］ 。空间碎片一旦与正在服役的卫星航天器发生碰撞，会直接改变航天器的表面性能，导致航天器系统故障，对航天器的威胁极大。并且废弃的航天器还占用了宝贵的轨道资源，所以面向非合作航天器的在轨服务技术（On-Orbit Servicing，OOS）受到各国航天领域研究人员的重视 ［ 2 2 - 3 3 2-3 ］ 。 空间非合作航天器在轨服务的关键任务在于连续获取目标相对追踪系统的相对位置和姿态。随着立体视觉的发展，国际上以空间机器人进行空间在轨服务已成为一种必然趋势 ［ 4 4 - 5 5 4-5 ］ 。而视觉传感器作为空间机器人最主要的部分，成为了国内外航天机构的研究重点。2015年，美国国防高级研究项目局（DARPA）在凤凰计划的基础上提出了“地球静止轨道卫星机器人服务”（RSGS），它采用多目视觉手段，在抓捕非合作航天器的逼近阶段，利用三目视觉算法实现对非合作目标的位姿测量，并计划于2022年或2023年发射 ［ 6 6 - 7 7 6-7 ］ 。2012年，欧洲航天局（ESA）的e.Deorbit计划也属于清洁太空提倡工作，目的是开展针对欧洲环境卫星Envisat的救援计划，该计划采用3相机+2激光雷达的组合构成用于自动操作的视觉系统，预计在2023年执行首次主动碎片清除计划 ［ 8 8 - 9 9 8-9 ］ 。在国内，蔡晗针对非合作目标显著的矩形太阳能帆板和星箭对接环等，利用特征提取和最小二乘法椭圆拟合的方法进行双目视觉测量，并通过地面仿真验证了该方法在超近程阶段（小于4 m）的有效性 ［ 10 10 ］ 。杨宁等以航天器本体和星箭对接环作为识别特征，提出了立体视觉相对位姿自主测量方法，在航天器本体尺寸为0.28 m、相对距离为2 m时位置测量精度小于4 mm，姿态测量精度小于1.5° ［ 11 11 ］ 。吴斌等针对含有圆和直线特征的1 m×1 m航天器，将基于直线和椭圆检测单目算法嵌入到现场可编程门阵列（FPGA）和数字信号处理器（DSP）系统中，当距离小于4 m时，距离方向精度优于10 cm，角度精度优于1° ［ 12 12 ］ 。综上所述，国外已将双目立体视觉技术应用到航天领域，但大多处于理论验证与样机研制阶段，而国内针对非合作航天器的双目视觉测量研究大多处在理论研究与计算机模拟仿真阶段，地面模拟实验不足。 本文提出一种对非合作航天器的双目立体视觉位姿测量方法。该方法采用两台大视场可见光相机获取高分辨率图像，用最大类间方差法（OTSU）和双边滤波法对图像进行预处理，接着利用弧线段拟合法提取目标表面的对接环椭圆，用Hough变换提取目标的矩形边框特征，并引入极线约束准则、对接环尺寸约束和光流跟踪的方法，提高算法的提取精度和效率。该方法具有较高的位姿解算精度，可以为追踪航天器提供连续的位姿导航信息。 2 双目立体视觉位姿测量方法 1 图1 图1 为本文双目立体视觉位姿测量方法的流程。其中，预处理在对图像进行去噪的同时，要保留边缘信息；对接环检测部分是通过弧线段拟合法，结合极线约束和尺寸约束提取目标的对接环椭圆；矩形边框检测部分是通过Hough直线变换及光流法辅助跟踪检测目标的四条边框直线；最后通过立体视觉原理构建的对接环平面和边框角点建立目标坐标系，解算检测目标相对于世界坐标系的位姿关系。 2.1　坐标系定义 2 为了方便解算非合作航天器与双目相机测量系统的位姿关系，建立目标坐标系（ <math id="M1"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226675&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226673&type= 18.03400040 3.72533321 ）、左相机坐标系（ <math id="M2"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226677&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226676&type= 16.42533302 3.72533321 ）和世界坐标系（ <math id="M3"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226679&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226678&type= 20.15066719 3.72533321 ），如 图2 图2 所示。 2 . 1 . 1　目标坐标系（ <math id="M4"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226684&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226683&type= 18.20333290 3.72533321 ） 3 该坐标系建立在非合作目标的表面，目标坐标系的原点 <math id="M5"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226687&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226685&type= 4.06400013 3.72533321 位于对接环的中心， <math id="M6"><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226690&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226688&type= 3.81000018 3.72533321 轴为对接环平面的法向量，与相机光轴同向，原点 <math id="M7"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226693&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226692&type= 4.06400013 3.72533321 指向边框角点的向量为 <math id="M8"><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226695&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226694&type= 4.06400013 3.72533321 轴，对应右手准则得到 <math id="M9"><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226698&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226696&type= 3.47133350 3.72533321 轴。 2 . 1 . 2　左相机坐标系（ <math id="M10"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226701&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226700&type= 16.42533302 3.72533321 ） 3 原点 <math id="M11"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226703&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226702&type= 3.64066648 3.72533321 定义为左相机的光心， <math id="M12"><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226705&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226704&type= 3.30199981 3.72533321 轴和 <math id="M13"><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226707&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226706&type= 3.64066648 3.72533321 轴分别与图像的行和列平行。 <math id="M14"><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226709&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226708&type= 3.04799986 3.72533321 轴为左相机的光轴，与图像平面垂直。 2 . 1 . 3　世界坐标系（ <math id="M15"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226711&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226710&type= 20.15066719 3.72533321 ） 3 世界坐标系定义在双目相机的安装支架上，以安装支架的中心为原点 <math id="M16"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226713&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226712&type= 4.57200003 3.72533321 ， <math id="M17"><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226715&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226714&type= 4.23333359 3.72533321 轴为双目系统的逼近方向， <math id="M18"><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226717&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226716&type= 4.57200003 3.72533321 轴的方向为左相机光心指向右相机光心，对应右手准则得到 <math id="M19"><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226719&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226718&type= 3.97933340 3.72533321 轴。文中的世界坐标系与左相机坐标系之间只存在刚体变换。 2.2　图像预处理 2 由于真实场景光照特性复杂，且非合作航天器表面材料特殊，相机在实际成像过程中，会存在噪声 ［ 13 13 ］ 。这些噪声叠加在原始图像上，不利于对接环椭圆和目标边框直线的检测，从而难以解算较高精度的位姿信息，所以在检测之前需要对图像进行预处理。一般大多采用滤波算法进行去噪处理，如均值滤波、中值滤波和高斯滤波等，这些滤波算法通过对邻域像素的加权平均来实现去噪的目的。但仅对图像进行空间域的处理，往往会在去噪的同时损失大量图像细节，使图像边缘过度平滑，丢失细节特征 ［ 14 14 ］ 。 本文选用双边滤波（Bilateral Filter，BF）法对左右图像进行预处理，该方法在高斯滤波器的基础上增加对像素之间相似度的判断，具有简单、非迭代和局域的特点，能够在保持图像边缘的基础上去除图像的噪声 ［ 15 15 ］ 。双边滤波法可定义如下： <math display="block" id="M20"><msub><mrow><mi>g</mi></mrow><mrow><mi mathvariant="normal">B</mi><mi mathvariant="normal">F</mi></mrow></msub><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>=</mo><mfrac><mrow><munder><mo movablelimits="false">∑</mo><mrow><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>∈</mo><mi>S</mi></mrow></munder><mrow><mi>g</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>⋅</mo><mi>w</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></mrow></mrow><mrow><munder><mo movablelimits="false">∑</mo><mrow><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>∈</mo><mi>S</mi></mrow></munder><mrow><mi>w</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></mrow></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226721&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226720&type= 54.69466782 15.32466698 ， 式中： <math id="M21"><msub><mrow><mi>g</mi></mrow><mrow><mi mathvariant="normal">B</mi><mi mathvariant="normal">F</mi></mrow></msub><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226723&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226722&type= 14.47799969 4.74133348 为滤波后的结果， <math id="M22"><mi>g</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226725&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226724&type= 11.68400002 3.81000018 为原图像 <math id="M23"><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226727&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226726&type= 9.05933285 3.81000018 点的像素值， S 表示 <math id="M24"><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226729&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226728&type= 9.05933285 3.81000018 点的掩膜集合， <math id="M25"><mi>w</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226731&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226730&type= 12.53066635 3.81000018 为滤波器的权重，其表达式为： <math display="block" id="M26"><mi>w</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>=</mo><mi>c</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>⋅</mo><mi>s</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226733&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226732&type= 40.89400101 3.81000018 ， 其中： <math display="block" id="M27"><mi>c</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>=</mo><msup><mrow><mi mathvariant="normal">e</mi></mrow><mrow><mo>-</mo><mfrac><mrow><msup><mrow><mfenced open="[" close="]" separators="|"><mrow><mo stretchy="false">(</mo><mi>x</mi><mo>-</mo><msub><mrow><mi>x</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><msup><mrow><mo stretchy="false">)</mo></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>+</mo><mo stretchy="false">(</mo><mi>y</mi><mo>-</mo><msub><mrow><mi>y</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><msup><mrow><mo stretchy="false">)</mo></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow><mrow><mn mathvariant="normal">2</mn><msup><mrow><msub><mrow><mi>σ</mi></mrow><mrow><mi>c</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow></mfrac></mrow></msup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226735&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226734&type= 40.13199997 9.31333351 ， <math display="block" id="M28"><mi>s</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>=</mo><msup><mrow><mi mathvariant="normal">e</mi></mrow><mrow><mo>-</mo><mfrac><mrow><msup><mrow><mfenced open="[" close="]" separators="|"><mrow><mi>g</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo><mo>-</mo><mi>g</mi><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><mo stretchy="false">)</mo></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow><mrow><mn mathvariant="normal">2</mn><msup><mrow><msub><mrow><mi>σ</mi></mrow><mrow><mi>s</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup></mrow></mfrac></mrow></msup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226738&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226736&type= 37.93066788 9.31333351 ， 式中： <math id="M29"><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mi mathvariant="normal">c</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226740&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226739&type= 10.83733368 4.74133348 为掩模中心点， <math id="M30"><mi>c</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226742&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226741&type= 11.09133339 3.81000018 和 <math id="M31"><mi>s</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226744&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226743&type= 10.75266743 3.81000018 分别表示空间域和值域的权重， <math id="M32"><msub><mrow><mi>σ</mi></mrow><mrow><mi>c</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226746&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226745&type= 2.70933342 3.72533321 和 <math id="M33"><msub><mrow><mi>σ</mi></mrow><mrow><mi>s</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226748&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226747&type= 2.53999996 3.72533321 为2个高斯函数核的标准差。所以，BF法综合考虑了空间域和值域来分配权重，减少了图像边缘区域被过度平滑的现象，起到了保边降噪的作用。 为保证双目测量系统的实时性，本文在进行双边滤波前先通过最大类间方差法 ［ 16 16 ］ 快速计算图像的最优化阈值，以前景和背景的类间方差最大作为阈值选取准则，将图像分为前景区和背景区。然后建立包含前景（非合作目标本体）的感兴趣区域（Region of Interest，ROI），在该区域进行图像的预处理，提高双目测量系统的计算效率。 图3 图3 为非合作航天器显著特征进行图像预处理前后的对比，可以看出，滤波后目标表面的噪声得到了很好的去除，目标的边框信息更为突出，对接环边缘信息也得到了很好的保留。 2.3　非合作航天器显著特征提取 2 在轨服务的近距离阶段，双目视觉测量系统受光照的影响，相机采集的图像信息较为丰富，但其中大部分并非位姿解算所需要的，所以需要从这些丰富的信息中提取显著的信息特征参与解算。本文研究的非合作航天器，通常表面含有星箭对接环、喷嘴、矩形边框和帆板等特征信息。由于帆板位于航天器两侧，很容易超出相机视场，而喷嘴的尺寸较小，所以本文通过提取目标表面的星箭对接环和矩形边框，建立目标坐标系，解算与世界坐标系的位姿关系，为追踪航天器提供精准的相对导航信息。 2 . 3 . 1　星箭对接环椭圆提取 3 根据相机成像原理，星箭对接环在双目相机像面上大多以椭圆形式呈现，常见的椭圆提取方法包括最小二乘法拟合、Hough变换和基于圆弧段拟合 ［ 2 2 ］ 。基于最小二乘法拟合椭圆通常利用图像的边缘检测信息，要求所有参与计算的边缘点在同一个椭圆上，对于星箭对接环这种包含多个同心圆的目标适应性较差；Hough变换则根据椭圆方程的5参数 <math id="M34"><mo stretchy="false">(</mo><msub><mrow><mi>x</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><msub><mrow><mi>y</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><mi>a</mi><mo>,</mo><mi>b</mi><mo>,</mo><mi>θ</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226755&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226754&type= 22.60599899 4.74133348 ，需要建立一个五维空间的累加器，不仅计算量大，且需要占用大量的内存资源，难以满足实时和嵌入式要求；基于圆弧段的椭圆拟合法根据弧段的特征将提取的边缘线段连接成弧段并分组，利用分组后的弧线段组进行椭圆参数的拟合。这种方法可以快速提取目标表面的多个椭圆特征，具有高鲁棒性、高效率等优点。 本文利用直线段检测（Line Segment Detector，LSD）算法 ［ 17 17 ］ ，快速从图像上提取亚像素级的线段，并根据线段的连续性和凸性分组得到弧线段组，对分组后的弧线段进行椭圆参数的拟合。基于LSD弧线段的椭圆检测方法 ［ 18 18 ］ 的具体步骤如下： （1）运用LSD方法从原始图像中提取所有线段，得到去除直线段后的 n 条弧线段集合 <math id="M35"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>a</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>a</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>a</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msubsup><mrow><mi>a</mi></mrow><mrow><mi>n</mi></mrow><mrow><mi>l</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226759&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226757&type= 25.65399933 4.48733330 ； （2）基于弧支撑线段的连续性和凸性原则，将属于同一曲线边缘的弧线段分为1组，形成 k 个弧线段组 <math id="M36"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>g</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>g</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>g</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msubsup><mrow><mi>g</mi></mrow><mrow><mi>k</mi></mrow><mrow><mi>l</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226763&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226761&type= 25.65399933 4.74133348 ； （3）对于弧线段组内的弧线段所跨角度较大时，直接进行最小二乘法拟合；对于所跨角度较小的组，进行两两组合拟合椭圆，最终得到初始椭圆集 <math id="M37"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>e</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>e</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>e</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow><mi>l</mi></mrow></msubsup><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msubsup><mrow><mi>e</mi></mrow><mrow><mi>m</mi></mrow><mrow><mi>l</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226767&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226765&type= 24.72266769 4.48733330 ， m 为初始椭圆集个数； （4）运用椭圆类聚合算法对初始椭圆几何进行聚类分析，并应用椭圆的几何性质加以验证，产生候选椭圆集合。 由于真实的空间环境较为复杂，且非合作航天器的对接环具有一定厚度和宽度，受光照角度的影响，图像上的圆弧段既来自凸出的对接环本身，也可能包含部分本体表面的环壁和阴影，从而拟合出多个椭圆特征，如 图4 图4 所示。为了筛选出正确的对接环，本文利用双目视觉的极线约束准则和对接环尺寸信息，建立完善的对接环筛选机制，具体步骤如下： （1）对于左图上椭圆集合中的任一椭圆子集 <math id="M38"><msub><mrow><mi>e</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226778&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226776&type= 2.28600001 3.72533321 ，计算圆心 <math id="M39"><mi>p</mi><mo stretchy="false">(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226781&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226779&type= 11.42999935 3.81000018 在右图上的极线 <math id="M40"><msub><mrow><mi>l</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226786&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226784&type= 1.94733334 3.72533321 ， F 表示左相机与右相机之间的基础矩阵： <math display="block" id="M41"><msub><mrow><mi>l</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>=</mo><mi mathvariant="bold-italic">F</mi><mi>p</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226790&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226788&type= 11.34533310 4.57200003 . （2）计算右图上椭圆集合中的各个子集的圆心到极线 <math id="M42"><msub><mrow><mi>l</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226794&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226792&type= 1.94733334 3.72533321 的距离 <math id="M43"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow/></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow/></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow/></msubsup><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mi>m</mi></mrow><mrow/></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226798&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226796&type= 27.34733391 3.97933340 ，若小于阈值 t ，则为候选匹配椭圆； （3）计算候选匹配椭圆集中各子集对应的对接环半径，选取与真实半径最接近的一组，即为最终的对接环椭圆。 2 . 3 . 2　矩形边框提取 3 通过提取非合作航天器的对接环，可以解算出目标的相对位置、俯仰和偏航等信息，但是无法判断滚转维的信息，所以需要提取目标表面的显著特征，确定目标的滚转情况。由于空间环境背景纯黑，非合作航天器的边框直线特征更为突出。 本文通过Hough变换提取非合作航天器的矩形边框特征，其基本思路是利用图像空间与参数空间点-线的对偶性，即对图像空间进行坐标变换，使它在另一坐标的特定位置出现峰值，从而将检测曲线转化为寻找峰值的问题 ［ 19 19 ］ 。为提高解算效率，通过极线约束准则和光流法辅助跟踪观测 ［ 20 20 ］ ，实现边框角点的选择以及优化角点提取算法，具体过程如下： （1）对于初始帧，通过hough变换提取非合作航天器的4条直线边框，计算左右图像4条直线边框的交点，分别为 <math id="M44"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226802&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226800&type= 20.31999969 4.82599974 和 <math id="M45"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226806&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226804&type= 20.31999969 4.82599974 ，通过双目极线约束准则，空间点 <math id="M46"><mi>P</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226810&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226808&type= 2.45533323 2.79399991 在左图像的位置 <math id="M47"><msub><mrow><mi>p</mi></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226814&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226812&type= 2.53999996 4.57200003 时，相应的右图像匹配点 <math id="M48"><msub><mrow><mi>p</mi></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226818&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226816&type= 2.70933342 4.57200003 必然在极线 <math id="M49"><mi>l</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226822&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226820&type= 1.18533337 2.79399991 上。所以通过极线距离约束，将4个角点一一匹配，极线距离分别为 <math id="M50"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow/></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow/></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow/></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow><mrow/></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226826&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226824&type= 21.84399986 3.97933340 ，选择极线距离最小时对应的角点，计算角点在世界坐标系下的三维坐标，参与建立目标坐标系。此外，将左右图像的4个角点坐标作为光流法辅助跟踪的初始点集 <math id="M51"><msub><mrow><mi>P</mi></mrow><mrow><mi mathvariant="normal">p</mi><mi mathvariant="normal">r</mi><mi mathvariant="normal">e</mi><mi mathvariant="normal">v</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226830&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226828&type= 6.09599972 3.72533321 ，并对滤波后图像进行裁剪，去除背景，提取ROI，下一帧只在该ROI模板中进行边框角点提取，提高算法效率； （2）对于非初始帧，以左图为例，根据ROI模板提取当前帧的ROI，在区域内进行直线检测，并计算交点坐标 <math id="M52"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">0</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">1</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">2</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">3</mn></mrow><mrow><mi mathvariant="normal">l</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226834&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226832&type= 22.60599899 4.82599974 ， t 表示当前帧数，辅以进行光流跟踪，得到光流跟踪的4个角点坐标 <math id="M53"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">0</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">1</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">2</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">3</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226838&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226836&type= 22.60599899 4.82599974 ，计算与检测点的像素距离 <math id="M54"><mfenced open="{" close="}" separators="|"><mrow><msubsup><mrow><mi>d</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">0</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">1</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">2</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>d</mi></mrow><mrow><mi>t</mi><mn mathvariant="normal">3</mn></mrow><mrow><mi mathvariant="normal">o</mi></mrow></msubsup></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226843&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226840&type= 23.87599945 4.48733330 ，选取离上一帧距离最近的交点，作为边框角点；当该帧的检测点与光流跟踪点之间的像素距离大于某一阈值（本文设置 <math id="M55"><msub><mrow><mi>d</mi></mrow><mrow><mi mathvariant="normal">m</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">x</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">10.0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226846&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226844&type= 17.44133377 3.72533321 ）时，认为检测点异常，选择光流跟踪的点代替边框角点，从而提高双目视觉测量系统的稳定性。 2.4　非合作航天器位姿测量 2 根据双目视觉系统的坐标系定义（见 图2 图2 ），解算非合作航天器的位姿关系，即为计算目标坐标系（ <math id="M56"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226850&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226848&type= 16.76399994 3.72533321 ）相对于世界坐标系（ <math id="M57"><msub><mrow><mi>O</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226854&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226852&type= 20.15066719 3.72533321 ）的旋转矩阵 <math id="M58"><msubsup><mrow><mi mathvariant="bold-italic">R</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226859&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226857&type= 4.31799984 3.97933340 和 <math id="M59"><msubsup><mrow><mi mathvariant="bold-italic">T</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226863&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226861&type= 4.23333359 3.97933340 。假设对接环中心和边框角点在世界坐标系下的坐标为 <math id="M60"><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226868&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226865&type= 3.81000018 3.97933340 和 <math id="M61"><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226872&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226871&type= 3.81000018 3.97933340 ， <math id="M62"><mi>t</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226878&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226876&type= 1.10066664 2.79399991 表示当前帧数，则目标坐标系的单位方向轴 <math id="M63"><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>x</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226885&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226882&type= 3.38666677 3.72533321 ， <math id="M64"><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>y</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226890&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226887&type= 3.21733332 3.72533321 和 <math id="M65"><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>z</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226897&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226893&type= 3.13266659 3.72533321 如下： <math display="block" id="M66"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>x</mi></mrow></msub><mo>=</mo><msubsup><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></mtd></mtr><mtr><mtd><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>y</mi></mrow></msub><mo>=</mo><mo stretchy="false">(</mo><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>t</mi></mrow></msubsup><mo>-</mo><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup><mo stretchy="false">)</mo><mo>/</mo><msub><mrow><mfenced open="‖" close="" separators="|"><mrow><mfenced open="" close="‖" separators="|"><mrow><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>t</mi></mrow></msubsup><mo>-</mo><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></mrow></mfenced></mrow></mfenced></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>z</mi></mrow></msub><mo>=</mo><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>x</mi></mrow></msub><mo>×</mo><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>y</mi></mrow></msub></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226903&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226900&type= 45.46599960 17.01799965 ， 其中 <math id="M67"><msubsup><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226909&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226906&type= 3.30199981 3.97933340 为对接环平面的法向量。则目标系相对于世界坐标系的旋转矩阵和平移向量为： <math display="block" id="M68"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><msubsup><mrow><mi mathvariant="bold-italic">R</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow><mrow><mi>t</mi></mrow></msubsup><mo>=</mo><mo stretchy="false">[</mo><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>x</mi></mrow></msub><mo>,</mo><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>y</mi></mrow></msub><mo>,</mo><msub><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mi>z</mi></mrow></msub><mo stretchy="false">]</mo></mtd></mtr><mtr><mtd><msubsup><mrow><mi mathvariant="bold-italic">T</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow><mrow><mi>t</mi></mrow></msubsup><mo>=</mo><msubsup><mrow><mi mathvariant="bold-italic">X</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226916&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226913&type= 27.00866890 9.99066734 ， <math display="block" id="M69"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><msub><mrow><mi>θ</mi></mrow><mrow><mi>x</mi></mrow></msub><mo>=</mo><mi mathvariant="normal">a</mi><mi mathvariant="normal">r</mi><mi mathvariant="normal">c</mi><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mo stretchy="false">(</mo><msub><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">32</mn></mrow></msub><mo>,</mo><msub><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">33</mn></mrow></msub><mo stretchy="false">)</mo></mtd></mtr><mtr><mtd><msub><mrow><mi>θ</mi></mrow><mrow><mi>y</mi></mrow></msub><mo>=</mo><mi mathvariant="normal">a</mi><mi mathvariant="normal">r</mi><mi mathvariant="normal">c</mi><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mfenced separators="|"><mrow><mo>-</mo><msub><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">31</mn></mrow></msub><mo>,</mo><mroot><mrow><msubsup><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">32</mn></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msubsup><mo>+</mo><msubsup><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">33</mn></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msubsup></mrow><mrow/></mroot></mrow></mfenced></mtd></mtr><mtr><mtd><msub><mrow><mi>θ</mi></mrow><mrow><mi>z</mi></mrow></msub><mo>=</mo><mi mathvariant="normal">a</mi><mi mathvariant="normal">r</mi><mi mathvariant="normal">c</mi><mi mathvariant="normal">t</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">n</mi><mo stretchy="false">(</mo><msub><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">21</mn></mrow></msub><mo>,</mo><msub><mrow><mi>r</mi></mrow><mrow><mn mathvariant="normal">11</mn></mrow></msub><mo stretchy="false">)</mo></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226925&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226921&type= 46.56666946 18.28800011 ， 其中： <math id="M70"><msub><mrow><mi>θ</mi></mrow><mrow><mi>x</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226932&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226929&type= 3.04799986 3.72533321 ， <math id="M71"><msub><mrow><mi>θ</mi></mrow><mrow><mi>y</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226939&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226936&type= 2.96333337 3.72533321 和 <math id="M72"><msub><mrow><mi>θ</mi></mrow><mrow><mi>z</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226945&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226942&type= 2.87866688 3.72533321 分别为目标的三轴角度变化， <math id="M73"><msub><mrow><mi>r</mi></mrow><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo stretchy="false">(</mo><mi>i</mi><mo>=</mo><mn mathvariant="normal">1</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mn mathvariant="normal">3</mn><mo>;</mo><mi>j</mi><mo>=</mo><mn mathvariant="normal">1</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mn mathvariant="normal">3</mn><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226951&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226948&type= 38.26933289 4.65666676 为旋转矩阵 <math id="M74"><msubsup><mrow><mi mathvariant="bold-italic">R</mi></mrow><mrow><mi mathvariant="normal">w</mi></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226957&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226954&type= 4.31799984 3.97933340 的对应元素。根据2.3.1节和2.3.2节的对接环和边框角点提取方法，可以计算出 <math id="M75"><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226963&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226960&type= 3.81000018 3.97933340 和 <math id="M76"><msubsup><mrow><mi>X</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226969&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226966&type= 3.81000018 3.97933340 。所以还需要重建出非合作目标的对接环平面，计算对接环平面的法向量 <math id="M77"><msubsup><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226976&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226973&type= 3.30199981 3.97933340 。 如 图5 图5 所示，对于左图，过对接环圆心等角度绘制 k 条直线，则与对接环椭圆的交点为｛ <math id="M78"><msub><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><mo>,</mo><msub><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><mo>,</mo><msub><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow></msub><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msub><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226983&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226979&type= 23.70666695 4.57200003 ｝，以点 <math id="M79"><msub><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226990&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226987&type= 3.04799986 4.57200003 为例，利用双目极线约束准则得到该点在右图上的极线为 <math id="M80"><msub><mrow><mi>l</mi></mrow><mrow><mi>p</mi><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227002&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10226998&type= 3.30199981 3.72533321 ，与右图上对接环椭圆的交点分别为 <math id="M81"><msub><mrow><mi>p</mi></mrow><mrow><mi mathvariant="normal">r</mi><mn mathvariant="normal">0</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227011&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227006&type= 3.64066648 4.57200003 和 <math id="M82"><msub><mrow><mi>p</mi></mrow><mrow><mi mathvariant="normal">r</mi><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227020&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227016&type= 3.64066648 4.57200003 ，通过立体视觉原理和与对接环圆心三维坐标的关系即可筛选出正确的匹配点。同理，可计算出左图所有点在右图上对应的点集为｛ <math id="M83"><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msubsup><mrow><mi>p</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow><mrow><mi mathvariant="normal">r</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227028&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227024&type= 23.70666695 4.82599974 ｝，从而求出对应点的三维点集｛ <math id="M84"><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><mo>,</mo><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><mo>,</mo><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">3</mn></mrow></msub><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><msub><mrow><mi>P</mi></mrow><mrow><mn mathvariant="normal">2</mn><mi>k</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227035&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227032&type= 26.16199875 4.14866638 ｝。通过最小二乘法迭代计算对接环平面方程，得到对应三维圆的单位法向量 <math id="M85"><msubsup><mrow><mi mathvariant="bold-italic">n</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227044&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227040&type= 3.30199981 3.97933340 。 3 测量实验与结果 1 为了验证本文所提方法的有效性，本文选用2台项目组研制的60°×60°的大视场相机，探测器尺寸为2 048×2 048 pixel，像元尺寸为5.5 <math id="M86"><mi mathvariant="normal">μ</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227065&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227061&type= 4.99533367 3.64066648 ×5.5 <math id="M87"><mi mathvariant="normal">μ</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227073&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227069&type= 4.99533367 3.64066648 ，焦距为10 mm。为了获取更大的检测视场，两台相机的基线为1.3 m，并将光轴内旋18°。采用目前较为成熟的张氏平面标定法 ［ 21 21 ］ ，标定的重投影误差分别为0.22和0.12个像素。选用的非合作测量目标为2 m×2 m的卫星模型，内环半径为60 cm。暗室环境下，测量模型与双目相机分别安装于两个六自由度的机械臂上，导轨长度为15 m，实验中使用0.1个太阳常数的太阳模拟器作为光源，光线与测量模型的角度约为30°。双目视觉测量系统为嵌入式DSP6678信息处理平台，主要分为左右2个图像处理平台和1个主控处理平台，图像预处理、对接环检测、矩形边框提取和光流法辅助跟踪在图像处理平台完成，主控处理平台利用极线约束和半径约束的方法进行候选椭圆的筛选和边框角点的提取，从而建立目标坐标系，解算非合作航天器的相对位姿信息。双目测量系统的数据更新率为1 Hz。 在某一状态下三目相机获取的图像如 图6 图6 所示。当前帧提取的对接环和矩形边框如 图7 图7 所示。 3.1　双目相机系统位置逼近实验 2 当追踪航天器距离非合作目标较近时，双目立体视觉系统能够在由远及近的逼近过程中连续为航天器提供位姿导航信息，是在轨服务的关键。本次实验中目标模型处于静止状态，双目相机系统在距目标12.0 m处，以4 cm每帧的速度向它逼近，运动到2.0 m处停止，共获得251帧图像。该组工况下非合作目标的绝对位姿和相对位姿变化如 图8 图8 所示。 1,2;3,4; 从 图8 图8 可以看出，在双目相机系统向非合作目标匀速逼近的过程中，在远距离段（12.0~10.0 m）时， X 轴的相对位置和姿态的波动较大，这是由于在远距离时，目标在双目图像上的成像较小，单个像元所占的真实尺寸较大，由于光照的不稳定，对接环和边框直线的检测精度比近距离时低，解算的相对位姿精度也较低，但波动最大不超过2 cm和1°。总体来看，该方法在逼近实验中的输出结果较为稳定，具备近距离范围内连续的位姿解算能力。最终目标模型的三轴前后帧的相对位置测量标准差 <math id="M88"><mn mathvariant="normal">3</mn><mi>σ</mi><mo>=</mo><mo stretchy="false">(</mo><mn mathvariant="normal">0.958</mn><mtext> </mtext><mi mathvariant="normal">c</mi><mi mathvariant="normal">m</mi><mo>,</mo><mn mathvariant="normal">0.070</mn><mtext> </mtext><mi mathvariant="normal">c</mi><mi mathvariant="normal">m</mi><mo>,</mo><mn mathvariant="normal">0.082</mn><mtext> </mtext><mi mathvariant="normal">c</mi><mi mathvariant="normal">m</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227160&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227157&type= 56.38800049 3.55599999 ，相对角度测量标准差 <math id="M89"><mn mathvariant="normal">3</mn><mi>σ</mi><mo>=</mo><mo stretchy="false">(</mo><mn mathvariant="normal">0.223</mn><mo>°</mo><mo>,</mo><mn mathvariant="normal">0.174</mn><mo>°</mo><mo>,</mo><mn mathvariant="normal">0.409</mn><mo>°</mo><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227172&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227164&type= 44.02666855 3.55599999 ，算法测量的移动距离均值为4.005 cm，与控制台提供的移动速度4 cm每帧相差仅为0.05 mm，解算精度较高。 3.2　非合作目标模型姿态转动实验 2 实验过程中，双目相机系统在距模型4.0 m处静止，目标在机械臂的控制下以2.0°每帧的速度做匀速旋转，共采集68帧图像。该组工况下非合作目标的绝对位姿和相对位姿变化如 图9 图9 所示。 1,2;3,4; 从 图9 图9 可以看出，当目标在距双目相机系统4.0 m处旋转时，双目立体视觉算法解算位姿趋势与实际运动状态一致，只有滚动轴角度匀速下降。由于目标姿态的改变，双目相机获取的前后帧图像受光照影响较大，所以容易干扰提取的对接环椭圆参数，所以其相对位置波动较大，如在第47帧时，三轴的相对位置为（ - 3.057 cm，0.468 cm，0.016 cm），相对姿态为 <math id="M90"><mo stretchy="false">(</mo><mo>-</mo><mn mathvariant="normal">2.201</mn><mo>°</mo><mo>,</mo><mn mathvariant="normal">0.134</mn><mo>°</mo><mo>,</mo><mn mathvariant="normal">0.135</mn><mo>°</mo><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227237&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227233&type= 39.03133392 3.55599999 ， X 轴对应的相对姿态误差较大。通过分析对接环和边框角点检测结果，造成该帧相对姿态误差较大的原因是右图部分阴影参与了拟合，导致最终构建的环法向量和圆心坐标突变。后期将通过前后帧的相对位置关系和进一步改进优化环检测方案，降低光照对算法的影响。总体来看，由于目标距相机较近，目标姿态的变化在图像上的体现越显著，像素点移动距离越大，相对姿态精度较高。最终目标模型的三轴前后帧的相对位置测量标准差 <math id="M91"><mn mathvariant="normal">3</mn><mi>σ</mi><mo>=</mo><mo stretchy="false">(</mo><mn mathvariant="normal">1.232</mn><mtext> </mtext><mi mathvariant="normal">c</mi><mi mathvariant="normal">m</mi><mo>,</mo><mn mathvariant="normal">0.201</mn><mtext> </mtext><mi mathvariant="normal">c</mi><mi mathvariant="normal">m</mi><mo>,</mo><mn mathvariant="normal">0.143</mn><mtext> </mtext><mi mathvariant="normal">c</mi><mi mathvariant="normal">m</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227244&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227241&type= 55.71066666 3.55599999 ，相对角度测量标准差 <math id="M92"><mn mathvariant="normal">3</mn><mi>σ</mi><mo>=</mo><mo stretchy="false">(</mo><mn mathvariant="normal">0</mn><mo>.</mo><msup><mrow><mn mathvariant="normal">106</mn></mrow><mrow><mo>∘</mo></mrow></msup><mo>,</mo><mn mathvariant="normal">0</mn><mo>.</mo><msup><mrow><mn mathvariant="normal">874</mn></mrow><mrow><mo>∘</mo></mrow></msup><mo>,</mo><mn mathvariant="normal">0</mn><mo>.</mo><msup><mrow><mn mathvariant="normal">726</mn></mrow><mrow><mo>∘</mo></mrow></msup><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227252&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=10227247&type= 42.41799927 3.81000018 ，算法测量的转动角度均值为1.991°，与控制台提供的转动速度2°每帧仅相差0.009°，解算精度较高。 4 结　论 1 本文针对在轨服务中非合作航天器相对位姿测量的关键任务，提出了一种双目立体视觉方法。该方法通过两台大视场相机获取图像，连续识别图像中的对接环椭圆和矩形边框，并引入极线约束准则、对接环尺寸约束和光流法跟踪的方法，提高算法的提取精度和效率。然后利用立体视觉构建非合作目标的对接环平面和边框角点，建立目标坐标系，解算与世界坐标系之间的位姿信息。最后通过实验室的双目相机、非合作目标模型和导轨平台，进行双目相机系统由远及近逼近和目标姿态转动实验。在双目相机系统12~2 m的逼近实验中，算法的相对位置精度优于1.0 cm，相对姿态精度优于0.41°，测量的移动距离均值为与真实移动距离相差0.05 mm。当目标在距双目相机系统4.0 m处旋转时，算法的相对位置精度优于1.3 cm，相对姿态精度优于0.88°，测量的转动角度均值与真实转动角度相差为0.01°，解算精度较高。为了提升双目立体视觉测量方法的稳定性和适应性，后续要进行地面模拟实验，定量分析实验结果并优化和改进算法。 参考文献 ChappellBill . NASA： Debris From India's Anti-Satellite Test Raised Threat To Space Statio ［EB/OL］.［ 2019-04-02 ］. https：//www.npr.org/2019/04/02/709032198/nasa-debris-from-indias-anti-satellite-test-raised-threat-to-space-station.html https://www.npr.org/2019/04/02/709032198/nasa-debris-from-indias-anti-satellite-test-raised-threat-to-space-station.html . NASA： Debris From India's Anti-Satellite Test Raised Threat To Space Statio 宋清丽 ， 梁智鹏 ， 董雪 ， 等 . 长春站高重复频率空间碎片激光测距技术 ［J］. 光学 精密工程 ， 2016 ， 24 （ 10 s）： 175 - 182 . 长春站高重复频率空间碎片激光测距技术 SONG Q L ， LIANG ZH P ， DONG X ， et al . . High repetition rate laser ranging to space debris from Changchun Observatory ［J］. Opt. Precision Eng. ， 2016 ， 24 （ 10 s）： 175 - 182 . （in Chinese） . High repetition rate laser ranging to space debris from Changchun Observatory 李明 ， 龚自正 ， 刘国青 . 空间碎片监测移除前沿技术与系统发展 ［J］. 科学通报 ， 2018 ， 63 （ 25 ）： 2570 - 2591 . 空间碎片监测移除前沿技术与系统发展 LI M ， GONG Z ZH ， LIU G Q . Frontier technology and system development of space debris surveillance and active removal ［J］. Chinese Science Bulletin ， 2018 ， 63 （ 25 ）： 2570 - 2591 . （in Chinese） Frontier technology and system development of space debris surveillance and active removal 艾海平 ， 陈力 . 空间机器人捕获航天器操作的避撞柔顺无源神经网络H∞控制 ［J］. 光学 精密工程 ， 2020 ， 28 （ 3 ）： 717 - 726 . 空间机器人捕获航天器操作的避撞柔顺无源神经网络H∞控制 AI H P ， CHEN L . Passivity-based neural network H∞ avoidance compliant control of space robot capturing spacecraft ［J］. Opt. Precision Eng. ， 2020 ， 28 （ 3 ）： 717 - 726 . （in Chinese） Passivity-based neural network H∞ avoidance compliant control of space robot capturing spacecraft HU H D ， WANG D Y ， GAO H ， et al . . Vision-based position and pose determination of non-cooperative target for on-orbit servicing ［J］. Multimedia Tools and Applications ， 2020 ， 79 （ 21/22 ）： 14405 - 14418 . . Vision-based position and pose determination of non-cooperative target for on-orbit servicing StroutNathan . Space： DARPA wants a robotic satellite mechanic launched by 2022 ［EB/OL］. ［ 2019-03-03 ］. https：//www.c4isrnet.com/battlefield-tech/space/2019/10/03/darpa-wants-a-robotic-satellite-mechanic-launched-by-2022/.html https://www.c4isrnet.com/battlefield-tech/space/2019/10/03/darpa-wants-a-robotic-satellite-mechanic-launched-by-2022/.html . Space： DARPA wants a robotic satellite mechanic launched by 2022 ErwinSandra . DARPA's Satellite-Servicing Robot to Get Another Shot ［EB/OL］. ［ 2019-07-31 ］. https： //www.space.com/darpa-satellite-servicing-robot-another-shot.html https://www.space.com/darpa-satellite-servicing-robot-another-shot.html . DARPA's Satellite-Servicing Robot to Get Another Shot ESTABLE S ， PRUVOST C ， FERREIRA E ， et al . . Capturing and deorbiting Envisat with an Airbus Spacetug. Results from the ESA e.Deorbit consolidation phase study ［J］. Journal of Space Safety Engineering ， 2020 ， 7 （ 1 ）： 52 - 66 . . Capturing and deorbiting Envisat with an Airbus Spacetug. Results from the ESA e.Deorbit consolidation phase study 申麟 ， 陈蓉 ， 焉宁 ， 等 . 空间碎片主动移除技术研究综述 ［J］. 空间碎片研究 ， 2020 ， 20 （ 2 ）： 1 - 6 . 空间碎片主动移除技术研究综述 SHEN L ， CHEN R ， YAN N ， et al . . Review of active space debris removal research ［J］. Space Debris Research ， 2020 ， 20 （ 2 ）： 1 - 6 . （in Chinese） . Review of active space debris removal research 蔡晗 . 基于双目视觉的非合作目标相对测量实验研究 ［D］. 北京 ： 北京理工大学 ， 2015 . 基于双目视觉的非合作目标相对测量实验研究 CAI H . Experiment Research of Non-cooperative Space Target Relative Measurement Based on Binocular Vision ［D］. Beijing ： Beijing Institute of Technology ， 2015 . （in Chinese） Experiment Research of Non-cooperative Space Target Relative Measurement Based on Binocular Vision 杨宁 ， 申景诗 ， 张建德 ， 等 . 基于立体视觉的空间非合作航天器相对位姿自主测量 ［J］. 光学 精密工程 ， 2017 ， 25 （ 5 ）： 1331 - 1339 . 基于立体视觉的空间非合作航天器相对位姿自主测量 YANG N ， SHEN J SH ， ZHANG J D ， et al . . Autonomous measurement of relative attitude and position for spatial non-cooperative spacecraft based on stereo vision ［J］. Opt. Precision Eng. ， 2017 ， 25 （ 5 ）： 1331 - 1339 . （in Chinese） . Autonomous measurement of relative attitude and position for spatial non-cooperative spacecraft based on stereo vision 吴斌 ， 叶东 ， 张鑫 ， 等 . 非合作目标姿态测量的嵌入式算法 ［J］. 光学 精密工程 ， 2016 ， 24 （ 11 ）： 2804 - 2813 . 非合作目标姿态测量的嵌入式算法 WU B ， YE D ， ZHANG X ， et al . . Embedded algorithm for relative pose measurement between non-cooperative targets ［J］. Opt. Precision Eng. ， 2016 ， 24 （ 11 ）： 2804 - 2813 . （in Chinese） . Embedded algorithm for relative pose measurement between non-cooperative targets 李俊峰 . 双边滤波算法的快速实现及其在图像处理的应用 ［D］. 广州 ： 南方医科大学 ， 2013 . 双边滤波算法的快速实现及其在图像处理的应用 LI J F . Fast Implementation of Bilateral Filter with Application in Image Processing ［D］. Guangzhou ： Southern Medical University ， 2013 . （in Chinese） Fast Implementation of Bilateral Filter with Application in Image Processing 李赓飞 ， 李桂菊 ， 韩广良 ， 等 . 红外成像系统的非均匀性实时校正 ［J］. 光学 精密工程 ， 2016 ， 24 （ 11 ）： 2841 - 2847 . 红外成像系统的非均匀性实时校正 LI G F ， LI G J ， HAN G L ， et al . . Real-time non-uniformity correction of infrared imaging system ［J］. Opt. Precision Eng. ， 2016 ， 24 （ 11 ）： 2841 - 2847 . （in Chinese） . Real-time non-uniformity correction of infrared imaging system 李信一 . 单帧运动模糊图像盲复原问题的研究 ［D］. 南京 ： 南京航空航天大学 ， 2012 . 单帧运动模糊图像盲复原问题的研究 LI X Y . Research on Blind Motion Deblurring Based on Single Image ［D］. Nanjing ： Nanjing University of Aeronautics and Astronautics ， 2012 . （in Chinese） Research on Blind Motion Deblurring Based on Single Image 王大轶 ， 张磊 ， 朱卫红 ， 等 . 基于双目光学图像信息的空间非合作目标自主相对导航方法 ［J］. 中国科学： 物理学 力学 天文学 ， 2019 ， 49 （ 2 ）： 85 - 92 . 基于双目光学图像信息的空间非合作目标自主相对导航方法 WANG D Y ， ZHANG L ， ZHU W H ， et al . . Autonomous relative navigation for noncooperative target using stereo vision measurements ［J］. Scientia Sinica （Physica ， Mechanica & Astronomica） ， 2019 ， 49 （ 2 ）： 85 - 92 . （in Chinese） . Autonomous relative navigation for noncooperative target using stereo vision measurements GIOI R GVON ， JAKUBOWICZ J ， MOREL J M ， et al . . LSD： a line segment detector ［J］. Image Processing on Line ， 2012 ， 2 ： 35 - 55 . . LSD： a line segment detector LU C S ， XIA S Y ， SHAO M ， et al . . Arc-support line segments revisited： an efficient high-quality ellipse detection ［J］. IEEE Transactions on Image Processing ， 2020 ， 29 ： 768 - 781 . . Arc-support line segments revisited： an efficient high-quality ellipse detection HOUGH V ， PAUL C . Method and Means for Recognizing Complex Patterns： US， 069654 ［P/OL］. 1962-12-18 . Method and Means for Recognizing Complex Patterns： US， 069654 罗寰 ， 王芳 ， 陈中起 ， 等 . 基于对称差分和光流估计的红外弱小目标检测 ［J］. 光学学报 ， 2010 ， 30 （ 6 ）： 1715 - 1720 . 基于对称差分和光流估计的红外弱小目标检测 LUO H ， WANG F ， CHEN ZH Q ， et al . . Infrared target detecting based on symmetrical displaced frame difference and optical flow estimation ［J］. Acta Optica Sinica ， 2010 ， 30 （ 6 ）： 1715 - 1720 . （in Chinese） . Infrared target detecting based on symmetrical displaced frame difference and optical flow estimation ZHANG Z Y . Flexible camera calibration by viewing a plane from unknown orientations ［C］. Proceedings of the Seventh IEEE International Conference on Computer Vision. September 20 - 27 ， 1999， Kerkyra， Greece . IEEE ， 1999 ： 666 - 673 . Flexible camera calibration by viewing a plane from unknown orientations 10.37188/OPE.20212903.0493 TP391 V448.22 A 1004-924X（2021）03-0493-10 束安,裴浩东,周姗姗等.非合作航天器的立体视觉位姿测量[J].光学精密工程,2021,29(03):493-502. 束安,裴浩东,周姗姗等.非合作航天器的立体视觉位姿测量[J].光学精密工程,2021,29(03):493-502. SHU An,PEI Hao-dong,ZHOU Shan-shan,et al.Stereo measurement of position and attitude of non-cooperative spacecraft[J].Optics and Precision Engineering,2021,29(03):493-502. SHU An,PEI Hao-dong,ZHOU Shan-shan,et al.Stereo measurement of position and attitude of non-cooperative spacecraft[J].Optics and Precision Engineering,2021,29(03):493-502. 中国科学院上海技术物理研究所创新专项项目（No.CX-270） 2020-12-02 2020-12-29 2021-03-15 2021-04-08 光学精密工程 3 29