CN111238530B - 一种捷联惯性导航系统空中动基座初始对准方法 - Google Patents
一种捷联惯性导航系统空中动基座初始对准方法 Download PDFInfo
- Publication number
- CN111238530B CN111238530B CN201911179003.5A CN201911179003A CN111238530B CN 111238530 B CN111238530 B CN 111238530B CN 201911179003 A CN201911179003 A CN 201911179003A CN 111238530 B CN111238530 B CN 111238530B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- measurement
- angular
- inertial navigation
- angular velocity
- 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 31
- 238000005259 measurement Methods 0.000 claims abstract description 62
- 230000008569 process Effects 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 30
- 230000009466 transformation Effects 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical group 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 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 125000004432 carbon atom Chemical group C* 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种捷联惯性导航系统空中动基座初始对准方法,步骤:基于捷联惯性导航系统解算速度与GNSS测量速度的差值作为一组量测量建立速度量测方程;建立飞行器的角运动约束模型,基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程,并在飞行器空中运动过程中,对角运动模式进行实时判别,判断其是否处于非角运动状态;当检测到飞行器处于非角运动状态时,引入建立的角速度约束模型,联合角速度虚拟量测方程与速度量测方程进行量测更新;当检测到飞行器处于角运动状态时,仅采用速度量测方程进行量测更新。本发明在不增加辅助传感器的前提下,提升各种机动情况下的机载捷联惯性导航系统空中对准精度、快速性等综合性能。
Description
技术领域
本发明属于惯性导航技术领域,特别涉及了一种动基座初始对准方法。
背景技术
对于采用GNSS/INS组合导航的运载体,如果能充分利用组合导航系统中GNSS的信息对惯性导航系统进行初始化,则可以减小系统对载体的依赖,实现自主对准。由于载体任务、环境的不同,往往需要在不同的机动下完成初始对准:某些系统如瞄准吊舱系统初始对准需要在地面启动或起飞阶段实现,机动方式受到严格限制;某些系统(如飞行器)若在航行中发生故障需要重启,便需要在空中高动态飞行条件下完成初始对准。在低机动情况下,收敛速度较快,但是方位失准角可观测度较低,导致方位失准角的对准精度较低;在高机动情况下,方位失准角可观测性得到提高,但机动运动同时也会影响系统的线性,对数据融合滤波器(如卡尔曼滤波器)的估计效果产生一定的负面影响,对准的快速性和精度受到影响。如何综合提高载机各种机动情况下的对准精度和快速性,是初始对准领域亟需解决的问题。
运动学约束辅助导航是一种新型的飞行器导航方法,它通过将飞行器的运动信息与现有的导航系统信息相融合,来有效提高导航系统的导航精度与可靠性。该方法无需增加额外的传感器,具有自主性强、成本低和零载重等优点。Dissanayake等针对低精度INS/GNSS组合系统,提出了运动约束的思想,即当载体在地面上运动且没有侧滑时,载体侧向和垂向速度为0。目前运动学约束辅助导航的研究多针对载体在地面运动的情况,但是空中飞行的飞机,由于迎角和侧滑角的存在,即使在飞机直线飞行的情况下,机体坐标系的侧向和垂向速度也不为零,地面运动中的速度约束、高度约束等条件在空中均不再适用。
发明内容
为了解决上述背景技术提到的技术问题,本发明提出了一种捷联惯性导航系统空中动基座初始对准方法。
为了实现上述技术目的,本发明的技术方案为:
一种捷联惯性导航系统空中动基座初始对准方法,包括以下步骤:
(1)基于捷联惯性导航系统解算速度与GNSS测量速度的差值作为一组量测量建立速度量测方程;
(2)建立飞行器的角运动约束模型,基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程,并在飞行器空中运动过程中,对角运动模式进行实时判别,实时判断出其是否处于非角运动状态;
(3)当检测到飞行器处于非角运动状态时,引入步骤(2)建立的角速度约束模型,将步骤(2)中的角速度虚拟量测方程联合步骤(1)中的速度量测方程进行量测更新;当检测到飞行器处于角运动状态时,仅采用步骤(1)中的速度量测方程进行量测更新。
进一步地,在步骤(1)中,所述速度量测方程如下:
其中,Zv(t)为速度量测量,vIE、vIN、vIU为捷联惯性导航系统解算的导航坐标系各轴的速度,δvE、δvN、δvU为捷联光写导航系统的速度误差,vGE、vGN、vGU为GNSS测量的导航坐标系各轴的速度,ME、MN、MU为GNSS接收机的测速误差,Hv(t)为量测系数矩阵,X(t)为捷联惯性导航系统的状态向量,Vv(t)为量测噪声向量。
进一步地,在步骤(2)中,飞机的角运动约束模型如下:
其中,为机体坐标系相对于导航坐标系的角速度误差在机体坐标系下投影,是导航坐标系到机体坐标系的姿态转换矩阵,为导航坐标系相对于惯性坐标系的角速度误差在导航坐标系下的投影,为导航坐标系相对于惯性坐标系的角速度在导航坐标系下的投影,φ为计算导航坐标系相对于导航坐标系的平台失准角,φ×表示φ的反对称矩阵。
进一步地,在步骤(2)中,所述虚拟量测方程如下:
其中,Zω(t)为角速度量测量,为捷联惯导系统解算的机体坐标系下各轴的角速度,为捷联惯导系统解算的机体坐标系下各轴的角速度误差,Hω(t)为量测系数矩阵,X(t)为捷联惯性导航系统的状态向量,Vω(t)为量测噪声向量。
进一步地,所述量测系数矩阵Hω(t)的具体形式如下:
其中:
01×10表示1×10的零矩阵,
i=1,2,3;j=1,2,3是导航坐标系到机体坐标系的姿态转换矩阵中的各元素;是导航坐标系相对于惯性坐标系的角速率在导航坐标系下的投影沿着机体坐标系三个轴的分量;Rm为地球子午圈半径,Rn为地球卯酉圈半径,L为当地纬度,h为当地海拔高度。
进一步地,在步骤(2)中,所述角运动模式判别方法如下:
(1)在角速度虚拟量测方程中,计算实际角速度量测值与预测角速度量测值之间的残差rω,k;
(3)构建模式检测函数:
设定阈值TD,当λω,k<TD时,则判定飞行器处于非角运动状态;当λω,k≥TD时,则判定飞行器处于角运动状态。
采用上述技术方案带来的有益效果:
1、本发明基于飞行器的角运动约束模型,进行运动模式判别,构造虚拟量测方程辅助GNSS进行空中动基座对准。在载体低机动情况下提高动基座对准的精度,在载体高机动情况下提高动基座对准的快速性,满足各种机动情况下的机载捷联惯性导航系统空中对准精度、快速性等综合需求。在GNSS失效时,本发明也可有效地抑制惯性导航系统的发散趋势,提高导航精度。
2、本发明中不需要增加额外设备,具有使用成本低、自主性强等特点,是一种较好的利用载体运动学信息进行空中动基座对准的方法。
附图说明
图1是本发明的方法流程图。
具体实施方式
以下将结合附图,对本发明的技术方案进行详细说明。
一种捷联惯性导航系统空中动基座初始对准方法,如图1所示,包括以下步骤:
步骤1:基于捷联惯性导航系统解算速度与GNSS测量速度的差值作为一组量测量建立速度量测方程;
步骤2:建立飞行器的角运动约束模型,基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程,并在飞行器空中运动过程中,对角运动模式进行实时判别,实时判断出其是否处于非角运动状态;
步骤3:当检测到飞行器处于非角运动状态时,引入步骤2建立的角速度约束模型,将步骤2中的角速度虚拟量测方程联合步骤1中的速度量测方程进行量测更新;当检测到飞行器处于角运动状态时,仅采用步骤1中的速度量测方程进行量测更新。
在本实施例中,上述步骤可以采用如下优选方案实现:
首先选取捷联惯导系统的数学平台失准角φE、φN、φU,速度误差δvE、δvN、δvU,陀螺随机常值漂移εbx、εby、εbz,陀螺一阶马尔可夫过程εrx、εry、εrz,加速度计一阶马尔可夫过程为对准滤波的状态量:
则状态方程为:
上式中,X(t)为状态向量;A(t)为状态转移矩阵;G(t)为系统噪声系数矩阵;W(t)为系统噪声向量。
惯性导航系统的速度信息vI=[vIE vIN vIU]和GNSS的速度信息vG=[vGE vGN vGU]可分别表示为:
上式中,vE0、vN0、vU0是飞行器沿导航坐标系各轴的真实速度;δvE、δvN、δvU是惯性导航系统解算的速度误差;ME、MN、MU为GNSS接收机测速误差,可视为白噪声。
则速度量测方程为:
上式中,Hv(t)=[03×3 diag[1 1 1] 03×9]为量测系数矩阵,03×3为3×3的零矩阵,03×9为3×9的零矩阵,Vv(t)为量测噪声向量,近似为白噪声。
建立飞行器的角运动约束模型,具体为:根据陀螺仪的实际输出,借助计算坐标系c系,c系相对n系存在数学平台失准角φ=[φE φN φU]T,其中φE、φN、φU分别东向、北向和天向平台失准角,该坐标系表示带有计算误差的计算导航坐标系。推导得出机体坐标系下的角速度误差与平台失准角之间的关系,建立飞机角运动约束模型。包括以下步骤:
其中,为陀螺仪实际输出的角速度,是导航坐标系相对于惯性坐标系的角速度在机体坐标系下投影,为机体坐标系相对于导航坐标系的角速度在机体坐标系下投影。是导航坐标系到机体坐标系的姿态转换矩阵,是地球自转角速度,是导航坐标系相对于地球坐标系的角速度在导航坐标系下投影,是导航坐标系相对于惯性坐标系的角速度在导航坐标系下投影。
对等式两端取导数,但等式右端不能直接进行求导,需借助计算坐标系c。c系相对n系存在数学平台失准角φ=[φE φN φU]T,其中φE、φN、φU分别东向、北向和天向平台失准角,该坐标系表示带有计算误差的计算导航坐标系。
从而得到:
其中,是机体坐标系下的角速度误差,是计算导航系到机体坐标系的姿态转换矩阵,是计算导航系到导航坐标系的姿态转换矩阵,是计算导航坐标系相对于惯性坐标系的角速度在计算导航坐标系下投影,是导航坐标系相对于惯性坐标系的角速度误差在导航坐标系下的投影。
c系相对n系的失准角φ通常是一个小角度,故可以采用一阶近似。则可以推导求得:
将式(6)带入式(5),可展开为:
将式(4)带入式(7),对比等式两边的变量,并忽略二阶小量可得:
当载体处于非角运动状态时,地球自转和载体在地球表面运动所产生的角速度分量量级较小,可认为机体坐标系相对于导航坐标系的角速度近似为零。而捷联惯导系统导航解算得到的角速度实际值,由于误差的存在并不为零。因此,可将机载捷联惯导系统解算得到的角速度实际值在机体坐标系x、y、z轴上投影作为动基座对准的虚拟量测信息,并将地球自转和载体在地球表面运动所产生的角速度分量视为量测信息的噪声信息进行处理。
则可通过式(9)构建运动约束虚拟量测方程,如式(10)所示。
其中,(i=1,2,3;j=1,2,3)是导航坐标系到机体坐标系的姿态转换矩阵的各元素;是导航坐标系相对于惯性坐标系的角速度在导航坐标系下的投影沿着机体坐标系三个轴的分量;Rm为地球子午圈半径,Rn为地球卯酉圈半径,L为当地纬度,h为当地海拔高度。
对角运动模式进行实时判别,具体为:
飞机角运动带来的实际角速度将通过量测残差向量对滤波器产生很大影响,甚至导致滤波发散。其方差为:
其中Pk/k-1为一步预测均方误差阵,Rω,k为k时刻的量测噪声方差阵。
当飞机直线运动时,残差rω,k较小,当飞机姿态发生变化时,残差rω,k急剧增大。因此,通过对残差rω,k的均值进行检验即可判别飞机的角运动模式。
b、构建模式检测函数:
对飞机的角运动数据进行预分析,选择适当的阈值TD,当λω,k<TD时,则判定飞机处于非角运动状态,运动约束有效,引入角速度约束模型,捷联惯性导航系统解算的角速度作为虚拟量测信息,联合步骤1中GNSS信息进行量测更新;当λω,k≥TD时,则判定飞机处于角运动状态时,运动约束无效,仅采用步骤1中GNSS信息进行量测更新。
根据步骤3中角运动模式判别的结果,当检测到飞机在直线飞行模式,引入角速度约束模型,捷联惯性导航系统解算的角速度作为虚拟量测信息,联合步骤1中GNSS信息进行量测更新:式(3)和式(10)构成共同量测方程,利用Zv(t)和Zω(t)进行量测更新,联合式(1)状态方程,通过滤波器即可对状态量进行滤波估计,精确估算出惯性导航系统初始姿态误差角,从而实现高精度的空中动基座对准。当检测到飞机不是直线飞行模式,则仅采用步骤1中GNSS信息进行量测更新,将式(3)作为量测方程,联合式(1)状态方程,通过滤波器即可对状态量进行滤波估计,估算出惯性导航系统初始姿态误差角。
实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (6)
1.一种捷联惯性导航系统空中动基座初始对准方法,其特征在于,包括以下步骤:
(1)基于捷联惯性导航系统解算速度与GNSS测量速度的差值作为一组量测量建立速度量测方程;
(2)建立飞行器的角运动约束模型,基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程,并在飞行器空中运动过程中,对角运动模式进行实时判别,实时判断出其是否处于非角运动状态;
(3)当检测到飞行器处于非角运动状态时,引入步骤(2)建立的角速度约束模型,将步骤(2)中的角速度虚拟量测方程联合步骤(1)中的速度量测方程进行量测更新;当检测到飞行器处于角运动状态时,仅采用步骤(1)中的速度量测方程进行量测更新。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911179003.5A CN111238530B (zh) | 2019-11-27 | 2019-11-27 | 一种捷联惯性导航系统空中动基座初始对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911179003.5A CN111238530B (zh) | 2019-11-27 | 2019-11-27 | 一种捷联惯性导航系统空中动基座初始对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111238530A CN111238530A (zh) | 2020-06-05 |
CN111238530B true CN111238530B (zh) | 2021-11-23 |
Family
ID=70866315
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911179003.5A Active CN111238530B (zh) | 2019-11-27 | 2019-11-27 | 一种捷联惯性导航系统空中动基座初始对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111238530B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101900573A (zh) * | 2010-07-15 | 2010-12-01 | 北京理工大学 | 一种实现陆用惯性导航系统运动对准的方法 |
CN102706366A (zh) * | 2012-06-19 | 2012-10-03 | 北京航空航天大学 | 一种基于地球自转角速率约束的sins初始对准方法 |
CN102901514A (zh) * | 2012-09-25 | 2013-01-30 | 北京航空航天大学 | 一种基于多惯组信息约束的协同初始对准方法 |
CN109579870A (zh) * | 2017-04-25 | 2019-04-05 | 广州市泰斗鑫信息科技有限公司 | 捷联惯导系统的自动对准方法和组合导航装置 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6456939B1 (en) * | 2000-01-04 | 2002-09-24 | Mccall Hiram | Micro inertial measurement unit |
EP1257783A1 (en) * | 2000-01-12 | 2002-11-20 | American GNC Corporation | Micro inertial measurement unit |
US20030033850A1 (en) * | 2001-08-09 | 2003-02-20 | Challoner A. Dorian | Cloverleaf microgyroscope with electrostatic alignment and tuning |
CN100593689C (zh) * | 2006-05-26 | 2010-03-10 | 南京航空航天大学 | 基于捷联惯性导航系统的姿态估计和融合的方法 |
CN101949710B (zh) * | 2010-07-28 | 2013-01-02 | 北京泰豪联星技术有限公司 | Gnss辅助mems惯性传感器零偏的快速在线动态标定方法 |
CN108594283B (zh) * | 2018-03-13 | 2022-04-29 | 北京沙谷科技有限责任公司 | Gnss/mems惯性组合导航系统的自由安装方法 |
CN108844533B (zh) * | 2018-04-24 | 2021-01-19 | 西安交通大学 | 一种基于多传感器融合和姿态解算的自由姿态pdr定位方法 |
CN108871323B (zh) * | 2018-04-25 | 2021-08-24 | 珠海全志科技股份有限公司 | 一种低成本惯性传感器在机动环境下的高精度导航方法 |
-
2019
- 2019-11-27 CN CN201911179003.5A patent/CN111238530B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101900573A (zh) * | 2010-07-15 | 2010-12-01 | 北京理工大学 | 一种实现陆用惯性导航系统运动对准的方法 |
CN102706366A (zh) * | 2012-06-19 | 2012-10-03 | 北京航空航天大学 | 一种基于地球自转角速率约束的sins初始对准方法 |
CN102901514A (zh) * | 2012-09-25 | 2013-01-30 | 北京航空航天大学 | 一种基于多惯组信息约束的协同初始对准方法 |
CN109579870A (zh) * | 2017-04-25 | 2019-04-05 | 广州市泰斗鑫信息科技有限公司 | 捷联惯导系统的自动对准方法和组合导航装置 |
Non-Patent Citations (2)
Title |
---|
基于模式判别的运动学约束辅助空中动基座对准方法;赵宾等;《中国惯性技术学报》;《中国惯性技术学报》编辑部;20191031;第27卷(第5期);第561-567页 * |
基于运动学约束模型辅助的井下人员定位系统研究;高春雷等;《煤炭技术》;20190630;第38卷(第06期);第170-172页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111238530A (zh) | 2020-06-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110487301B (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
CN111156994B (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN112629538B (zh) | 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法 | |
Huang et al. | A new fast in-motion coarse alignment method for GPS-aided low-cost SINS | |
CN102692225B (zh) | 一种用于低成本小型无人机的姿态航向参考系统 | |
CN101413800B (zh) | 导航/稳瞄一体化系统的导航、稳瞄方法 | |
CN105698822B (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN111121766B (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN107806874B (zh) | 一种视觉辅助的捷联惯导极区初始对准方法 | |
CN105928515B (zh) | 一种无人机导航系统 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN113029139B (zh) | 基于运动检测的机场飞行区车辆差分北斗/sins组合导航方法 | |
CN102654404A (zh) | 一种提高航姿参考系统解算精度和系统抗干扰能力的方法 | |
CN111024074B (zh) | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 | |
CN103697894A (zh) | 基于滤波器方差阵修正的多源信息非等间隔联邦滤波方法 | |
Cui et al. | In-motion alignment for low-cost SINS/GPS under random misalignment angles | |
CN111189442A (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN110954102A (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
CN111220151B (zh) | 载体系下考虑温度模型的惯性和里程计组合导航方法 | |
CN105928519B (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 | |
CN108151765A (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
CN113008229B (zh) | 一种基于低成本车载传感器的分布式自主组合导航方法 | |
CN111238530B (zh) | 一种捷联惯性导航系统空中动基座初始对准方法 | |
CN113834481B (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 |