专利名称：一种自主在轨服务航天器超近距离视觉位姿测量方法
技术领域：
本发明涉及一种自主在轨服务航天器超近距离视觉位姿测量方法，特别涉及一种用于自主在轨服务航天器的超近距离基于散焦图像的位姿测量方法，属于航天器相对视觉测量与自主导航领域。
背景技术：
近年来，以卫星在轨对接与组装、维修与燃料加注等航天器自主任务的研究受到广泛关注。在该类型的航天器自主任务的执行过程中，追踪航天器需要对目标航天器的位置与姿态信息进行实时的测量。由于两个航天器之间的相对距离很近，采用的传感器通常为相机和激光测距雷达(LIDAR)。激光测距雷达虽然可以较好地获取目标距离信息，但是造价极其昂贵，并且测量过程中会消耗大量能量，增加航天器负担。视觉测量系统采用相机作为传感器，通过对目标卫星上某些已知特征点成像，采用对应的相关算法从而求出目标航天器与追踪航天器之间的相对位置和相对姿态信息。近些年很多学者围绕航天器交会对接为背景，对航天器相对视觉测量经行了大量研究，提出了不同的算法。曹喜滨等研究了航天器交会对接位姿视觉测量迭代算法(曹喜滨，张世杰.航天器交会对接位姿视觉测量迭代算法[J].哈尔滨工业大学学报.2005，37 (O08):1123-1126.2005, 37 (008): 1123-1126);朱仁璋等就交会对接逼近断，研究了一种视觉系统测距求解算法(朱仁璋，林彦，张磊.航天器交会计算机视觉系统测距求解新算法[J].北京航空航天大学学报.2006，32(7):764-768.2006，32(7):764-768);冯春等研究了一种基于双焦距的航天器相对位姿测量算法(冯春，吴洪涛，乔兵，等.基于双焦单目视觉的航天器间相对位姿确定算法[J].中国空间科学技术.2012 (4): 37-44)。以上研究大都重点关注航天器交会对接的逼近段(距离从2m至20m左右)，航天器本身相对姿态变化不大，主要是位置变化为主。而对于自主在轨服务 器而言，追踪航天器与目标航天器之间的距离通常会更小(小于2m)，此时在轨服务航天器在进行在轨操作过程中，相对距离相对稳定，反而相对姿态可能发生较大变化。而对于此类情形下的位姿测量问题，相关研究还比较少。此外，以上研究在建模过程中为了简化求解过程，常忽略特征点之间的深度差来简化透视投影方程，这样使得在超近距离时让测量误差增大。本发明在建模过程精细化数学模型，提高位姿测量的精度。于此同时，光学系统在距离拍摄目标很近时具有景深浅的特点，相机所获取的图像容易因聚焦不当而发生散焦模糊。这种图像的模糊可能会对视觉测量系统的精度产生不良的影响。实际上，由光学原理可以得知，图像的模糊程度(通常定义扩散参数σ h来表示散焦图像的模糊程度)与目标的物距u (即镜头到目标物体的距离)在相机内部参数(包括相机焦距f，镜头光圈口径D，镜头与相机成像面的距离s)固定时是线性相关的。根据这一原理，利用图像散焦模糊信息可以求解相机拍摄目标的物距U，一般也称u为目标的深度信息。基于这种原理的测距方法称为散焦测距(英文缩写DFD，DepthFrom Defocus)。散焦测距理论最早由 Pentland 提出(Pentland A P.A New Sense forDepth of Field[J].Pattern Analysis and Machine Intelligence, IEEE Transactionson, 1987，PAM1-9 (4):523_531)。DFD算法通过20年不断的发展，不同的学者提出了许多不同的算法。Subbarao M等提出了一种基于S变换的散焦测距算法(Subbarao M, SuryaG.Depth from defocus:a spatial domain approach[J].1nternational Journal ofComputer Vision, 1994, 13 (3): 271_294);Xian T等基于 Subbarao M 的 S变换理论进行了相关测距算法的进一步研究(Xian T, Subbarao M.Depth-from-defocus:blur equalizationtechnique: Optics East2006, 2006 [C].1nternational Society for Optics andPhotonics)。上述研究中散焦测距需要相机在不同的相机参数(常见改变光圈大小D或者镜头到相机成像面的距离s)下获取两幅模糊程度不一样的图像，通过对比模糊程度的差异最终求解目标深度信息。如果再用常规的测量相机，需要在测量过程中改变相机的参数，这样会大大降低测量的实时性。本发明采用一种单镜头双CCD的相机，实现了相机同时采集两幅相机参数(镜头到相机成像面的距离s)不一样的散焦图像，提高了测量系统的实时性。

