CN104316060B - 空间非合作目标的交会对接方法与装置 - Google Patents
空间非合作目标的交会对接方法与装置 Download PDFInfo
- Publication number
- CN104316060B CN104316060B CN201410250186.6A CN201410250186A CN104316060B CN 104316060 B CN104316060 B CN 104316060B CN 201410250186 A CN201410250186 A CN 201410250186A CN 104316060 B CN104316060 B CN 104316060B
- Authority
- CN
- China
- Prior art keywords
- space non
- target
- cooperative
- cooperative target
- relative
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000001914 filtration Methods 0.000 claims abstract description 14
- 238000013459 approach Methods 0.000 claims abstract description 4
- 238000005259 measurement Methods 0.000 claims description 55
- 230000000007 visual effect Effects 0.000 claims description 39
- 239000011159 matrix material Substances 0.000 claims description 20
- 230000001133 acceleration Effects 0.000 claims description 14
- 230000008859 change Effects 0.000 claims description 8
- 230000009897 systematic effect Effects 0.000 claims description 5
- 230000010354 integration Effects 0.000 claims 1
- 230000006641 stabilisation Effects 0.000 claims 1
- 238000011105 stabilization Methods 0.000 claims 1
- 230000008569 process Effects 0.000 abstract description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 3
- 238000004891 communication Methods 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- QNRATNLHPGXHMA-XZHTYLCXSA-N (r)-(6-ethoxyquinolin-4-yl)-[(2s,4s,5r)-5-ethyl-1-azabicyclo[2.2.2]octan-2-yl]methanol;hydrochloride Chemical compound Cl.C([C@H]([C@H](C1)CC)C2)CN1[C@@H]2[C@H](O)C1=CC=NC2=CC=C(OCC)C=C21 QNRATNLHPGXHMA-XZHTYLCXSA-N 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000006835 compression Effects 0.000 description 1
- 238000007906 compression Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000686 essence Substances 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明适用于航天领域，提供了一种空间非合作目标的交会对接方法和装置，该方法包括：地面导引至系统捕获范围内；依据能够确定空间非合作目标相对参数的测量部件的最简组合，分别确定测量视线角、相对距离及方位角；根据捕获量测结果，以扩展卡尔曼滤波算法进行相对导航；根据导航结果，分别执行CW参考轨迹制导和直线参考轨迹制导对目标进行跟踪，并给出了理想轨迹相对位置和相对速度方程；接近过程采用PID控制律和伪速率脉冲调制器进行推力控制。通过空间非合作目标的捕获、跟踪与接近，追踪航天器可以在进入捕获非合作目标工作范围后完成对空间非合作目标的自主捕获、连续跟踪与稳定接近，从而实现对空间非合作目标的交会对接。
Description
技术领域
本发明属于航天航空领域，尤其涉及空间非合作目标的交会对接方法和装置。
背景技术
随着航空航天技术的发展，由于航天器的维修、更新、组装的要求，空间在轨服务已经成为空间探索任务的一个重要趋势，对空间目标尤其是空间非合作目标的交会对接的需求也越来越迫切。
目前的交会对接试验大多针对空间合作航天器。其中，合作航天器通常包含以下特征或结构：激光反射器、用于测距和通讯传输的射频发射器、易于区分的可见或可反射的表观特征，抓捕固定装置以及合适的姿态控制系统。而不满足上述要求的其它航天器，则可以称之为空间非合作目标。
由于空间非合作目标没有安装标靶以及反射器等特征结构，无法完成与空间非合作目标的通信，不能准确的与非合作目标完成准确有效的交会对接。
发明内容
本发明实施例的目的在于提供一种空间非合作目标的交会对接方法和装置，以解决现有技术由于空间非合作目标没有安装标靶以及反射器等特征结构，无法完成与空间非合作目标的通信，不能准确的与非合作目标完成准确有效的交会对接的问题。
本发明实施例是这样实现的，一种空间非合作目标的交会对接方法，所述方法包括：
通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标；
根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息；
追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向；
当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息；
根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息；
根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹；
根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接。
本发明实施例的另一目的在于提供一种空间非合作目标的交会对接装置，所述装置包括：
相机控制单元，用于通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标；
视角线测量单元，用于根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息；
姿态指向调整单元，用于追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向；
方位角信息获取单元，用于当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息；
相对导航单元，用于根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息；
接收轨迹确定单元，用于根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹；
接近单元，用于根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接。
在本发明实施例中，通过空间非合作目标的捕获、跟踪与接近，追踪航天器可以在进入捕获非合作目标工作范围后完成对空间非合作目标的自主捕获、连续跟踪与稳定接近，从而实现对空间非合作目标的交会对接。
附图说明
图1是本发明实施例提供的空间非合作目标的交会对接方法的实现流程图；
图2是本发明实施例提供的空间非合作目标的交会对接的结构示意图；
图3是本发明实施例提供的空间非合作目标的交会对接硬件结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
本发明实施例可用于对非合作目标的交会对接，以填补现有技术中不能实现对空间非合作目标的交会对接的问题，具体包括如下步骤：通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标；根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息；追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向；当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息；根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息；根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹；根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接。下面详细论述如下：
在本发明实施例中，包括以下几个重要的坐标系，介绍如下：
(a)航天器质心轨道坐标系
航天器质心轨道坐标系(OoXoYoZo)简称为轨道坐标系。其坐标原点Oo为航天器质心，Zo轴从航天器质心指向地心，Xo轴位于轨道平面内垂直于Zo轴，并指向在轨飞行的前进方向；Yo轴使得OoXoYoZo构成右手正交系。
(b)航天器质心本体坐标系
航天器质心本体坐标系是右旋正交坐标系，原点Ob位于飞行基座质心，ObXb轴、ObYb轴和ObZb轴指向航天器特征方向，在标称状态下与轨道坐标系平行。
(c)微波测距仪测量坐标系
微波测距仪的测量坐标系OMXMYMZM，其坐标原点OM为微波测距仪天线的测量中心点；XM轴与微波测距仪的波束中心轴平行，由原点指向探测方向。YM轴和ZM轴在垂直与XM轴的平面内，YM轴指向测距仪发射机方向。OMXMYMZM坐标系为右手直角坐标系，与微波测距仪天线固连。
在标称状态下与追踪器质心本体坐标系平行。
(d)相机测量坐标系
相机测量坐标系OCXCYCZC的原点为相机测量中心；OCXC轴与光轴平行，由原点指向相机探测方向；OCYC和OCZC轴在与OCXC垂直的平面内，OCYC方向指向接插件方向。OCXCYCZC坐标系为右手直角坐标系，与相机固连。在标称状态下与SFR质心坐标系平行。
(e)微波测距仪相对距离：目标与微波测距仪测量坐标系原点间距离。
(f)微波测距仪相对速率：指相对距离对时间的一阶导数。
(g)微波测距仪视线角
微波测距仪视线角包括俯仰角αm和方位角βm。
俯仰角αm：定义为视线与视线在测距仪测量坐标系OMXMYM平面的投影的夹角，偏向-ZM轴为正。
方位角βm：定义为视线在测距仪测量坐标系OMXMYM平面的投影与OMXM轴的夹角，偏向+YM轴为正。
(a)相机相对距离：是指相机测量坐标系原点与目标之间的距离。
(b)相机视线：定义为从相机测量坐标系原点至目标形心的矢量。
(c)相机方位角
俯仰角αc：定义为视线与视线在相机测量坐标系的OCXCYC平面的投影的夹角，偏向-ZC轴为正。
方位角βc：定义为视线在相机测量坐标系的OCXCYC平面的投影与OCXC轴的夹角，偏向+YC轴为正。
在本发明实施例中，对相对运动状态方程介绍如下：
相对运动方程采用C-W方程，选用目标器的质心轨道坐标系为相对运动坐标系，若目标器运行于圆轨道上，则一阶Hill方程如下：
其中，n为目标器的轨道角速度值，[fx,fy,fz]T为除地球二体引力引起的追踪器加速度与目标器加速度之差在相对运动坐标系下的投影。若目标器无轨控，则有
其中u(t)＝[ux,uy,uz]T为追踪器喷气推力加速度在相对运动坐标系下的投影，w(t)＝[wx,wy,wz]T追踪器与目标器摄动加速度差在相对运动坐标系下的投影，视为噪声。
选取系统状态为得到状态方程
其中，
图1示出了本发明实施例提供的空间非合作目标的交会对接方法的实现流程，详述如下：
在步骤S101中，通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标。
可选的，所述宽视场相机为用于测量部件最简组合的宽视场相机。
宽视场测量相机的主要功能是在光照区对目标进行捕获和跟踪测量，并提供目标图像。性能如下：
(a)对空间大目标的捕获和跟踪测量范围为相对距离200m～15km；
(b)视场20°×20°；
(c)CCD像素数目1024×1024；
(d)提供目标的方位角测量信息，空间目标的视线角速度变化范围为±0.2°/s以内时，测量精度0.1°(3σ，系统误差与三倍的随机误差均方差之和)；
(e)捕获时间小于10s。
在步骤S102中，根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息。
具体的，所述根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息步骤包括：
所述非合作目标的视线角测量信息包括俯仰角αc以及方位角βc，根据公式获取非合作目标的视线角测量信息，其中，为空间非合作目标的等效半径，xc,yc,zc为空间非合作目标器的质心在宽视场测量相机的测量系中相对位置坐标。
在步骤S103中，追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向。
在步骤S104中，当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息。
所述微波测距仪对大目标的测量范围为相对距离为200m～15km，在±1°范围内可对目标连续测量。微波测距仪输出相对距离、相对速率、视线角信息。测量数据需包括测量数据采样时刻对应的时间信息。微波测距仪的测量精度为：
(a)相对距离测量精度优于：5+0.001R(m)(3σ，R为相对距离)；
(b)相对速度测量精度：优于0.1m/s(3σ)；
(c)当目标视线角速度变化范围为±0.1°/s以内时，视线角测量精度≤0.1°(3σ，R≤10km)或≤0.15°(3σ，10km≤R≤15km)；
(d)检测概率大于95％；
(e)虚警概率小于10-6；
(f)捕获时间优于10s。
可选的，所述当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息步骤包括：
采用公式计算得到空间非合作目标相对于追踪器微波测距仪测量坐标系的视线距离ρm以及空间非合作目标相对于追踪器微波测距仪测量坐标系的视线距离变化率其中，Ras0为空间非合作目标的等效半径，xm,ym,zm为空间非合作目标的质心在微波测距仪的测量系中相对位置坐标，为空间非合作目标的质心在微波测距仪的测量系中相对位置坐标的变化率。
对于测距仪提供的方位角信息，是相对于相机视场来说的，也就是相机和微波测距配合得到的，可以根据步骤S101中计算视线角的公式，相应的采用测距仪坐标系对应的数据。
测距仪与相机测量的原理在于：相机确定目标在图像中的2D坐标，测距仪确定目标的距离，在已知相机焦距f、相机和测距仪的安装位置关系的情况下，是可以通过相似性来得到(xc,yc,zc)和(xm,ym,zm)。
在步骤S105中，根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息。
相对运动方程采用C-W方程，选用目标器的质心轨道坐标系为相对运动坐标系，若目标器运行于圆轨道上，则一阶Hill方程如下：
其中，n为目标器的轨道角速度值，[fx,fy,fz]T为除地球二体引力引起的追踪器加速度与目标器加速度之差在相对运动坐标系下的投影。若目标器无轨控，则有
其中u(t)＝[ux,uy,uz]T为追踪器喷气推力加速度在相对运动坐标系下的投影，w(t)＝[wx,wy,wz]T追踪器与目标器摄动加速度差在相对运动坐标系下的投影，视为噪声。
选取系统状态为得到状态方程
其中，
状态方程选取(3)式，系统状态为相对位置，相对速度：
假设目标器和追踪器运行在共面圆轨道上，目标器与追踪器轨道角速度相同均为n，同时假设微波测距仪的测量坐标系OmXmYmZm相对于追踪器质心本体系是固定的(上述假设仅针对式(10))。令追踪器质心本体系转到微波测距仪的测量坐标系的方向余弦阵为令微波测距仪的测量坐标系原点在追踪器质心本体系下的坐标为[xm0,ym0,zm0]T，令追踪器惯性姿态角速度在追踪器质心本体系下的投影为[ωx,ωy,ωz]T，则通过推导可以得到：
其中为追踪器的轨道坐标系转到目标器的轨道坐标系的方向余弦阵，可以认为是单位阵，也可以由目标器与追踪器的相对位置估算得到。
由式(9)与式(10)可得
其中[]*表示反对称矩阵。
同理，假设宽视场测量相机的测量坐标系OcXcYcZc相对于追踪器质心本体系是固定的(上述假设仅针对式(14))。令追踪器质心本体系转到宽视场测量相机的测量坐标系的方向余弦阵为令宽视场测量相机的测量坐标系原点在追踪器质心本体系下的坐标为[xc0,yc0,zc0]T，令追踪器惯性姿态角速度在追踪器质心本体系下的投影为[ωx,ωy,ωz]T，则通过推导可以得到：
其中为追踪器的轨道坐标系转到目标器的轨道坐标系的方向余弦阵，可以认为是单位阵，也可以由目标器与追踪器的相对位置估算得到。
由式(9)与式(10)可得
记测量值为z(t)＝[z1,z2,z3,z4,z5,z6]T，且
其中
令
代入式(11)和(12)，得
令
代入式(15)和(16)，得
建立量测方程z(t)＝h(x(t))+v：
其中
h1[x(t)]＝ρm0-Ras0 (21)
h2[x(t)]＝asin(zc/ρc) (22)
h3[x(t)]＝atan(yc/xc) (23)
式(21)～(24)中，xm,ym,zm,由式(18)确定，xc,yc,zc,由式(19)确定。
量测方程中的h对x求偏导数，得到偏导数公式
上式中各项偏导数计算公式如下：
相对导航采用扩展卡尔曼滤波算法，非线性系统的系统方程为
z(t)＝h[x(t),t]+v(t) (34)
围绕最优状态估计线性化有
其中
将式(35)离散化有
对上式使用卡尔曼滤波基本方程，并通过推导可得扩展卡尔曼滤波的方程为：
其中
上式中，K为滤波增益矩阵，v(t)是均值为0协方差阵为Q的观测噪声，I为单位矩阵，是x的二阶导数。
在步骤S106中，根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹。
远距离段(15km～1km)，设目标器在轨道半径为r的圆轨道上，追踪器与目标器共轨并在目标器后方15km处，在以目标器的质心轨道坐标系为相对运动坐标系时，相对位置和相对速度为：
追踪器采用C-W制导在V-bar方向施加速度增量，从-15km处接近到2km处先后所需的速度增量为：
式中Δx＝14000m。
在接近过程中采用C-W制导理想轨迹为参考轨迹进行修正，理想轨迹相对位置见公式(42)，相对速度见公式(43)。
中近距离段(1000m～300m)采用直线参考轨道迹接近，设接近的速度为Δvx，则理想轨迹相对位置见公式(42)，相对速度见公式(43)。
在步骤S107中，根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接。
跟踪接近控制采用PID控制律，见公式(44)。
推力器采用伪速率调制器(PSF)输出。其中，为期望的相对位置，为相对位置估计值，为相对位置，KP为控制律比例系数Kd为控制律阻尼系数，KI为控制律积分系数，s为积分时间常数。伪速率调制器主要由非线性继电器环节和惯性环节反馈连接组成。
如图2所示，本发明还提供了作为与本发明空间非合作目标的交会对接方法实施例相对应的空间非合作目标的交会对接装置，包括：
相机控制单元201，用于通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标；
视角线测量单元202，用于根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息；
姿态指向调整单元203，用于追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向；
方位角信息获取单元204，用于当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息；
相对导航单元205，用于根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息；
接收轨迹确定单元206，用于根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹；
接近单元207，用于根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接。
优选的，所述宽视场相机为用于测量部件最简组合的宽视场相机。
本发明实施例所述空间非合作目标的交会对接装置与空间非合作目标的交会对接方法对应，在此不作重复赘述。
另外，如图3所示为本发明实施所述的空间非合作目标的交会对接硬件结构示意图，由宽视场相机以及微波测距仪获取空间非合作目标的视线角测量信息、空间非合作目标的相对距离与方位角信息，由信息处理单元压缩处理后发送至GNC分系统，从而控制追踪航天器完成捕获、跟踪、接近的交付对接。
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。
Claims (7)
1.一种空间非合作目标的交会对接方法，其特征在于，所述方法包括：
通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标；
根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息；
追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向；
当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息；
根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息；
根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹；
根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接；
当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息步骤包括：
采用公式计算得到空间非合作目标相对于追踪器微波测距仪测量坐标系的视线距离ρm以及空间非合作目标相对于追踪器微波测距仪测量坐标系的视线距离变化率其中，Ras0为空间非合作目标的等效半径，xm,ym,zm为空间非合作目标的质心在微波测距仪的测量系中相对位置坐标，为空间非合作目标的质心在微波测距仪的测量系中相对位置坐标的变化率；
所述根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息包括：
根据扩展卡尔曼滤波的方程
进行相对导航，其中，Φ(k+1,k)≈I+F(tk)T，为系非线性函数线性化后的系统矩阵，为线性化后的观测矩阵，为系统状态方程，z(t)＝h[x(t),t]+v(t)为系统观测方程，为线性化后的状态方程与观测方程，为C-W方程，n为目标器的轨道角速度值，fx,fy,fz为除地球的二体引力引起的追踪器加速度与目标器加速度之差在相对运动坐标系下的投影，u(t)＝[ux,uy,uz]T为控制器向量，为系统状态向量，为线性化后的系统状态矩阵、输入-控制模型以及系统观测矩阵，w(t)＝[wx,wy,wz]T追踪器与目标器摄动加速度差在相对运动坐标系下的投影，K为滤波增益矩阵，v(t)是均值为0协方差阵为Q的观测噪声，I为单位矩阵，是x的二阶导数；
所述根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹步骤包括：
根据确定理想轨迹相对位置，根据确定理想轨迹相对速度，其中，Δvx1、Δvx2为速度增量且xc,yc,zc为空间非合作目标器的质心在宽视场测量相机的测量系中相对位置坐标，为空间非合作目标器的质心在宽视场测量相机的测量系中相对位置坐标的时间变化率，w(t)＝[wx,wy,wz]T追踪器与目标器摄动加速度差在相对运动坐标系下的投影。
2.根据权利要求1所述方法，其特征在于，所述根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息步骤包括：
所述非合作目标的视线角测量信息包括俯仰角αc以及方位角βc，根据公式获取非合作目标的视线角测量信息，其中，为空间非合作目标的等效半径，xc,yc,zc为空间非合作目标器的质心在宽视场测量相机的测量系中相对位置坐标。
3.根据权利要求1所述方法，其特征在于，所述根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近步骤包括：
根据PID控制律公式对空间非合作目标进行缓慢稳定接近，其中，为期望的相对位置，为相对位置估计值，为相对位置，KP为控制律比例系数Kd为控制律阻尼系数，KI为控制律积分系数，s为积分时间常数。
4.根据权利要求1所述方法，其特征在于，所述宽视场相机为用于测量部件最简组合的宽视场相机。
5.根据权利要求1所述方法，其特征在于，所述微波测距仪的测量范围为相对距离200m至15km。
6.一种空间非合作目标的交会对接装置，其特征在于，所述装置包括：
相机控制单元，用于通过地面导引提供的空间非合作目标的位置信息，结合追踪航天器的绝对GPS信息，控制追踪航天器的宽视场测量相机的捕获范围包括所述空间非合作目标；
视角线测量单元，用于根据所述宽视场相机捕获的目标，确定空间非合作目标的视线角测量信息；
姿态指向调整单元，用于追踪航天器根据所述视线角测量信息，调整对所述空间非合作目标的姿态指向；
方位角信息获取单元，用于当所述姿态指向满足微波测距仪的波束范围时，测距仪提供空间非合作目标的相对距离与方位角信息；
相对导航单元，用于根据所述空间非合作目标的相对距离与方位角信息，采用扩展卡尔曼滤波算法进行相对导航，持续获得目标测量信息；
接收轨迹确定单元，用于根据相对导航获取的空间非合作目标测量信息，依次进行C-W制导和直线制导，确定接近轨迹；
接近单元，用于根据所述接近轨迹，实施PID控制，对空间非合作目标进行缓慢稳定接近，以完成空间非合作目标的交会对接；
所述方位角信息获取单元用于：
采用公式计算得到空间非合作目标相对于追踪器微波测距仪测量坐标系的视线距离ρm以及空间非合作目标相对于追踪器微波测距仪测量坐标系的视线距离变化率其中，Ras0为空间非合作目标的等效半径，xm,ym,zm为空间非合作目标的质心在微波测距仪的测量系中相对位置坐标，为空间非合作目标的质心在微波测距仪的测量系中相对位置坐标的变化率；
所述相对导航单元用于：
根据扩展卡尔曼滤波的方程
进行相对导航，其中，Φ(k+1,k)≈I+F(tk)T，为系非线性函数线性化后的系统矩阵，为线性化后的观测矩阵，为系统状态方程，z(t)＝h[x(t),t]+v(t)为系统观测方程，为线性化后的状态方程与观测方程，为C-W方程，n为目标器的轨道角速度值，fx,fy,fz为除地球的二体引力引起的追踪器加速度与目标器加速度之差在相对运动坐标系下的投影，u(t)＝[ux,uy,uz]T为控制器向量，为系统状态向量，为线性化后的系统状态矩阵、输入-控制模型以及系统观测矩阵，w(t)＝[wx,wy,wz]T追踪器与目标器摄动加速度差在相对运动坐标系下的投影，K为滤波增益矩阵，v(t)是均值为0协方差阵为Q的观测噪声，I为单位矩阵，是x的二阶导数；
所述接近轨迹确定单元用于：
根据确定理想轨迹相对位置，根据确定理想轨迹相对速度，其中，Δvx1、Δvx2为速度增量且xc,yc,zc为空间非合作目标器的质心在宽视场测量相机的测量系中相对位置坐标，为空间非合作目标器的质心在宽视场测量相机的测量系中相对位置坐标的时间变化率，w(t)＝[wx,wy,wz]T追踪器与目标器摄动加速度差在相对运动坐标系下的投影。
7.根据权利要求6所述装置，其特征在于，所述宽视场相机为用于测量部件最简组合的宽视场相机。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410250186.6A CN104316060B (zh) | 2014-06-06 | 2014-06-06 | 空间非合作目标的交会对接方法与装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410250186.6A CN104316060B (zh) | 2014-06-06 | 2014-06-06 | 空间非合作目标的交会对接方法与装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104316060A CN104316060A (zh) | 2015-01-28 |
| CN104316060B true CN104316060B (zh) | 2018-09-11 |
Family
ID=52371324
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410250186.6A Active CN104316060B (zh) | 2014-06-06 | 2014-06-06 | 空间非合作目标的交会对接方法与装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104316060B (zh) |
Families Citing this family (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104765373B (zh) * | 2015-01-30 | 2017-11-07 | 北京控制工程研究所 | 一种星上相对运动状态获取方法 |
| CN105353763B (zh) * | 2015-12-01 | 2018-03-30 | 哈尔滨工业大学 | 一种非合作目标航天器相对轨道姿态有限时间控制方法 |
| CN105953795B (zh) * | 2016-04-28 | 2019-02-26 | 南京航空航天大学 | 一种用于航天器表面巡视的导航装置及方法 |
| CN106094565B (zh) * | 2016-06-13 | 2019-01-04 | 北京航空航天大学 | 一种航天器自主交会控制系统地面仿真试验方法 |
| CN107168051B (zh) * | 2017-04-07 | 2020-02-07 | 西北工业大学 | 一种基于Tau理论的航天器交会制导方法 |
| CN107065547B (zh) * | 2017-04-07 | 2019-12-03 | 西北工业大学 | 一种基于零空间方法的非合作目标自主交会策略 |
| CN107990871A (zh) * | 2017-09-05 | 2018-05-04 | 北京航空航天大学 | 一种基于多传感信息融合的相对位姿测量装置与方法 |
| CN109094818B (zh) * | 2018-01-24 | 2021-01-22 | 北京电子工程总体研究所 | 一种空间飞行器的远程交会制导方法 |
| CN108287476B (zh) * | 2018-02-06 | 2019-02-26 | 哈尔滨工业大学 | 基于高阶滑模控制和扰动观测器的空间翻滚非合作目标自主交会制导方法 |
| CN108519083B (zh) * | 2018-03-06 | 2019-06-18 | 北京控制工程研究所 | 一种空间非合作多目标捕获与跟踪算法 |
| CN110618466B (zh) * | 2018-06-20 | 2021-06-18 | 天津工业大学 | 一种空间目标姿态可探测性度量方法 |
| CN109211233B (zh) * | 2018-09-25 | 2020-10-23 | 常熟理工学院 | 基于加速度传感器的电梯运动检测及异常位置停车判断方法 |
| CN109885073B (zh) * | 2019-01-15 | 2021-11-09 | 西北工业大学 | 一种针对空间非合作目标自由漂浮运动状态的预测方法 |
| CN110221625B (zh) * | 2019-05-27 | 2021-08-03 | 北京交通大学 | 无人机精确位置的自主降落导引方法 |
| CN111102981B (zh) * | 2019-12-09 | 2022-03-04 | 北京空间机电研究所 | 一种基于ukf的高精度卫星相对导航方法 |
| CN111189457B (zh) * | 2020-02-25 | 2021-12-07 | 上海航天控制技术研究所 | 一种基于cw方程的解耦变增益自主相对导航方法 |
| CN111367314B (zh) * | 2020-03-09 | 2021-07-27 | 西北工业大学 | 一种基于多航天器编队的空间非合作目标协同抓捕方法 |
| CN111536983B (zh) * | 2020-05-11 | 2022-06-03 | 北京控制工程研究所 | 一种航天器三超控制宽频多源多级的协同定姿方法及系统 |
| CN113135302B (zh) * | 2021-03-09 | 2022-09-02 | 中国人民解放军国防科技大学 | 一种与机动非合作目标交会对接的方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101726296A (zh) * | 2009-12-22 | 2010-06-09 | 哈尔滨工业大学 | 空间机器人视觉测量、路径规划、gnc一体化仿真系统 |
| CN101733746A (zh) * | 2009-12-22 | 2010-06-16 | 哈尔滨工业大学 | 空间机器人非合作目标自主识别与捕获方法 |
| CN103438888A (zh) * | 2013-07-24 | 2013-12-11 | 西北工业大学 | 一种对空间非合作目标自主交会的相对导航方法 |
| CN103576689A (zh) * | 2013-10-08 | 2014-02-12 | 北京控制工程研究所 | 一种交会对接六自由度相对控制方法 |
-
2014
- 2014-06-06 CN CN201410250186.6A patent/CN104316060B/zh active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101726296A (zh) * | 2009-12-22 | 2010-06-09 | 哈尔滨工业大学 | 空间机器人视觉测量、路径规划、gnc一体化仿真系统 |
| CN101733746A (zh) * | 2009-12-22 | 2010-06-16 | 哈尔滨工业大学 | 空间机器人非合作目标自主识别与捕获方法 |
| CN103438888A (zh) * | 2013-07-24 | 2013-12-11 | 西北工业大学 | 一种对空间非合作目标自主交会的相对导航方法 |
| CN103576689A (zh) * | 2013-10-08 | 2014-02-12 | 北京控制工程研究所 | 一种交会对接六自由度相对控制方法 |
Non-Patent Citations (5)
| Title |
|---|
| Study on Intelligent Visual Servoing of Space Robot for Cooperative Target Capturing;Ye Shi,Bin Liang et al;《Proceeding of the IEEE International Conference on Information and Automation》;20120630;第733-738页 * |
| 对异面椭圆轨道目标航天器绕飞的相对导航算法;周文勇，袁建平，罗建军;《西北工业大学学报》;20070430;第25卷(第2期);第211页 * |
| 空间非合作目标交会运动状态估计的卡尔曼滤波方法;张秋华等;《电子测量与仪器学报》;20041231;第685-689页 * |
| 空间非合作目标飞行器在轨交会控制研究;张立佳;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20100315(第3期);第21、26、34-35、58-59页 * |
| 非合作目标交会相对导航方法研究;刘涛，解永春;《航天控制》;20060430;第24卷(第2期);第48-53页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104316060A (zh) | 2015-01-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104316060B (zh) | 空间非合作目标的交会对接方法与装置 | |
| CN105184776B (zh) | 目标跟踪方法 | |
| US6489922B1 (en) | Passive/ranging/tracking processing method for collision avoidance guidance and control | |
| US8204677B2 (en) | Tracking method | |
| CN103852082B (zh) | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 | |
| CN109911188A (zh) | 非卫星导航定位环境的桥梁检测无人机系统 | |
| Shen et al. | Optical Flow Sensor/INS/Magnetometer Integrated Navigation System for MAV in GPS‐Denied Environment | |
| US9857179B2 (en) | Magnetic anomaly tracking for an inertial navigation system | |
| CN111102981B (zh) | 一种基于ukf的高精度卫星相对导航方法 | |
| US9875403B2 (en) | Method for accurately geolocating an image sensor installed on board an aircraft | |
| Delaune et al. | Extended navigation capabilities for a future mars science helicopter concept | |
| Vetrella et al. | Cooperative UAV navigation based on distributed multi-antenna GNSS, vision, and MEMS sensors | |
| US8346466B2 (en) | Systems and methods for determining heading | |
| Rhudy et al. | Unmanned aerial vehicle navigation using wide‐field optical flow and inertial sensors | |
| KR20160120467A (ko) | 차량용 2차원 레이더의 방위각 보정 장치 및 방법 | |
| CN108225307A (zh) | 一种惯性测量信息辅助的星图匹配方法 | |
| CN109186614B (zh) | 一种航天器间近距离自主相对导航方法 | |
| George et al. | Inertial navigation aided by monocular camera observations of unknown features | |
| CN110286371A (zh) | 基于雷达点阵数据的小天体着陆器相对位姿确定方法 | |
| CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
| Kaiser et al. | Localization and control of an aerial vehicle through chained, vision-based pose reconstruction | |
| JP2008241079A (ja) | 航法システム | |
| Schlaile et al. | Using natural features for vision based navigation of an indoor-VTOL MAV | |
| Yun et al. | Range/optical flow-aided integrated navigation system in a strapdown sensor configuration | |
| Kaiser et al. | Position and orientation of an aerial vehicle through chained, vision-based pose reconstruction |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |