CN107270895A - 一种用于空中加油会合段的相对导航系统及方法 - Google Patents
一种用于空中加油会合段的相对导航系统及方法 Download PDFInfo
- Publication number
- CN107270895A CN107270895A CN201710468464.9A CN201710468464A CN107270895A CN 107270895 A CN107270895 A CN 107270895A CN 201710468464 A CN201710468464 A CN 201710468464A CN 107270895 A CN107270895 A CN 107270895A
- Authority
- CN
- China
- Prior art keywords
- relative
- gps
- fuel charger
- data
- congregation
- 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
Classifications
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种用于空中加油会合段的相对导航系统及方法。系统采用捷联惯性导航系统(SINS)、卫星定位系统(GPS)以及红外搜索与跟踪系统(IRST)组合的方式,加油机与受油机之间通过数据链进行通信。采用混合多级式的融合结构模型,可以实时得到受油机与加油机之间高精度的相对位置、速度、姿态信息,满足了空中加油会合段的任务要求。同时IRST可以独立工作,削弱了相对导航系统对数据链的依赖,使系统具有高可靠性和容错性。
Description
技术领域
本发明属于相对导航与组合导航领域,尤其涉及一种用于空中加油会合段的相对导航系统及方法。
背景技术
空中加油是指在飞行过程中一架飞机向另一架或多架飞机传输燃料的活动。拥有了该项技术,意味着飞机不需要落地就可以加注燃料,大大地增加了飞机的航程以及续航时间,为更好的执行任务提供可能。
求解加油机与受油机之间的相对导航信息是空中加油的首要问题,相对导航信息包括相对位置、速度与姿态三个方面。目前,国内外针对空中加油会合段相对导航算法的研究很少。有一些针对编队飞行的相对导航算法,但没有考虑到空中加油会合段的特点与要求。目前常用的相对导航手段主要有:(1)绝对定位结果作差;(2)GPS差分方法;;(3)基于测量角度和距离的目标定位方法。
现有技术手段存在一些技术问题:如何选择合理的传感器,满足空中加油会合段的要求;如何设计算法,提供加油机与受油机之间的实时、高精度的相对导航信息,保证输出的收敛性;如何满足相对导航系统的可靠性与容错性要求。
发明内容
发明目的:针对以上问题,本发明提出一种用于空中加油会合段的相对导航系统及方法。
技术方案:为实现本发明的目的,本发明所采用的技术方案是:一种用于空中加油会合段的相对导航系统,包括加油机和受油机;其中加油机包括SINS、GPS和数据链通信系统;受油机包括SINS、GPS、IRST和数据链通信系统,飞机间通过数据链传递相关数据。
一种用于空中加油会合段的相对导航方法,具体包括:
(1)加油机上安装SINS、GPS以及数据链通信系统;受油机上安装SINS、GPS、IRST和数据链通信系统。飞机间通过数据链传递相关数据;
(2)加油机中设有局部融合滤波器;受油机中设有局部融合滤波器、相对状态滤波器、目标跟踪滤波器和系统融合中心;
(3)采用混合多级式的融合结构模型,实时得到高精度的相对位置、速度和姿态信息。
局部融合滤波器具体工作为:
(1)采用SINS与GPS紧组合的方式,利用GPS信息校正SINS的信息,得到绝对定位结果;
(2)用卡尔曼滤波的估计结果校正陀螺仪和加速度计的输出;
(3)利用局部融合滤波器估计结果修正后的角速度和比力、GPS量测以及局部融合滤波器解算得到的绝对位置,通过数据链发送给加油机。
相对状态融合滤波器具体工作为:
(1)利用GPS载波相位差分信息,估计相对导航状态的误差,从而校正相对导航状态;
(2)状态方程采用相对惯性状态误差微分方程,量测为GPS载波相位差分的解算结果与相对导航状态的差值;
(3)采用卡尔曼滤波算法,得到加油机与受油机之间的相对导航状态误差。
(4)用卡尔曼滤波算法,得到陀螺仪漂移量和加速度计漂移量的误差估计值,用于校正角速度和比力,形成闭环系统。
目标跟踪滤波器具体工作为:
(1)加入IRST目标跟踪滤波器,求解加油机的航迹;
(2)利用GPS载波相位差分得到的受油机与加油机之间的直线距离来代替IRST的距离量测;
(3)加油机运动模型选择常用的速度模型(CV模型)和加速度模型(CA模型),通过机动性检测条件判断加油机是否发生了机动。判断加油机属于非机动状态时,状态方程采用CV模型;判断加油机处于机动状态时,状态方程采用CA模型。
(4)量测利用IRST测量得到的视线仰角和视线方位角以及GPS差分得到的直线距离信息,建立量测方程。
系统融合中心具体工作为:
(1)将相对状态滤波器的结果与目标跟踪滤波器的结果进行融合;
(2)采用估计方差的逆矩阵进行加权融合,信息融合的周期取相对状态融合滤波器和目标跟踪滤波器周期的最小公倍数。
有益效果:
本发明针对空中加油会合段,相对导航系统采用SINS、GPS以及IRST组合的传感器配置,优势互补。结构上采用混合多级式的融合模型,可以实时得到高精度的相对位置、速度和姿态。并且当数据链出现中断时,IRST可独立工作,满足系统可靠性与容错性的要求。
附图说明
图1是相对导航系统的结构框图;
图2是IRST导航系统测量模型;
具体实施方式
下面结合附图和实施例对本发明的技术方案作进一步的说明。
本发明针对空中加油会合段,相对导航系统采用SINS、GPS以及IRST组合的方式,在系统框架上采用混合多级式的融合结构模型,可以实时得到加油机与受油机之间的高精度的相对位置、速度、姿态信息。当数据链出现中断时,IRST可独立工作,满足系统可靠性与容错性的要求。
如图1所示是本发明所述的相对导航系统的结构框图,包括加油机和受油机;其中,加油机包括SINS,GPS和数据链通信系统;受油机包括SINS,GPS,IRST和数据链通信系统。加油机与受油机之间通过数据链进行通信。相对导航系统采用混合多级式的融合结构模型。
加油机中设有局部融合滤波器;受油机中设有局部融合滤波器、相对状态滤波器、目标跟踪滤波器和系统融合中心。
(1)局部融合滤波器。
局部绝对状态滤波器采用SINS与GPS紧组合的方式。利用Kalman滤波来校正SINS输出的位置、姿态和速度信息,并且校正了陀螺仪和加表输出的角速度和比力。
本方案充分利用GPS的输出信息。利用加油机和受油机上的GPS信息先校正自身的绝对定位的结果,并修正了陀螺仪、加表的测量信息。加油机通过数据链将相关数据传至受油机。由于局部融合滤波器的存在,大大提高了相对状态误差模型的精确性,有效地抑制解算结果的发散。
(2)相对状态滤波器。
相对状态滤波器总体思路:利用GPS载波相位差分结果,估计出相对导航状态的误差,从而校正相对导航状态。状态方程采用相对惯性状态误差微分方程,量测选择GPS载波相位差分的结果与相对导航状态的差值。采用卡尔曼滤波,得到加油机与受油机之间的相对导航状态误差,继而得到校正后的相对位置、相对姿态和相对速度信息。并且通过滤波算法,可以估计陀螺仪漂移量和加速度计漂移量的误差值,用于校正角速度和比力,形成闭环系统。
具体如下:
(2.1)相对惯性系统的状态误差微分方程。
根据陀螺仪与加表的误差方程,推导相对位置与姿态的误差微分方程,算法采用四元数来表示姿态。
加油机t与受油机u之间的相对姿态可以定义为相对姿态的误差可以定义为其中,表示相对四元数的估计值。
姿态微分方程如下:
其中,角速度表示受油机u机体系相对于加油机t机体系的角速度在受油机u机体系中的投影。使用增量公式表示相对四元数的误差如下:
由以上两个公式可以得到:
由四元数乘法:
由于相对四元数误差很小:
δq=[δq1,δq2,δq3,δq4]T≈[1,0,0,0]T
作如下简化:
去除小量后,可以得到:
结合陀螺仪的误差模型,上式可以转化为:
相对位置表示为并且:
其中,是从惯性坐标系到飞机u机体系的方向余弦阵。
取两阶导数后:
由微分方程可以得到:
同时有:
由上面两个方程,可以整理得到:
定义相对速度误差的微分形式如下:
因为相对距离与地球半径相比很小,可以忽略重力加速度的影响。由上述两个方程以及陀螺仪的误差模型,可以得到:
相对状态误差变量定义为:
建立相对状态误差方程如下:
离散形式如下:
X(k)=F(k-1)X(k-1)+G(k-1)W(k-1)
其中,W(k-1)是均值为0的高斯白噪声。
(2.2)量测方程。
GPS相对量测值利用无基站的载波相位差方法解算得到,记为:
量测方程为:
整理后,记为:
ΔZ(k)=H(k)ΔX(k)+V(k)
其中,V(k)是均值为0的高斯白噪声。
(2.3)数据融合。
数据融合算法采用卡尔曼滤波的方法,包括时间更新和量测更新两部分。假设系统噪声协方差阵为Q,量测噪声协方差阵为R。
协方差的一步预测为:
K时刻的协方差阵为:
Pk=(I-KkHk)Pk/k-1(I-KkHk)T+KkRkKk T
增益矩阵为:
状态一步预测:
Xk/k-1=Fk-1Xk-1
状态估计:
Xk=Xk/k-1+Kk(Zk-HkXk/k-1)
通过卡尔曼滤波算法,可以得到相对导航状态的误差,记为用于修正相对导航状态以及角速度和比力。
(3)目标跟踪滤波器。
对于目标跟踪滤波器,加入了IRST目标跟踪滤波器,体现了目标跟踪(航迹融合)的特点。将IRST的输出作为一串量测序列考虑,并且把加油机运动特性考虑进来。
IRST角度量测精度较高,但距离测量精度偏低。利用GPS差分得到的双机的直线距离来取代IRST的距离量测,可以有效提高IRST目标跟踪滤波器输出的精度。
加油机运动模型选择常用的速度模型(CV模型)和加速度模型(CA模型),通过机动性检测条件判断加油机是都发生了机动。判断加油机属于非机动状态时,状态方程采用CV模型;判断加油机处于机动状态时,状态方程采用CA模型。量测利用IRST测量得到的视线仰角和视线方位角,以及GPS差分得到的直线距离信息。
CV模型:
CA模型:
如图2所示是IRST导航系统测量模型,IRST系统提供距离、视线仰角以及视线方位角。IRST可以大范围工作(>100km),并且不依赖于数据链路。使得相对导航系统更可靠。假定测量得到的距离为ρ,方位角为β,视线仰角为α.加油机与受油机之间的相对位置为[Δx,Δy,Δz]。根据几何关系可以建立如下方程,继而可以获得量测方程。
(4)系统融合中心。
系统融合中心将相对状态滤波器的结果与目标跟踪滤波器的结果进行融合。采用估计方差的逆矩阵进行加权融合。信息融合周期取相对状态滤波器的结果与目标跟踪滤波器周期的最小公倍数。
本发明针对空中加油会合段,系统采用多传感器组合的方式,优势互补。加入了IRST数据源,利用了IRST测量范围广的特点;设计了目标跟踪滤波器,把加油机运动特性考虑进来。融合结构采用混合多级式的结构模型,可以实时得到受油机与加油机之间高精度的相对位置、速度、姿态信息,满足了空中加油会合段的任务要求。同时IRST可以独立工作,削弱了相对导航系统对数据链的依赖,使系统具有高可靠性和容错性。
Claims (6)
1.一种用于空中加油会合段的相对导航系统,其特征在于:包括加油机和受油机;其中,加油机包括SINS、GPS和数据链通信系统;受油机包括SINS、GPS、IRST和数据链通信系统,飞机间通过数据链传递相关数据。
2.一种用于空中加油会合段的相对导航方法,其特征在于:具体包括:
(1)加油机上安装SINS、GPS和数据链通信系统;受油机上安装SINS、GPS、IRST和数据链通信系统,飞机间通过数据链传递相关数据;
(2)加油机中设有局部融合滤波器;受油机中设有局部融合滤波器、相对状态滤波器、目标跟踪滤波器和系统融合中心;
(3)采用混合多级式的融合结构模型,实时得到高精度的相对位置、速度和姿态信息。
3.根据权利要求2所述的用于空中加油会合段的相对导航方法,其特征在于:
所述局部融合滤波器具体工作为:
(1)采用SINS与GPS紧组合的方式,利用GPS信息校正SINS的信息,得到绝对定位结果;
(2)用卡尔曼滤波的估计结果校正陀螺仪和加速度计的输出;
(3)加油机上,GPS量测、局部融合滤波器解算得到的绝对位置以及用局部融合滤波器估算结果修正后的角速度和比力,通过数据链发送给受油机。
4.根据权利要求2所述的用于空中加油会合段的相对导航方法,其特征在于:
所述相对状态滤波器具体工作为:
(1)利用GPS的载波相位差分信息,估计相对导航状态的误差,从而校正相对导航状态;
(2)状态方程采用相对惯性状态误差微分方程,量测为GPS载波相位差分的解算结果与相对导航状态的差值;
(3)采用卡尔曼滤波算法,得到加油机与受油机之间的相对导航状态误差。继而得到相对导航状态的估计值;
(4)用卡尔曼滤波算法,得到陀螺仪漂移量和加速度计漂移量的误差估计值,用于校正角速度和比力,形成闭环系统。
5.根据权利要求2所述的用于空中加油会合段的相对导航方法,其特征在于:
所述目标跟踪滤波器具体工作为:
(1)加入IRST目标跟踪滤波器,求解加油机的航迹;
(2)利用GPS载波相位差分得到的两架飞机的直线距离来取代IRST的距离量测;
(3)加油机运动模型选择常用的速度模型和加速度模型,通过机动性检测条件判断加油机是否发生了机动;判断加油机属于非机动状态时,状态方程采用速度模型;判断加油机处于机动状态时,状态方程采用加速度模型;
(4)量测利用IRST测量得到的视线仰角和视线方位角,以及GPS差分得到的直线距离信息,建立量测方程;
(5)当数据链通信中断时,可完全依赖于IRST进行相对定位。
6.根据权利要求2所述的用于空中加油会合段的相对导航方法,其特征在于:
所述系统融合中心具体工作为:
(1)将相对状态滤波器的结果与目标跟踪滤波器的结果进行融合;
(2)采用估计方差的逆矩阵进行加权融合,信息融合的周期取相对状态滤波器和目标跟踪滤波器周期的最小公倍数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710468464.9A CN107270895A (zh) | 2017-06-20 | 2017-06-20 | 一种用于空中加油会合段的相对导航系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710468464.9A CN107270895A (zh) | 2017-06-20 | 2017-06-20 | 一种用于空中加油会合段的相对导航系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107270895A true CN107270895A (zh) | 2017-10-20 |
Family
ID=60069432
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710468464.9A Pending CN107270895A (zh) | 2017-06-20 | 2017-06-20 | 一种用于空中加油会合段的相对导航系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107270895A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115145294A (zh) * | 2022-06-30 | 2022-10-04 | 西北工业大学 | 一种用于自主空中加油对接的组合导航系统和方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN101957204A (zh) * | 2010-09-28 | 2011-01-26 | 北京航空航天大学 | 一种基于相互测距信息的机群惯性导航数据融合方法 |
CN104034329A (zh) * | 2014-06-04 | 2014-09-10 | 南京航空航天大学 | 发射惯性系下的多组合导航处理装置及其导航方法 |
CN104567880A (zh) * | 2014-12-23 | 2015-04-29 | 北京理工大学 | 一种基于多源信息融合的火星最终接近段自主导航方法 |
CN205507094U (zh) * | 2014-12-30 | 2016-08-24 | 大连现代高技术集团有限公司 | 机场廊桥对接飞机舱口导航系统 |
-
2017
- 2017-06-20 CN CN201710468464.9A patent/CN107270895A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN101957204A (zh) * | 2010-09-28 | 2011-01-26 | 北京航空航天大学 | 一种基于相互测距信息的机群惯性导航数据融合方法 |
CN104034329A (zh) * | 2014-06-04 | 2014-09-10 | 南京航空航天大学 | 发射惯性系下的多组合导航处理装置及其导航方法 |
CN104567880A (zh) * | 2014-12-23 | 2015-04-29 | 北京理工大学 | 一种基于多源信息融合的火星最终接近段自主导航方法 |
CN205507094U (zh) * | 2014-12-30 | 2016-08-24 | 大连现代高技术集团有限公司 | 机场廊桥对接飞机舱口导航系统 |
Non-Patent Citations (2)
Title |
---|
ZHU YUNFENG 等: "Research on Relative Navigation Algorithm for UAV Autonomous Aerial Refueling Rendezvous Phase", 《PROCEEDINGS OF 2016 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 * |
张欣: "多旋翼无人机的姿态与导航信息融合算法研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115145294A (zh) * | 2022-06-30 | 2022-10-04 | 西北工业大学 | 一种用于自主空中加油对接的组合导航系统和方法 |
CN115145294B (zh) * | 2022-06-30 | 2024-05-07 | 西北工业大学 | 一种用于自主空中加油对接的组合导航系统和方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106123921B (zh) | 动态干扰条件下捷联惯导系统的纬度未知自对准方法 | |
CN102538781B (zh) | 基于机器视觉和惯导融合的移动机器人运动姿态估计方法 | |
CN107656301A (zh) | 一种基于多源信息融合的车载定位方法 | |
CN106871928A (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN104764467B (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN101858748A (zh) | 高空长航无人机的多传感器容错自主导航方法 | |
CN106595668A (zh) | 一种用于光电吊舱的无源定位算法 | |
CN101900573B (zh) | 一种实现陆用惯性导航系统运动对准的方法 | |
CN109059909A (zh) | 基于神经网络辅助的卫星/惯导列车定位方法与系统 | |
CN109471144A (zh) | 基于伪距/伪距率的多传感器紧组合列车组合定位方法 | |
CN105783943A (zh) | 一种基于无迹卡尔曼滤波的极区环境下舰船大方位失准角传递对准方法 | |
CN108151737A (zh) | 一种动态互观测关系条件下的无人机蜂群协同导航方法 | |
CN108303079B (zh) | 一种水下usbl反向应用的数据平滑方法 | |
CN103047999A (zh) | 一种舰载主/子惯导传递对准过程中的陀螺误差快速估计方法 | |
CN202209953U (zh) | 用于水下载体的地磁辅助惯性导航系统 | |
US20180172841A1 (en) | Positioning apparatus | |
CN107289942A (zh) | 一种用于编队飞行的相对导航系统及方法 | |
CN109931955A (zh) | 基于状态相关李群滤波的捷联惯性导航系统初始对准方法 | |
CN102519485A (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN102168978B (zh) | 一种船用惯性导航系统摇摆基座开环对准方法 | |
CN104697520A (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN109084760A (zh) | 一种楼宇间导航系统 | |
CN104949687A (zh) | 一种长时间导航系统全参数精度评估方法 | |
CN105021212A (zh) | 一种初始方位信息辅助下潜航器快速传递对准方法 | |
CN109781096A (zh) | 一种用于智能农机的组合导航定位系统和方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20171020 |
|
RJ01 | Rejection of invention patent application after publication |