CN102706329A - 一种用于交会对接的ccd测量方法 - Google Patents
一种用于交会对接的ccd测量方法 Download PDFInfo
- Publication number
- CN102706329A CN102706329A CN2012101754115A CN201210175411A CN102706329A CN 102706329 A CN102706329 A CN 102706329A CN 2012101754115 A CN2012101754115 A CN 2012101754115A CN 201210175411 A CN201210175411 A CN 201210175411A CN 102706329 A CN102706329 A CN 102706329A
- Authority
- CN
- China
- Prior art keywords
- docking port
- trail
- following
- prime
- respect
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种用于交会对接的CCD测量方法,利用两台CCD照相机对目标飞行器上的标记灯进行成像,进而确定标记灯的位置,通过目标飞行器标记灯和对接口的相对位置关系确定追踪飞行器对接口和目标飞行器对接口的相对位置、相对姿态和相对速度。本发明公开的方法思路巧妙,运算简单,能够对两台CCD照相机的测量结果快速响应,而无需经过复杂的大量计算,因而能够提高追踪飞行器对接口和目标飞行器对接口的交会对接的精确性和实时性。
Description
技术领域
本发明涉及交会对接技术,具体涉及一种用于交会对接的CCD测量方法。
背景技术
在交会对接过程中,在追踪飞行器与目标飞行器的最终逼近阶段,需精确控制两个飞行器之间的相对位置、相对姿态和相对速度,以达到精确的对接要求,获得柔性对接条件,从而使交会对接过程中的碰撞冲击力最小化。计算机视觉***是通过图形成像方式实现对目标的跟踪测量,其利用安装在追踪飞行器上的CCD照相机跟踪安装在目标飞行器上的一组标记,并将标记成像在CCD照相机上,基于在图像坐标系下的位置以及光学成像原理和几何约束条件,建立图像坐标与目标的位置、姿态之间的关系,从而提供离散的位置、姿态估计值,供交会对接使用。然而,现有的计算机视觉***尽管可用于交会对接中两飞行器的相对位置、相对姿态和相对速度的测量,实现两飞行器的交会对接,但是,它必须采用两台摄像机同时拍摄视场图像,并对两幅图像进行配准,且图像配准过程需进行相当复杂的计算,在测量的实时性和精确性方面难于同时保证。
发明内容
鉴于此,本发明提供了一种用于交会对接的CCD测量方法,能够在保证精确性的前提下,实时地确定两飞行器的相对位置、相对姿态和相对速度。
本发明的用于交会对接的CCD测量方法包括,
有益效果:
本发明公开了一种用于交会对接的CCD测量方法,利用CCD照相机将目标飞行器的标记点记录并定位在坐标系中,当推广到三个标记点的情形时,通过建立测量坐标系、像平面坐标系和CCD坐标系导出了目标飞行器在测量坐标系中的位置坐标、姿态矩阵和三个姿态角,从而确定目标飞行器和追踪飞行器的相对位置、相对姿态和相对速度,为两者的交会对接提供了精确的数据。与现有的利用计算机视觉***进行交会对接的技术相比,本发明的方法实现过程简单,运算量小,响应速度快,适合应用于对精确性和实时性均要求较高的交会对接场合。
附图说明
图1为目标飞行器上的对接口和标记灯的位置示意图。
图2为追踪飞行器上的对接口和CCD照相机的位置示意图。
具体实施方式
下面结合附图并举实施例,对本发明的用于交会对接的CCD测量方法进行详细描述。
1、建立双CCD测量***
图1所示为目标飞行器上的对接口和标记灯的位置,位于等腰三角形三个顶点处的圆表示用于指示交会对接的标记灯,等腰三角形内的大圆表示目标飞行器的对接口,三个标记灯所在的平面与对接口表面平行。由于三个标记灯不构成等边三角形,因此三个标记灯的相对位置可唯一地确定目标飞行器的对接口的姿态(即目标飞行器对接口相对于追踪飞行器对接口的滚动角、俯仰角和方位角)。图1中以大圆上面的十字线标识目标飞行器对接口的姿态,十字线的交点与大圆的圆心重合。
为了使追踪飞行器实现与如图1所示的目标飞行器交会对接的目的,本发明建立了一种双CCD测量***,其含有两台CCD照相机,图2所示为追踪飞行器的对接口和两台CCD照相机的位置,本发明采用双针孔形CCD照相机成像,针孔形CCD照相机刚性安装在追踪飞行器上,以矩形框表示。两台CCD照相机(CCD1和CCD2)中间的大圆表示追踪飞行器的对接口,其上的十字线的交点与大圆的圆心重合,CCD1和CCD2所在的平面与对接口表面平行,CCD1和CCD2的中心均位于十字线所在平面内,且水平像素线与十字线的横线平行。
基于所述双CCD测量***,构造以下坐标系:
以追踪飞行器对接口上的十字线构造一坐标系,十字线的横线和纵线分别为x轴和y轴,z轴与x轴和y轴构成右手系,将其称为“测量坐标系”。
在CCD照相机的像平面上构造一坐标系,与水平像素线和垂直像素线平行的直线作为此坐标系的x轴和y轴,像平面的中点为此坐标系的原点,将其称为“像平面坐标系”。本发明含有两台CCD照相机,因此有两个像平面坐标系。
以CCD照相机的焦点为原点构造一坐标系,与水平像素线和垂直像素线平行的直线作为此坐标系的x轴和y轴,z轴与x轴和y轴构成右手系,如此的坐标系称为“CCD坐标系”。本发明含有两台CCD照相机,因此有两个CCD坐标系。$
2、确定目标飞行器对接口的位置
根据CCD照相机的成像原理,由某一点在CCD照相机中的图像可得到CCD照相机像平面的中点到该点的直线方程;根据小孔成像原理,以目标飞行器上任一点A为例,若经测量得到点A在像平面坐标系中的坐标为(m,n),且在CCD坐标系中的坐标为(x,y,z),则有:
在图2实施例中,含有两台CCD照相机,经测量得到的目标飞行器上任一点B在两个像平面坐标系中的坐标分别为(m1,n1)和(m1′,n1′),则两个像平面坐标系的原点与点B的连线的方向向量分别为(m1l,n1l,f)和(m1′l,n1′l,f);又CCD1和CCD2到测量坐标系原点的距离均为d,因此在测量坐标系中CCD1和CCD2的坐标分别为(-d,0,0)和(d,0,0)。因此,在测量坐标系中,CCD1的像平面坐标系的原点到点B的连线的方程为CCD2的像平面坐标系的原点到点B的连线的方程为由上两式可构成以下方程组:
解该方程组可得到点B在测量坐标系中的位置坐标,为:
式(2)为目标飞行器上任一点B在测量坐标系中的位置坐标(x,y,z)。
将上述确定点B的位置坐标的过程推广到三个点的情况,以图1中的三个标记灯(即D1、D2和D3)为目标点,它们在两个像平面坐标系中的坐标为(mi,ni)和(mi′,ni′),(i=1,2,3),则根据式(2)容易得到D1、D2和D3在测量坐标系中的位置坐标为:
至此,经双CCD测量***的测量及运算,图1所示的目标飞行器上的三个标记灯D1、D2和D3的位置为已知。根据三个标记灯D1、D2和D3与目标飞行器对接口的相对位置关系能够得到该对接口的具***置。以以下相对位置为例,确定目标飞行器对接口的位置坐标:目标飞行器对接口的中心位于三个标记灯构成的等腰三角形的高线上,且对接口的中心与等腰三角形的底边的距离为三角形的高的三分之一。
首先,由标记灯D1和D2的位置坐标容易得到D1和D2的连线的中点P的位置坐标,为:
由于目标飞行器对接口的中心与等腰三角形的底边的距离为三角形的高的三分之一,即对接口的中心位于点P至D3的连线的三分之一处,所以该对接口中心的位置坐标(x0,y0,z0)为:
将式(3)和(4)代入式(5)得到:
式(6)确定了目标飞行器对接口的中心在测量坐标系中的位置坐标(x0,y0,z0)。
3、确定目标飞行器对接口的姿态
为了实现追踪飞行器对接口和目标飞行器对接口的交会对接,除了需要确定目标飞行器对接口在测量坐标系中的位置,还需确定目标飞行器对接口在测量坐标系中的姿态,即确定目标飞行器对接口相对于追踪飞行器对接口的滚动角、俯仰角和方位角(分别记为θ和ψ)。
以目标飞行器的三个标记灯D1、D2和D3的相对位置确定目标飞行器对接口在测量坐标系中的姿态。具体地,由标记灯D1、D2和D3的相对位置可得到以下向量:
其中,D1(x1,y1,z1)、D2(x2,y2,z2)和D3(x3,y3,z3)已利用式(3)得到,因此所述V1、V2和V3的坐标值是唯一确定的,于是V1、V2和V3分别代表测量坐标系中的一个方向向量,各自的坐标值可构成一个一行三列矩阵,如:V1=(a11 a21 a31),V2=(a12 a22 a32),V3=(a13 a23 a33),其中矩阵中的每个量为由上述计算得到的具体坐标值。
要实现目标飞行器和追踪飞行器的姿态调整,也就是要实现将追踪飞行器对接口绕当前的测量坐标系的x轴、y轴和z轴分别旋转角度θ和ψ之后,新的测量坐标系的x轴、y轴和z轴分别与目标飞行器的V1、V2和V3平行,基于该平行关系可得到角度θ和ψ的值。按此思路,进行以下步骤:
以欧拉角表示的目标飞行器的姿态矩阵为:
于是有:
θ=Arc sin(-a13)
利用上述方法,以采用1024×570像素的两台CCD照相机为例,d=1000(mm),f=60(mm),l=0.05(mm),测量得到三个标记灯D1、D2和D3在两个像平面坐标系中的坐标分别为:
(m1,n1)=(0,-60),(m1',n1')=(-240,-60),
(m2,n2)=(240,-60),(m2',n2')=(0,60),
(m3,n3)=(120,120),(m3',n3')=(-120,120),
则可利用式(3)得到在测量坐标系中的D1、D2和D3的坐标分别为:
(x1,y1,z1)=(-1000,-500,10000),
(x2,y2,z2)=(1000,-500,10000),
(x3,y3,z3)=(0,1000,10000),
由D1、D2和D3的相对位置得到:
V1=(1 0 0),
V2=(0 1 0),
V3=(0 0 1),
于是:
除此之外,目标飞行器和追踪飞行器的相对速度可通过两者的相对位置计算得到,即相邻两时刻的位置之差除以间隔的时间就是相对速度。
由于本发明的方法思路巧妙,运算简单,可对双CCD测量***的测量结果进行快速响应,因此本发明能够实时地确定目标飞行器对接口和追踪飞行器对接口的相对位置、相对姿态和相对速度,确保追踪飞行器对接口和目标飞行器对接口的交会对接的精确性和实时性。
综上所述,以上仅为本发明的较佳实施例,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种用于交会对接的CCD测量方法,其特征在于,包括:
步骤1,建立双CCD测量***,其中两台CCD照相机等距离安装于追踪对接口的两侧;
步骤2,确定目标对接口相对于追踪对接口的位置,包括;
①基于双CCD测量***的测量结果,确定用于指示交会对接的三个标记灯相对于追踪对接口的位置;其中,以所述三个标记灯为顶点的三角形为等腰三角形,且目标对接口位于所述等腰三角形的高线上;以及
②根据所述三个标记灯相对于追踪对接口的位置以及目标对接口与所述三个标记灯的相对位置,确定目标对接口相对于追踪对接口的位置;
步骤3,确定目标对接口相对于追踪对接口的姿态;
步骤4,根据两不同时刻下的目标对接口相对于追踪对接口的位置之差以及所述两不同时刻之间的时间间隔确定目标对接口相对于追踪对接口的运动速度;以及
步骤5,基于所述目标对接口相对于追踪对接口的位置、所述目标对接口相对于追踪对接口的姿态和所述目标对接口相对于追踪对接口的运动速度,进行目标对接口和追踪对接口的交会对接。
2.如权利要求1所述的方法,其特征在于,所述步骤3的确定目标对接口相对于追踪对接口的姿态即确定目标对接口相对于追踪对接口的滚动角俯仰角θ和方位角ψ,包括:
①计算向量V1、V2和V3:
其中(x1,y1,z1)、(x2,y2,z2)和(x3,y3,z3)分别为所述三个标记灯相对于追踪对接口的位置的坐标,且位于(x3,y3,z3)处的标记灯代表所述等腰三角形的顶点;以及
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101754115A CN102706329A (zh) | 2012-05-31 | 2012-05-31 | 一种用于交会对接的ccd测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101754115A CN102706329A (zh) | 2012-05-31 | 2012-05-31 | 一种用于交会对接的ccd测量方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102706329A true CN102706329A (zh) | 2012-10-03 |
Family
ID=46899281
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012101754115A Pending CN102706329A (zh) | 2012-05-31 | 2012-05-31 | 一种用于交会对接的ccd测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102706329A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103822582A (zh) * | 2014-03-04 | 2014-05-28 | 中国人民解放军国防科学技术大学 | 用于交会对接实验平台的相对运动测量*** |
CN104061926A (zh) * | 2014-06-24 | 2014-09-24 | 北京控制工程研究所 | 基于在轨数据进行相对导航敏感器状态辅助判断的方法 |
CN104154931B (zh) * | 2014-07-23 | 2017-01-25 | 北京控制工程研究所 | 一种交会测量***的光机定位测量方法 |
CN108801135A (zh) * | 2016-05-31 | 2018-11-13 | 哈尔滨工业大学 | 核燃料棒位姿自动识别装置 |
CN112573312A (zh) * | 2020-12-03 | 2021-03-30 | 日立楼宇技术(广州)有限公司 | 电梯轿厢位置确定方法、装置、电梯***及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003085684A (ja) * | 2001-09-12 | 2003-03-20 | Kenwood Corp | 計測装置、走行時間または走行距離計測方法 |
CN101419070A (zh) * | 2008-12-03 | 2009-04-29 | 南京航空航天大学 | 基于激光测距成像仪的相对位姿确定方法 |
CN101493325A (zh) * | 2009-03-09 | 2009-07-29 | 清华大学 | 激光测绘*** |
US20120075461A1 (en) * | 2009-03-27 | 2012-03-29 | Qifeng Yu | Ground-based videometrics guiding method for aircraft landing or unmanned aerial vehicles recovery |
-
2012
- 2012-05-31 CN CN2012101754115A patent/CN102706329A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003085684A (ja) * | 2001-09-12 | 2003-03-20 | Kenwood Corp | 計測装置、走行時間または走行距離計測方法 |
CN101419070A (zh) * | 2008-12-03 | 2009-04-29 | 南京航空航天大学 | 基于激光测距成像仪的相对位姿确定方法 |
CN101493325A (zh) * | 2009-03-09 | 2009-07-29 | 清华大学 | 激光测绘*** |
US20120075461A1 (en) * | 2009-03-27 | 2012-03-29 | Qifeng Yu | Ground-based videometrics guiding method for aircraft landing or unmanned aerial vehicles recovery |
Non-Patent Citations (1)
Title |
---|
安凯等: "一种用于交会对接的CCD快速测量方法", 《光电工程》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103822582A (zh) * | 2014-03-04 | 2014-05-28 | 中国人民解放军国防科学技术大学 | 用于交会对接实验平台的相对运动测量*** |
CN104061926A (zh) * | 2014-06-24 | 2014-09-24 | 北京控制工程研究所 | 基于在轨数据进行相对导航敏感器状态辅助判断的方法 |
CN104061926B (zh) * | 2014-06-24 | 2017-10-24 | 北京控制工程研究所 | 基于在轨数据进行相对导航敏感器状态辅助判断的方法 |
CN104154931B (zh) * | 2014-07-23 | 2017-01-25 | 北京控制工程研究所 | 一种交会测量***的光机定位测量方法 |
CN108801135A (zh) * | 2016-05-31 | 2018-11-13 | 哈尔滨工业大学 | 核燃料棒位姿自动识别装置 |
CN109000557A (zh) * | 2016-05-31 | 2018-12-14 | 哈尔滨工业大学 | 一种核燃料棒位姿自动识别方法 |
CN109000557B (zh) * | 2016-05-31 | 2019-07-05 | 哈尔滨工业大学 | 一种核燃料棒位姿自动识别方法 |
CN112573312A (zh) * | 2020-12-03 | 2021-03-30 | 日立楼宇技术(广州)有限公司 | 电梯轿厢位置确定方法、装置、电梯***及存储介质 |
CN112573312B (zh) * | 2020-12-03 | 2023-02-28 | 日立楼宇技术(广州)有限公司 | 电梯轿厢位置确定方法、装置、电梯***及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101813465B (zh) | 非接触精密测转角的单目视觉测量方法 | |
EP3407294A1 (en) | Information processing method, device, and terminal | |
CN103759669A (zh) | 一种大型零件的单目视觉测量方法 | |
CN103512548B (zh) | 距离测量装置及距离测量方法 | |
CN102013099B (zh) | 车载摄像机外参数交互式标定方法 | |
CN104200086A (zh) | 宽基线可见光相机位姿估计方法 | |
CN102706329A (zh) | 一种用于交会对接的ccd测量方法 | |
CN102135421B (zh) | 一种三维姿态角的测量方法和*** | |
WO2018133727A1 (zh) | 一种正射影像图的生成方法及装置 | |
CN103729837A (zh) | 一种单个路况摄像机的快速标定方法 | |
CN106979803B (zh) | 一种基于航拍无人机的测量河道流量的方法 | |
CN102254318A (zh) | 基于图像透视投影变换的车辆道路交通视频测速方法 | |
CN105466430A (zh) | 一种无人机的定位方法和装置 | |
CN103294886A (zh) | 用于再生虚拟物体的*** | |
CN104990515A (zh) | 大型物体三维形状测量***及其测量方法 | |
CN110610518A (zh) | 一种基于特征点位置校正的靶标位姿测量***及方法 | |
CN103903260A (zh) | 一种摄像机内参数快速标定的靶标方法 | |
CN108022267A (zh) | 一种摄像机标定装置及标定方法 | |
CN105157592A (zh) | 基于双目视觉的柔性后缘可变形机翼的变形形状和速率的测量方法 | |
CN102136140B (zh) | 一种基于矩形图样的视频图像距离检测方法 | |
CN101621711A (zh) | 采用两个相同圆进行摄像机标定的方法 | |
CN108036791B (zh) | 一种部件间高精度自动对接的位姿检测方法 | |
CN103606147A (zh) | 多台不共视场量测相机的坐标系转换标定方法 | |
CN103954220B (zh) | 撞桥试验中船体运动状态数字图像测量方法 | |
CN106570906A (zh) | 一种摄像机角度偏移条件下基于矩形图样的距离检测方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20121003 |