发明内容
本发明要解决的技术问题是提高超近距离测量时的精度、降低测量成本，公开一种自主在轨服务航天器超近距离视觉位姿测量方法。本发明的目的是通过下述技术方案实现的。本发明采用一种特制的相机作为测量用相机，所述特制的相机包括一个镜头、两个CCD ;镜头采用远心光学镜头，即将镜头的光圈叶片放置于镜头的前向焦平面处，这样使得光线通过镜头后能平行于光轴。这样当镜头与CCD的距离改变时，特征点目标成像的中心点不会随之发生偏移。为了能同时在不同镜头与CCD距离时采集两幅图像，使用一块半反半透镜放置于镜头后方，从镜头过来的光线被该透镜平均分成两个方向，两个方向的光线分别投射在CXDl成像面与(XD2成像面上。两块CXD距镜头的距离略有不同，镜头到CXDl成像面的距离记为S1,镜头到(XD2成像面的距离记为S2,且S2 > S:。

本发明的一种自主在轨服务航天器超近距离视觉位姿测量方法，包括如下步骤:步骤一，通过相机同步采集两幅模糊程度不同的散焦图像，图像I与图像2，其中图像I为相机CXDl所成的像，图像2为相机(XD2所成的像。步骤二，采用基于S变换的DFD算法对目标进行散焦测距，获取目标图像每个像素点的整体深度信息U。步骤三，图像处理提取特征点图像坐标值，结合图像坐标信息最终获取目标的位置姿态信息。所述步骤三的图像处理提取特征点图像坐标值的方法，具体步骤如下:利用特征点光斑所成的像与黑色背景之间的亮度差异提取出特征点光斑区域，通过计算区域重心计算每个特征点图像坐标(UpVi), (i = I 5)。所述步骤三获取目标的位置姿态信息的方法，具体步骤如下:步骤1、首先定义基本坐标系特征点构型。共建立三个坐标系，分别是以相机为中心的相机坐标系OcXcYcZc,以目标特征构型为中心的目标坐标系OtXtYtZt,以及图像坐标系O1U1Vp在目标航天器上设定五个特征点S1, S2, S3, s4, S5作为测量参考点。步骤2、求相对位置参数；
由已经计算出的每个特征点图像坐标(Ui, Vi), (i = I 5)在步骤二的深度信息结果中查找对应的特征点的深度信息Ui, (i = I 5)。通过相机的几何关系方程(I)求出
各个特征点在相机坐标系中y轴的分量X1 = I ~ 5) οj/J =Ii,+Jt-/,(I = I 5)(I)由特征点S1与特征点S3在相机坐标系中y轴分量);丨,}!1与其对应的图像坐标(U11V1), (U3, V3)即可求出两航天器相对位置t= [tx，ty，tz]T。具体表达式见公式(2)如下。Ij, =(,f+义:)/2Ix = (f/, +f/;)/,./(2/) = (f/, +/3XX +)9/(4/)(2)4 = (K + K>VZ(2/)-{Vx + )(yι 十yl)/(4/)tx, ty, tz三个参数即为3个相对位置参数，表示目标航天器坐标系中心与相机坐标系中心的相对位直关系。步骤3、求解相对姿态参数；由已经计算出的每个特征点图像坐标(Ui, Vi), (i = I 5)与步骤3中获取的各个特征点在相机坐标系中的I轴分量^, (/ = I 5)根据透视投影方程(方程(3))求解出各
个特征点在相机坐标系中的坐标S, ==1-5).Vj U = I' /1m
权利要求
1.一种自主在轨服务航天器超近距离视觉位姿测量方法，其特征在于:具体步骤如下: 步骤一，通过特制的相机同步采集两幅模糊程度不同的散焦图像，图像I与图像2，其中图像I为相机CXDl所成的像，图像2为相机(XD2所成的像； 步骤二，采用基于S变换的DFD算法对目标进行散焦测距，获取目标图像每个像素点的整体深度信息u ； 步骤三，图像处理提取特征点图像坐标值，结合图像坐标信息最终获取目标的位置姿态息。
2.如权利要求1所述的一种自主在轨服务航天器超近距离视觉位姿测量方法，其特征在于:所述特制的相机包括一个镜头、两个CCD ;镜头采用远心光学镜头，即将镜头的光圈叶片放置于镜头的前向焦平面处，这样使得光线通过镜头后能平行于光轴；这样当镜头与CCD的距离改变时，特征点目标成像的中心点不会随之发生偏移；为了能同时在不同镜头与CCD距离时采集两幅图像，使用一块半反半透镜放置于镜头后方，从镜头过来的光线被该透镜平均分成两个方向，两个方向的光线分别投射在CCDl成像面与CCD2成像面上；两块CXD距镜头的距离略有不同，镜头到CXDl成像面的距离记为S1，镜头到(XD2成像面的距离记为S2,且S2 > Si。
3.如权利要求1所述的一种自主在轨服务航天器超近距离视觉位姿测量方法，其特征在于:所述步骤三的图像处理提取特征点图像坐标值的方法，具体步骤如下: 利用特征点光斑所成的像与黑色背景之间的亮度差异提取出特征点光斑区域，通过计算区域重心计算每个特征点图像坐标(UpVi), (i = I 5)。
4.如权利要求1所述的一种自主在轨服务航天器超近距离视觉位姿测量方法，其特征在于:所述步骤三获取目标的位置姿态信息的方法，具体步骤如下: 步骤1、首先定义基本坐标系特征点构型；共建立三个坐标系，分别是以相机为中心的相机坐标系OcXcYcZc,以目标特征构型为中心的目标坐标系OtXtYtZt,以及图像坐标系O1U1V1 ；在目标航天器上设定五个特征点S1, S2, S3, S4, S5作为测量参考点； 步骤2、求相对位置参数； 由已经计算出的每个特征点图像坐标(Ui, Vi), (i = I 5)在步骤二的深度信息结果中查找对应的特征点的深度信息Ui，(i = I 5);通过相机的几何关系方程(I)求出各个特征点在相机坐标系中I轴的分量火,(i = I ~ 5);=(I) 由特征点S1与特征点S3在相机坐标系中y轴分量}’i ,)4与其对应的图像坐标(U11V1), (U3, V3)即可求出两航天器相对位置t = [tx，ty，tz]T;具体表达式见公式(2)如下；ty = (}>1 +) / 2 tx = Hh + i (2/) = (U1 + (Z3XX' + VD / (4/)(2) C + V3K / (2/) = (Vt + + v_01 (4/) tx, ty, tz三个参数即为3个相对位置参数，表示目标航天器坐标系中心与相机坐标系中心的相对位置关系； 步骤3、求解相对姿态参数；由已经计算出的每个特征点图像坐标(Ui, Vi), (i = 1 5)与步骤3中获取的各个特征点在相机坐标系中的y轴分量.V:，(/.......1 -5)根据透视投影方程(方程(3))求解出各个特征点在相机坐标系中的坐标
全文摘要
本发明涉及一种自主在轨服务航天器超近距离视觉位姿测量方法,特别涉及一种用于自主在轨服务航天器的超近距离基于散焦图像的位姿测量方法，属于航天器相对视觉测量与自主导航领域。通过相机同步采集两幅模糊程度不同的散焦图像，图像1与图像2，其中图像1为相机CCD1所成的像，图像2为相机CCD2所成的像。采用基于S变换的DFD算法对目标进行散焦测距，获取目标图像每个像素点的整体深度信息u。图像处理提取特征点图像坐标值，结合图像坐标信息最终获取目标的位置姿态信息。本发明采用单镜头双CCD相机同时获取两幅图像用于散焦测距，能同时采集两幅相机参数不同的散焦图像。测量过程中无需改变相机参数，提高测量系统实时性。
文档编号G01C11/02GK103245335SQ20131018912
公开日2013年8月14日 申请日期2013年5月21日 优先权日2013年5月21日
发明者张景瑞, 胡星, 翟光, 张尧, 蔡晗 申请人:北京理工大学