一种非合作航天器上太阳能帆板三角架结构的位姿自主测量方法
【专利摘要】本发明提出了一种非合作航天器上太阳能帆板三角架结构的位姿自主测量方法。该方法首先给出了基于滑动窗口Hough变化以及三角形内切圆的特征结构自主识别算法，得到三角架上特征点的图像坐标，再结合P4P算法以及已知的航天器尺寸与特征结构，计算出由旋转矩阵与平移矩阵表示的相对位姿。本发明适用于近距离交会阶段，对非合作航天器进行观测、跟踪、对接时的相对位姿测量。有益效果：本发明可自动完成太阳能帆板三角架部件的特征提取及位姿解算，整个过程中无需人工干预，也无需在目标上安置标识器，实时性和自主性高，克服了远程控制下测量结果受传输时延、传输可靠性的影响大，系统不稳定等缺点。
【专利说明】一种非合作航天器上太阳能帆板三角架结构的位姿自主测 量方法
【技术领域】
[0001] 本发明涉及一种非合作航天器上太阳能帆板三角架结构的位姿自主测量方法，属 于航天器在轨服务【技术领域】。
【背景技术】
[0002] 随着太空活动日益频繁，由于发射失误或通信天线展开失败产生的失效或废弃卫 星越来越多，这些失效卫星不仅造成了巨大的经济损失，还占用了宝贵的轨道资源，给其他 卫星的运行造成威胁。为了尽可能的挽回损失或净化轨道环境，以卫星维修、生命延长及太 空垃圾清除为目的在轨服务技术越来越受重视（崔乃刚，王平，郭继峰，等.空间在轨服务 技术发展综述[J].宇航学报.2007, 28 (4) : 33-39)。在轨服务过程中，通常需要先测得目标 航天器的位置与姿态信息，这些航天器大多和地面控制端失去了信息交流，运动状态未知， 且机构上没有安装用于辅助测量的合作标志器和特征块，称为非合作目标。对于此类目标 位姿的测量，只能利用目标上的自然特征，其测量误差与难度都远远比合作目标的位姿测 量要大。
[0003] 针对非合作航天器上不同部件的位姿测量方法，各国都开展了大量的研究。文献 (Inaba N, Oda M, Asano M. Rescuing a stranded Satellite in Space-experimental robotic capture of non-cooperative Satellites[J]. Transactions of the Japan Society for Aero-nautical and Space Sciences. 2006, 48 (162) : 213-220.)提出一种 针对航天器的星箭对接环部件进行位姿测量的方法，该方法事先假定目标航天器外形、 尺寸及质量等都已知。文献（徐文福，梁斌，李成.基于立体视觉的航天器相对位姿 测量方法与仿真研究[J].宇航学报，2009,30(4):1-8.)以太阳能帆板三角架为识别目 标，提出将非合作航天器图像下传到地面，利用人机交互的方式为追踪航天器提供人工 合作信息完成特征提取与位姿解算。文献（Du X D, Liang B，et al. Pose measurement of large non-cooperative satellite based on collaborative cameras. Acta Astronautica, 2011，68(11) :2047-2065.)也是通过人机交互的方式，选取太阳能帆板矩 形框架为目标对象，利用双目相机对较大的非合作航天器进行位姿测量。
[0004] 综上所述，目前虽然对于航天器相对位姿测量的整体研究很多，但专门针对航天 器特征识别的研究较少。现有为数不多的特征识别也大多采用人机交互的方法，通过将远 程拍摄到的图片下传到地面主控端，通过人工手动选取目标参考点，实现特征结构的实时 定位与跟踪，这种方法受到传输时延、传输可靠性的影响较大，系统将不稳定，而且由于需 要地面人员的直接参与，其自主性和实时性不高。大多需要人的远程操控，其自主性和实时 性不高，且测量结果受传输时延、传输可靠性的影响大，系统不稳定。因此，提出一种非合作 航天器上太阳能帆板三角架结构的位姿自主测量方法，以获取近距离交会阶段非合作航天 器的相对位姿，是非常必要和迫切的。
【发明内容】
[0005] 本发明为解决现有非合作航天器位姿测量的自主性和实时性差、系统不稳定以及 传输时延大等问题，进而提供了一种非合作航天器上太阳能帆板三角架结构的位姿自主测 量方法，主要步骤包括基于单目视觉的图像预处理、基于滑动Hough变化以及三角形内切 圆特性的特征结构自主识别、以及基于P4P算法的相对位姿测量。该方法无需人工干预，也 无需在目标上安置标识器，而是以航天器自身的典型部件作--太阳能帆板三角支架作为 识别对象，实现非合作航天器与摄像机相对位姿的自主测量。
[0006] 技术方案
[0007] 为解决上述问题，一种非合作航天器上太阳能帆板三角架结构的位姿自主测量方 法所采用的技术方案是：
[0008] 步骤1 :摄像机拍摄图片，对原图像进行滤波、二值化，Canny算法提取边缘等预处 理；
[0009] 步骤2 :采用基于滑动窗口 Hough变化以及三角形内切圆的特征结构自主识别算 法，得到三角架上特征点的图像坐标；：
[0010] 步骤3 :结合P4P算法以及已知的航天器尺寸与特征结构，计算出由旋转矩阵与平 移矩阵表示的相对位姿；
[0011] 步骤4 :将估测的姿态信息转换成旋转角与平移距离的表示方式，与激光跟踪仪 测量的准确值作对比，分析误差原因。
[0012] 有益效果
[0013] 与现有技术相比，本发明的有益效果是无需添加任何辅助测量工具，直接选取非 合作航天器上的典型部件一太阳能帆板三角架为对象进行目标位姿的自主测量，且不需要 将太空中拍摄到的图像下传到地面由人工选取图像参考点，避免了图像远程传输过程中产 生的时延和系统不稳定。
【专利附图】
【附图说明】
[0014] 图1为Hough算法下将图像空间上的直线映射到P - Θ参数空间的示意图；
[0015] 图2为三角形及其内切圆关系的原理图；
[0016] 图3为中心透视投影成像模型图；
[0017] 图4为相对位姿测量实验示意图；
[0018] 图5为三角形检测结果图；
【具体实施方式】
[0019] 一种非合作航天器上太阳能帆板三角架结构的位姿自主测量方法，图像处理步 骤：
[0020] (1)采用Canny算子提取图像边缘：用高斯滤波器平滑图像，再用一阶偏导的有限 差分来计算梯度的幅值和方向，接着对梯度幅值进行非极大值抑制，最后用双阈值算法检 测和连接边缘；
[0021] (2)进行均值滤波，降低像素的噪声；
[0022] (3)图像二值化：即灰度分划，指设定一个灰度值，凡是图像本身灰度大于它的便 令其为亮点而灰度值低于设定值的，便令其为暗点，如此获得一个二元的图像。
[0023] -种非合作航天器上太阳能帆板三角架结构的位姿自主测量方法，基于滑动 Hough变化的三角形检测的具体实施方案是：
[0024] 利用点一线的对偶性，即采用参数方程P = XC〇s( Θ )+ysin( Θ )将图像平面上的 一个点就对应到参数平面上的一条曲线上，其中P是从原点引到直线的垂线长度，Θ是垂 线与X轴正向的夹角。原始坐标系下呈现直线的所有点，它们的斜率和截距是相同的，这个 特点表现在参数坐标系下即所有曲线聚集于同一个点（θ。， Ρ(ι)，参见图1。由三角形内切 圆特性：内切圆圆心到三边距离相等，选取一小窗口在图像上滑动，指定窗口中心为坐标原 点，对窗口内图像进行Hough变化，当窗口滑动到坐标系原点正好与三角形内切圆圆心重 合时，三角形在对应的Hough参数空间内会有三个峰值点，且这三个峰值点的P坐标绝对 值相等（参见图2)，由此可确定三角形顶点和内心的图像坐标。具体实现步骤如下 ：
[0025] (1)对图像进行预处理，提取特征并计算其梯度方向；
[0026] (2)将（θ，p )参数平面量化，设置二维累计矩阵Η( Θ i，p p ;
[0027] (3)边缘细化，即在边缘点的梯度方向上保留极值点，剔除那些非极值点；
[0028] (4)对每一边缘点，以其梯度方向Ψ为中心，设置一小区间[Ψ-Θ。，ψ+Θ。]，其中 Θ。为经验，一般可取5°?10°，在此小区间上以Λ Θ为步长，对每一个区间中的Θ量化 值计算相应的Ρ值，并给相应的累计矩阵元素增加一个单位值；
[0029] (5)对累计矩阵进行阈值检测，将大于阈值的点作为备选点；
[0030] (6)取累计矩阵（即参数空间）中备选点中的极大值点为所需的峰值点，这些点所 对应的参数空间的坐标即所检测直线的参数。
[0031] (7)判断上一步检测到的直线段集合中是否有三条线段的长度及角度满足以下条 件（由于数字图像中的直线段不能精确满足其数学定义，需要设置阈值，以下条件表达式 中八即为设定的阈值）：
[0032]
【权利要求】
1. 一种非合作航天器上太阳能帆板三角架结构的位姿自主测量方法，其特征在于包括 如下步骤： (1) 基于单目视觉的图像预处理：根据摄像机采集到的图像，进行实时处理，包括平滑 滤波、边沿检测、二值化处理等； (2) 基于滑动窗口 Hough变化以及三角形内切圆的特征结构自主识别：用滑动窗口遍 历原图像，对窗口内的图片进行Hough变化与判定，找到满足三角形特征的顶点坐标； (3) 基于P4P算法的相对位姿解算：结合已知的航天器尺寸以及检测出的三角形上四 个共面特征点的图像坐标，计算出由旋转矩阵与平移矩阵表示的相对位姿，并与激光跟踪 仪测量的准确值对比。
2. 根据权利要求1所述的图像预处理过程，其特征在于： 采用自适应Canny边缘检测算法来克服传统的Canny算法噪声抑制与边缘的定位性 能相冲突、对阈值设定不灵活、不能自动根据图像特征确定阈值、算法的自主能力较差等缺 点，通过某种计算方法自动确定阈值和高斯空间系数，能够根据不同的图像特性自适应的 进行边缘检测。
3. 根据权利要求1所述的基于滑动Hough变化的三角形特征检测的算法，其特征在 于： 利用三角形内切圆心到三边距离相等这一特性。选择一个窗口在图像中滑动，以该窗 口的中心作为直角坐标系的原点对窗口内的图像作Hough变换。当滑动到坐标系原点正好 与三角形内切圆圆心重合时，三角形在对应的Hough参数空间内会有三个峰值点，这三个 峰值点的P坐标绝对值相等，Θ值不同。由此确定三角形顶点和内心的图像坐标。
4. 根据权利要求1所述的基于P4P算法的非合作航天器位姿解算，其特征在于： 当已知目标结构上任一共面四点的图像坐标（Ui，Vi)和对应的空间坐标（X- y<)i，zj 时，依据摄像机成像模型：
可唯一确定摄像机坐标 系到目标航天器坐标系之间的位姿转换关系
【文档编号】G01C21/24GK104154919SQ201410398179
【公开日】2014年11月19日 申请日期:2014年8月13日 优先权日:2014年8月13日
【发明者】宋荆洲, 曹彩秀, 孙汉旭, 贾庆轩 申请人:北京邮电大学