CN107289942A - 一种用于编队飞行的相对导航系统及方法 - Google Patents

一种用于编队飞行的相对导航系统及方法 Download PDF

Info

Publication number
CN107289942A
CN107289942A CN201710467512.2A CN201710467512A CN107289942A CN 107289942 A CN107289942 A CN 107289942A CN 201710467512 A CN201710467512 A CN 201710467512A CN 107289942 A CN107289942 A CN 107289942A
Authority
CN
China
Prior art keywords
relative
gps
sins
wave filter
data
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.)
Granted
Application number
CN201710467512.2A
Other languages
English (en)
Other versions
CN107289942B (zh
Inventor
朱云峰
孙永荣
赵伟
李旺灵
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201710467512.2A priority Critical patent/CN107289942B/zh
Publication of CN107289942A publication Critical patent/CN107289942A/zh
Application granted granted Critical
Publication of CN107289942B publication Critical patent/CN107289942B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明公开了一种用于编队飞行的相对导航系统及方法,采用捷联惯导系统(SINS)与卫星定位系统(GPS)组合的方式,在飞机上分别安装SINS导航系统、GPS导航系统以及数据链通信系统,飞机间通过数据链进行数据传输。本发明中首先利用本机上的GPS信息校正SINS的信息,得到飞机的绝对定位结果,并对陀螺仪与加速度计的输出进行修正,再用飞机间GPS差分信息估计相对状态的误差,提高相对导航结果的精度;每架飞机不仅拥有局部融合滤波器,还有相对状态滤波器,融合系统采用全并行的分布式结构,进行并行处理,保证导航解算的实时性。

Description

一种用于编队飞行的相对导航系统及方法
技术领域
本发明属于相对导航与组合导航领域,尤其涉及一种用于编队飞行的相对导航系统及方法。
背景技术
获取高精度的相对导航信息是编队飞行中的关键问题。为了保证飞行任务的完成,对相对导航算法的实时性、精确性以及可靠性提出了非常高的要求。
国内外在SINS/GPS的相对导航算法上大多数都采用集中滤波的方法,所有数据都送到一架飞机上进行融合,采用一个滤波器作为唯一的融合中心。
传统方法通过飞机间的运动关系构建相对状态误差方程,用GPS差分信息构造量测方程,通过滤波得到相对导航信息。传统方法的缺点在于状态方程中需要用到两套陀螺仪的角速度以及加速度计的比力数据,并且还需要用到两套惯导输出的位置速度和姿态信息。惯性导航系统的特点在于短时高精度,但导航结果随时间发散。因此,状态转移矩阵本身是带有误差的,而且呈发散趋势。这就造成了滤波模型的不准确。并且传统方法大多没有设置反馈回路,属于开环系统。同时以往较多采用的单融合中心的结构也不能满足编队飞行对实时性与数据共享的任务要求。
发明内容
发明目的:针对以上问题,本发明提出一种用于编队飞行的相对导航系统及方法。
技术方案:为实现本发明的目的,本发明所采用的技术方案是:一种用于编队飞行的相对导航系统,包括N架飞机,每架飞机上均安装SINS、GPS以及数据链通信系统,飞机间通过数据链传递相关数据。
一种用于编队飞行的相对导航方法,具体包括:
(1)飞机上安装SINS、GPS以及数据链通信系统,飞机间通过数据链传递相关数据;
(2)采用全并行的分布式结构;每架飞机为一个多传感器平台,包括局部融合滤波器和相对状态滤波器;每架飞机都可作为一个融合中心,解算得到与编队中任一飞机的相对位置、姿态和速度,全并行处理,保证实时性。
局部融合滤波器具体工作为:
(1)采用SINS与GPS紧组合的方式,利用GPS信息校正SINS的信息,得到绝对定位结果;
(2)用卡尔曼滤波的估计结果修正陀螺仪和加速度计输出的角速度和比力;
(3)局部融合滤波器修正后的角速度和比力、GPS量测以及局部融合滤波器解算得到的绝对位置,送往数据链与其他飞机共享。
相对状态滤波器具体工作为:
(1)每架飞机为一个融合中心,利用GPS载波相位差分信息,估计相对状态的误差,从而校正相对导航状态;
(2)状态方程采用相对惯性状态误差微分方程,量测为GPS载波相位差分的解算结果与相对导航状态的差值;
(3)采用卡尔曼滤波算法,估计飞机之间的相对导航状态误差;
(4)用卡尔曼滤波算法,得到陀螺仪漂移量和加速度计漂移量的误差值,用于校正角速度和比力,形成闭环系统。
有益效果:本发明充分应用GPS信息源,不仅可以得到更高精度的单架飞机的绝对导航信息,而且可以直接校正惯性器件的输出。由于SINS/GPS组合的结果是收敛的,因此保证相对状态误差模型的精度和收敛性,使得状态转移矩阵的精度更高,模型更准确。
本发明采用全并行的分布式融合结构,每架飞机作为一个多传感器平台,既有局部融合滤波器,又有相对状态滤波器。每架飞机都可以解算得到与编队中任一飞机的相对位置、姿态和速度,因此每架飞机都可以看作是一个融合中心,并且全并行处理,保证实时性。
附图说明
图1是本发明的相对导航系统的结构框图;
图2是相对导航方法的相对位置误差仿真图;
图3是相对导航方法的相对速度误差仿真图;
图4是相对导航方法的相对姿态误差仿真图。
具体实施方式
下面结合附图和实施例对本发明的技术方案作进一步的说明。
如图1所示是本发明所述的相对导航系统的结构框图,飞机上安装SINS、GPS以及数据链通信系统,飞机间通过数据链传递相关数据。
系统采用全并行的分布式结构,每架飞机作为一个多传感器平台,既有局部融合滤波器,又有相对状态滤波器。每架飞机都可以解算得到与编队中任一飞机的相对位置、姿态和速度,因此每架飞机都可以看作是一个融合中心,并且全并行处理,保证实时性。
局部融合滤波器采用SINS与GPS紧组合的方式,利用GPS信息校正SINS的信息,得到更好的绝对定位结果,同时修正陀螺仪和加速度计的输出。由于局部融合滤波器的存在,大大提高了相对状态误差模型的精度,有效地抑制解算结果的发散。GPS量测、局部融合滤波器修正后的角速度和比力、以及局部融合滤波器解算得到的绝对位置,都会送往数据链,与其他飞机共享。
每架飞机都有相对状态滤波器,因此每架飞机都可以作为融合中心。相对状态滤波器总体思路:利用GPS载波相位差分信息,通过滤波算法估计出相对导航状态的误差,从而校正相对导航状态。状态方程采用相对惯性状态误差微分方程,量测选择GPS载波相位差分结果与相对导航状态之差。采用卡尔曼滤波,估计飞机之间的相对导航状态误差,并得到陀螺仪漂移量和加速度计漂移量的误差值,用于校正角速度和比力,形成闭环系统。
以双机结构为例讨论相对状态滤波器的建立,具体如下:
(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)量测方程。
GPS相对量测值利用无基站的载波相位差方法解算得到,记为:
量测方程为:
整理后,记为:
ΔZ(k)=H(k)ΔX(k)+V(k)
其中,V(k)是均值为0的高斯白噪声。
(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)
通过卡尔曼滤波算法,估计得到相对状态的误差,记为用于修正相对导航状态以及角速度、比力。
对系统进行仿真,得到如图2、图3和图4所示的仿真图。仿真条件设置为:陀螺仪:[常值漂移,马尔可夫过程,相关时间]=[0.01,0.01,3600.0](单位:度/小时,度/小时,秒);加速度计:[马尔可夫过程,相关时间]=[0.001*g,3600.0](单位:米/秒/秒,秒);GPS:定位精度:[10,10,10](单位:米,米,米),速度精度:[0.2,0.2,0.2](单位:米/秒,米/秒,米/秒);惯导系统的数据输出频率为10Hz,GPS的数据输出频率为2Hz;飞机t为匀速直线飞行,飞机u飞行过程为先匀速直线后爬升再匀速直线飞行。
其中,图2是相对导航方法的相对位置误差仿真图;图3是相对导航方法的相对速度误差仿真图;图4是相对导航方法的相对姿态误差仿真图。
本发明的相对导航方法,采用捷联惯性导航系统与GPS组合的方式,在系统框架上采用全并行分布式的融合结构,先用各架飞机上安装的GPS的量测先去校正其捷联惯导的系统的误差,得到更高精度的位置、速度、姿态信息,并且修正陀螺仪和加表的输出。然后再用GPS载波相位差分信息估计相对导航状态误差。该方案可以实时地提供高精度的相对导航信息,相较于传统方法而言,精度更高,并有效地抑制输出的发散。

Claims (4)

1.一种用于编队飞行的相对导航系统,其特征在于:包括N架飞机,每架飞机上均安装SINS、GPS以及数据链通信系统,飞机间通过数据链传递相关数据。
2.一种用于编队飞行的相对导航方法,其特征在于:具体包括:
(1)飞机上安装SINS、GPS以及数据链通信系统,飞机间通过数据链传递相关数据;
(2)采用全并行的分布式结构;每架飞机为一个多传感器平台,包括局部融合滤波器和相对状态滤波器;每架飞机都可以作为一个融合中心,解算得到与编队中任一飞机的相对位置、姿态和速度,全并行处理,保证实时性。
3.根据权利要求2所述的用于编队飞行的相对导航方法,其特征在于:
所述局部融合滤波器具体工作为:
(1)采用SINS与GPS紧组合的方式,利用GPS信息校正SINS的信息,得到绝对定位结果;
(2)用卡尔曼滤波的估计结果修正陀螺仪和加速度计输出的角速度和比力;
(3)局部融合滤波器修正后的角速度与比力、GPS量测以及局部融合滤波器解算得到的绝对位置,通过数据链发送给其他飞机。
4.根据权利要求2所述的用于编队飞行的相对导航方法,其特征在于:
所述相对状态滤波器具体工作为:
(1)每架飞机为一个融合中心,利用GPS载波相位差分信息,估计相对状态的误差,从而校正相对导航状态;
(2)状态方程采用相对惯性状态误差微分方程,量测为GPS载波相位差分的解算结果与相对导航状态的差值;
(3)采用扩展卡尔曼进行滤波,估计飞机之间的相对导航状态误差;
(4)用卡尔曼滤波算法,估计陀螺仪漂移量和加速度计漂移量的误差值,用于校正角速度和比力,形成闭环系统。
CN201710467512.2A 2017-06-20 2017-06-20 一种用于编队飞行的相对导航系统及方法 Active CN107289942B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710467512.2A CN107289942B (zh) 2017-06-20 2017-06-20 一种用于编队飞行的相对导航系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710467512.2A CN107289942B (zh) 2017-06-20 2017-06-20 一种用于编队飞行的相对导航系统及方法

Publications (2)

Publication Number Publication Date
CN107289942A true CN107289942A (zh) 2017-10-24
CN107289942B CN107289942B (zh) 2020-11-03

Family

ID=60097360

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710467512.2A Active CN107289942B (zh) 2017-06-20 2017-06-20 一种用于编队飞行的相对导航系统及方法

Country Status (1)

Country Link
CN (1) CN107289942B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109813311A (zh) * 2019-03-18 2019-05-28 南京航空航天大学 一种无人机编队协同导航方法
CN110207691A (zh) * 2019-05-08 2019-09-06 南京航空航天大学 一种基于数据链测距的多无人车协同导航方法
CN110598184A (zh) * 2019-09-18 2019-12-20 南京山鹞航空科技有限公司 一种编队复合跟踪系统数据注册误差校准方法
CN111044075A (zh) * 2019-12-10 2020-04-21 上海航天控制技术研究所 基于卫星伪距/相对测量信息辅助的sins误差在线修正方法
CN111708377A (zh) * 2020-06-21 2020-09-25 西北工业大学 基于惯导/飞控系统信息融合的飞行控制方法
CN112034871A (zh) * 2020-08-25 2020-12-04 南京航空航天大学 一种可倾转多旋翼飞行器的全向控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102636798A (zh) * 2012-04-12 2012-08-15 南京航空航天大学 基于环路状态自检测的sins/gps深组合导航方法
CN105786015A (zh) * 2016-03-28 2016-07-20 安徽大学 基于Arkbird A飞控系统的无人机编队控制系统及控制方法
CN106094862A (zh) * 2016-06-22 2016-11-09 陕西宝成航空仪表有限责任公司 无人机编队飞行通信控制的实现方法
CN106569504A (zh) * 2015-10-09 2017-04-19 内蒙古信源信息技术有限公司 一种通过北斗旋翼无人机实现偏远地区设备信息采集的装置和数据交互方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102636798A (zh) * 2012-04-12 2012-08-15 南京航空航天大学 基于环路状态自检测的sins/gps深组合导航方法
CN106569504A (zh) * 2015-10-09 2017-04-19 内蒙古信源信息技术有限公司 一种通过北斗旋翼无人机实现偏远地区设备信息采集的装置和数据交互方法
CN105786015A (zh) * 2016-03-28 2016-07-20 安徽大学 基于Arkbird A飞控系统的无人机编队控制系统及控制方法
CN106094862A (zh) * 2016-06-22 2016-11-09 陕西宝成航空仪表有限责任公司 无人机编队飞行通信控制的实现方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
ZHU YUNFENG,SUN YONGRONG,HUANG BIN,LI RONGBING,WU LING: "Research on Relative Navigation Algorithm for UAV Autonomous Aerial Refueling Rendezvous Phase", 《PROCEEDINGS OF 2016 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109813311A (zh) * 2019-03-18 2019-05-28 南京航空航天大学 一种无人机编队协同导航方法
CN110207691A (zh) * 2019-05-08 2019-09-06 南京航空航天大学 一种基于数据链测距的多无人车协同导航方法
CN110598184A (zh) * 2019-09-18 2019-12-20 南京山鹞航空科技有限公司 一种编队复合跟踪系统数据注册误差校准方法
CN110598184B (zh) * 2019-09-18 2020-04-28 南京山鹞航空科技有限公司 一种编队复合跟踪系统数据注册误差校准方法
CN111044075A (zh) * 2019-12-10 2020-04-21 上海航天控制技术研究所 基于卫星伪距/相对测量信息辅助的sins误差在线修正方法
CN111044075B (zh) * 2019-12-10 2023-09-15 上海航天控制技术研究所 基于卫星伪距/相对测量信息辅助的sins误差在线修正方法
CN111708377A (zh) * 2020-06-21 2020-09-25 西北工业大学 基于惯导/飞控系统信息融合的飞行控制方法
CN111708377B (zh) * 2020-06-21 2022-10-25 西北工业大学 基于惯导/飞控系统信息融合的飞行控制方法
CN112034871A (zh) * 2020-08-25 2020-12-04 南京航空航天大学 一种可倾转多旋翼飞行器的全向控制方法
CN112034871B (zh) * 2020-08-25 2022-05-24 南京航空航天大学 一种可倾转多旋翼飞行器的全向控制方法

Also Published As

Publication number Publication date
CN107289942B (zh) 2020-11-03

Similar Documents

Publication Publication Date Title
CN107289942A (zh) 一种用于编队飞行的相对导航系统及方法
CN110207697B (zh) 基于角加速度计/陀螺/加速度计的惯性导航解算方法
CN105606094B (zh) 一种基于mems/gps组合系统的信息条件匹配滤波估计方法
CN106052716B (zh) 惯性系下基于星光信息辅助的陀螺误差在线标定方法
CN104764467B (zh) 空天飞行器惯性传感器误差在线自适应标定方法
CN104698486B (zh) 一种分布式pos用数据处理计算机系统实时导航方法
CN106989761B (zh) 一种基于自适应滤波的空间飞行器制导工具在轨标定方法
CN106767797B (zh) 一种基于对偶四元数的惯性/gps组合导航方法
CN108387227A (zh) 机载分布式pos的多节点信息融合方法及系统
RU2380656C1 (ru) Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах
CN107764261B (zh) 一种分布式pos传递对准用模拟数据生成方法和系统
CN104713559B (zh) 一种高精度sins模拟器的设计方法
CN110849360B (zh) 面向多机协同编队飞行的分布式相对导航方法
CN103557864A (zh) Mems捷联惯导自适应sckf滤波的初始对准方法
Hansen et al. Nonlinear observer design for GNSS-aided inertial navigation systems with time-delayed GNSS measurements
CN110440830A (zh) 动基座下车载捷联惯导系统自对准方法
ITTO20060107A1 (it) Apparecchiatura di pilotaggio automatico per un aeromobile a velatura rotante
CN103175528A (zh) 基于捷联惯导系统的捷联罗经姿态测量方法
CN105606093B (zh) 基于重力实时补偿的惯性导航方法及装置
CN113340298A (zh) 一种惯导和双天线gnss外参标定方法
CN108627152A (zh) 一种微型无人机基于多传感器数据融合的导航方法
CN109084756B (zh) 一种重力视运动参数辨识与加速度计零偏分离方法
RU2382988C1 (ru) Бесплатформенная инерциальная система ориентации на "грубых" чувствительных элементах
CN105300407B (zh) 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法
CN111141285B (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
GR01 Patent grant
GR01 Patent grant