CN109099911B - 一种航空系统导航定位的方法及系统 - Google Patents

一种航空系统导航定位的方法及系统 Download PDF

Info

Publication number
CN109099911B
CN109099911B CN201810763578.0A CN201810763578A CN109099911B CN 109099911 B CN109099911 B CN 109099911B CN 201810763578 A CN201810763578 A CN 201810763578A CN 109099911 B CN109099911 B CN 109099911B
Authority
CN
China
Prior art keywords
navigation
astronomical
inertial
navigation system
error
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
Application number
CN201810763578.0A
Other languages
English (en)
Other versions
CN109099911A (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.)
Zhejiang Ocean University ZJOU
Original Assignee
Zhejiang Ocean University ZJOU
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 Zhejiang Ocean University ZJOU filed Critical Zhejiang Ocean University ZJOU
Priority to CN201810763578.0A priority Critical patent/CN109099911B/zh
Publication of CN109099911A publication Critical patent/CN109099911A/zh
Application granted granted Critical
Publication of CN109099911B publication Critical patent/CN109099911B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/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
    • 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/24Navigation; 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)
  • Navigation (AREA)

Abstract

本发明公开了一种航空系统导航定位的方法及系统,用以解决传统天文定位精度受限于水平基准的精度,很难实现高精度定位的问题。该方法包括:建立基于地心惯性系的惯导系统;对所述惯导系统进行解算得到载体的惯导解算结果;利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;根据所述投影得到惯性/天文紧组合导航系统的量测信息。本发明充分利用惯导系统和天文导航系统的量测信息获得高精度的数字水平基准,解决现有传统天文导航定位受水平基准制约的问题,导航精度高。

Description

一种航空系统导航定位的方法及系统
技术领域
本发明涉及航天系统导航技术领域,尤其涉及一种航空系统导航定位的方法及系统。
背景技术
天文导航系统是利用自然星体与实践有关的位置信息,借助被动光电探测设备,通过解算确定载体航向、在台和位置的导航设备。
惯性/天文紧组合导航系统作为一个完全自主的黄金组合系统一直以来受到各国的高度重视。现有的惯性/天文紧组合导航系统中,主要利用利用空间六分仪或地平仪直接敏感地平、六分仪观测水平线或者由惯导系统提供水平基准,然后采用高度差法定位,即观测两颗及以上恒星的高度角和方位角后迭代求解,提供给组合导航系统的量测是载体位置。
地平仪(如红外地平仪)的精度目前只能达到0.02°,最终定位精度约为1-3km,利用空间六分仪,天文导航可以得到较高的定位精度,但是该设备过于复杂且成本过高,不利于大范围使用,而且地平仪和空间六分仪只能在太空使用,无法用于大气层内的飞行器及舰船。
目前,国内外惯导平台的水平精度的最高水平为4-8,一般为20-40,基于惯导水平的天文导航的定位精度只能达到海里级。传统天文定位精度受限于水平基准的精度,很难实现高精度定位,可见受水平基准限制已成天文导航技术向高精度方向发展的瓶颈。
发明内容
本发明要解决的技术问题目的在于提供一种航空系统导航定位的方法及系统,用以解决传统天文定位精度受限于水平基准的精度,很难实现高精度定位的问题。
为了实现上述目的,本发明采用的技术方案为:
一种航空系统导航定位的方法,包括步骤:
建立基于地心惯性系的惯导系统;
对所述惯导系统进行解算得到载体的惯导解算结果;
利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;
根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;
根据所述投影得到惯性/天文紧组合导航系统的量测信息。
上述方案中,还包括步骤:
对所述惯性/天文紧组合导航系统进行仿真验证。
上述方案中,所述对所述惯导系统进行解算得到载体的惯导解算结果的步骤,具体包括:
利用陀螺仪量测输出的载体相对于惯性空间的转动角速度和加速度计的量测输出的载体相对于惯性空间的比力,获取惯导设备的的输出数据;
对所述输出数据进行解算获得所述地心惯性系下载体的姿态、速度、位置信息。
上述方案中,所述利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准的步骤,具体包括:
根据所述惯导系统解算出的载体在地心惯性系中位置信息得到包含位置误差的位置矩阵;
利用组合导航滤波器估计位置误差以对所述位置矩阵的误差进行校正;
通过坐标变换和误差补偿,计算得到当地地理系的水平信息;
根据所述当地地理系的水平信息构造高精度数字水平基准。
上述方案中,所述计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影的步骤,具体包括:
利用高度差法计算天文定位经纬度;
根据所述天文定位经纬度得到天文导航系统输出的位置;
结合所述天文导航系统输出的位置和高度计算输出的高度信息获得载体的位置矢量;
根据所述载体的位置矢量得到所述天文导航系统解算出的位置信息在所述惯性坐标系中的投影。
上述方案中,所述根据所述投影得到惯性/天文紧组合导航系统的量测信息的步骤,具体包括:
建立地心惯性系下的惯性/天文紧组合导航系统的状态方程;
通过天文导航系统的测量信息与状态量之间的关系建立组合导航系统的量测方程。
上述方案中,所述建立地心惯性系下的惯性/天文紧组合导航系统的状态方程的步骤,具体包括:
取组合导航系统状态量为惯导的位置误差、速度误差、姿态误差、加速度计量误差和陀螺误差;
根据惯导系统误差方程建立惯性/天文紧组合导航系统的状态方程。
上述方案中,所述通过所述天文导航系统的量测信息与状态量之间的关系得到所述惯性/天文紧组合导航系统的量测方程的步骤,具体包括:
计算惯导解算的姿态矩阵和星敏感器测量的姿态矩阵的姿态矩阵差;
根据所述姿态矩阵差得到惯性/天文紧组合导航系统的姿态量测方程;
将惯导系统解算的位置和天文导航系统解算的位置作为滤波器的量测值;
根据所述滤波器的量测值与组合导航系统状态量之间进行估计后再联立的关系得到所述惯性/天文紧组合导航系统的量测方程。
一种航空系统导航定位的系统,包括:
惯导设备,用于量测惯性导航数据并将惯导数据送入导航计算机;
星敏感器,用于量测天文导航信息并将导航数据送入导航计算机;
导航计算机,用于将导航解算结果发送至上位机;
高度计,用于测量飞行器的高度;
上位机,用于对所述导航计算机进行控制。
上述方案中于,所述导航计算机包括:
建立模块,用于建立基于地心惯性系的惯导系统;
解算模块,用于对所述惯导系统进行解算得到载体的惯导解算结果;
构造模块,用于利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;
判断模块,用于根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;
输出模块,用于根据所述投影得到惯性/天文紧组合导航系统的量测信息;
验证模块,用于对所述惯性/天文紧组合导航系统进行仿真验证。
本发明与传统的技术相比,有如下优点:
本发明充分利用惯导系统和天文导航系统的量测信息获得高精度的数字水平基准,解决现有传统天文导航定位受水平基准制约的问题,导航精度高。
附图说明
图1为本发明一实施例中航空系统导航定位的方法的流程示意图;
图2为本发明一实施例中地心惯性系i下的惯导系统导航算法的流程示意图;
图3为本发明另一实施例中航空系统导航定位的方法的流程示意图;
图4为本发明提出的紧组合方法与传统松方法姿态误差对比曲线;
图5为本发明提出的紧组合方法与传统松方法位置误差对比曲线;
图6为本发明一实施例中航空系统导航定位的系统的结构示意图。
具体实施方式
以下是本发明的具体实施例并结合附图,对本发明的技术方案作进一步的描述,但本发明并不限于这些实施例。
除非另有定义,本文所使用的所有的技术和科学术语与本发明的技术领域技术人员通常理解的含义相同。本文中在本发明说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
本发明实施例提出一种基于高精度数字水平的惯性/天文紧组合导航方法和系统,充分利用惯导系统和天文导航系统的量测信息获得高精度的数字水平基准,解决现有传统天文导航定位受水平基准制约,导航精度不准的问题。
本发明提供的惯性/天文紧组合导航系统,包括惯导设备、星敏感器、导航计算机、高度计和上位机。惯导设备和星敏感器将数据送入导航计算机,导航计算机进行处理后将导航结算结果送入上位机实时显示,上位机同时对导航计算机进行控制。惯导设备包括陀螺仪和加速度计,星敏感器为大视场星敏感器,将PC机或Windows的嵌入式模块作为导航计算机。
请参阅图1,为本发明一实施例中航空系统导航定位的方法的流程示意图,将分别对各个步骤进行说明。
S101、建立基于地心惯性系的惯导系统。
惯导系统,即惯性导航系统,是一种不依赖外部信息,也不向外部辐射能量的自主式导航系统。其工作环境不仅包括空中、地面,还可以在水下。惯导的基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,且把它变换到导航坐标系中,就能够在导航坐标系中的速度、姿态和位置等信息。
不同于一般的利用高度差原理进行天文定位的导航将当地地理坐标系t作为导航坐标系n的方法,本发明将地心惯性系i选作n系,这样星敏感器测量的高精度姿态信息可以直接用于估计校正载体的姿态误差以及陀螺误差,提高姿态精度,而且,建立的惯性/天文紧组合导航系统模型具有简单直观等优点。
S103、对惯导系统进行解算得到载体的惯导解算结果。
其中,步骤S103具体包括:
利用个陀螺仪量测出的载体相对于惯性空间的转动角速和加速度计的量测输出的载体相对于惯性空间的比力,获取惯导设备的输出数据;
对输出数据进行解算获得地心惯性系下载体的姿态、速度、位置信息。
利用陀螺仪量测输出的载体相对于惯性空间的转动角速度
Figure GDA0003253613660000071
和加速度计的量测输出的载体相对于惯性空间的比力
Figure GDA0003253613660000072
其中上标“~”表示量测值。获取到惯导器件的输出数据后,进行导航解算获得地心惯性系i下载体的姿态,速度,位置,信息,一路用于组合导航,另一路用于构造数字水平基准。
地心惯性系i下惯导设备的导航方程可表示为:
Figure GDA0003253613660000073
其中,ri是从地心坐标系原点至载体的位置矢量;vi是速度矢量;fb是比力矢量;gi是地球引力加速度矢量;
Figure GDA0003253613660000074
是载体的姿态矩阵;
Figure GDA0003253613660000075
是航天器角速度的反对称阵,并且
Figure GDA0003253613660000076
Figure GDA0003253613660000077
定义如下:
Figure GDA0003253613660000078
请参见图2,为本发明实施例中地心惯性系i下的惯导系统导航算法的流程示意图。解算出的地心惯性系i下载体的位置ri=(x y z)T和载体相对于地心惯性系i的姿态矩阵
Figure GDA0003253613660000081
惯导系统结算的结果用于构造高精度数字水平基准。
S105、利用惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准。
其中,步骤S105具体包括:
根据惯导系统结算出的载体在地心惯性系中位置信息得到包含位置误差的位置矩阵;
利用组合导航滤波器估计位置误差以对位置矩阵的误差进行校正;
通过坐标变换和误差补偿,计算得到当地地理系的水平信息;
根据当地地理系的水平信息构造高精度数字水平基准。
具体的,惯导系统相对于平台惯导系统,没有物理平台,是通过计算进行姿态变幻得到数字平台,本发明实施例利用地心惯性系下的惯导解算结果以及组合导航滤波器输出的导航误差估计,通过一系列的坐标变换和误差补偿,计算得到当地地理系的水平信息,也就是构造出了高精度的数字水平基准。
利用该惯导系统测量得到的比力及角速度解算出地心惯性系i下飞行器的位置ri=(x y z)T,那么载体在赤道坐标系中的投影为P(r,αd,δd),则:
Figure GDA0003253613660000082
Figure GDA0003253613660000091
δd=arcsin(z);
其中,αd∈(0,2π),δd∈(-π/2,π/2)。
惯导解算出的载体在地理坐标系t中的位置为:
λINS=αd+tG,LINS=δd
其中,tG为春分点的格林尼治时角,大小与位置无关。
根据解算的位置(LINS,λINS)可以得到由地球固联坐标系e到t系的位置矩阵
Figure GDA0003253613660000092
Figure GDA0003253613660000093
位置矩阵
Figure GDA0003253613660000094
包含位置误差带来的误差,可以用组合导航滤波器估计位置误差,对位置矩阵的误差进行校正。假设滤波器估计的位置误差为δPi=[δx δy δz]t,是位置误差在i系下的投影,不能直接位置矩阵进行校正,下面将其换算到e系。
根据球面天文学,坐标在天球上的微小变化,是由观测点的微小位移,或者天体在空间位置的微小变化造成的,通常可以用球面坐标对空间位置的关系推得的微分公式足够精确地表示。对于一个载体,在赤道坐标系中的投影P(r,αd,δd)在与其相联系的直角坐标系中的坐标为:x=rcosαcosδ,y=rsinαcosδ,z=rsinδ,将其微分得:
Figure GDA0003253613660000101
Figure GDA0003253613660000102
dr=cosδdcosαdδx+cosδdsinαdδy+sinδddz
载体在天球中的位置(αdδd)与在e系中位置(L,λ)的关系为:
λ=αd+tG,L=δd
两边微分得:
Figure GDA0003253613660000103
Figure GDA0003253613660000104
e系下的估计位置误差δP=[-δL δλcosLINS δλsinLINS]T,对位置矩阵误差进行校正:
Figure GDA0003253613660000111
根据惯导输出得到i系到b系的姿态矩阵
Figure GDA0003253613660000112
其中包含惯导解算的姿态误差带来的误差,假设滤波器估计的姿态误差角为
Figure GDA0003253613660000113
对惯导输出的捷联姿态矩阵
Figure GDA0003253613660000114
进行校正:
Figure GDA0003253613660000115
导航当前时刻为t,那么由i系到e系的坐标变换矩阵
Figure GDA0003253613660000116
为:
Figure GDA0003253613660000117
接着根据坐标变换关系,得到了b系到t的坐标变换矩阵,也就是高精度的数字水平基准:
Figure GDA0003253613660000118
S107、根据高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在惯导系统中的投影。
其中,所述计算得到天文导航系统解算出的位置信息在惯导系统中的投影的步骤具体包括:
利用高度差法计算天文定位经纬度;
根据天文定位经纬度得到天文导航系统输出的位置;
结合天文导航系统输出的位置和高度计算输出的高度信息获得载体的位置矢量;
根据载体的位置矢量得到天文导航系统解算出的位置信息在惯性坐标系中的投影。
天文导航系统的大视场星敏感器工作时能同时探测到3颗以上的恒星目标,输出载体相对于惯性空间的姿态矩阵
Figure GDA0003253613660000121
星敏感器同时还观测两颗以上的恒星星光矢量,利用构造的高精度水平基准获得星光矢量的高度角后,用高度差法进行天文定位。
自然天体的运动规律是固定不变的,因此星光矢量在某个时刻在固定坐标系的中位置是可以精确得到的。在地球上,只要载体的纬度L和经度λ已知,根据球面三角公式,恒星在当地地理系t中的高度角H和方位角A与恒星在天球中的坐标和地理位置间存在以下关系:
sinH=sinL·sinDec+cosL·cosDec·cosLHA:
Figure GDA0003253613660000122
其中,恒星的格林时角GHA和赤纬Dec可以查询星历获得。地方时角LHA可由下面公式求得:
Figure GDA0003253613660000123
求取反三角函数可以得到高度角H和方位角A,
H=arcsin(sinLsinDec+cosLcosDeccosLHA);
Figure GDA0003253613660000131
Figure GDA0003253613660000132
高度差法定位的过程:选取两颗导航星,星敏感器观测天体得到观测高度角Ho1、Ho2,选择一个假定位置AP(可由惯导系统提供),求天体在AP的计算高度角Hc1、Hc2和计算方位角Ac1、Ac1。天文导航系统的观测高度角和计算高度角的高度角差值为:
ΔHi=Ho1-Hc1,i=1,2;
引入辅助量:
Figure GDA0003253613660000141
观测点的经纬度可通过下式求得:
Figure GDA0003253613660000142
利用解析高度差法计算天文定位经纬度,一般经过1-2次迭代就快速收敛到足够高的精度,收敛速度取决于假定位置AP和真实位置之间差多少。
通过以上步骤,利用星敏感器观测两个或两个以上的恒星的天文角度信息就得到天文导航系统输出的位置(LCNS,λCNS),结合高度计输出的高度信息,可以获得载体的位置矢量
Figure GDA0003253613660000143
为了进行后续的滤波计算,需要将惯导系统和天文导航系统的位置信息转换到同一坐标系下,这里将地理位置(LCNS,λCNS)投影到惯性系。
根据载体在天球中的位置与在e系中位置的关系,可知:
Figure GDA0003253613660000151
此时载体在赤道坐标系中的投影
Figure GDA0003253613660000152
在与其相联系的直角坐标系中的坐标为:
Figure GDA0003253613660000153
因此天文导航系统解算出的位置信息在惯性系中的投影为:
Figure GDA0003253613660000154
S109、根据投影得到惯性/天文紧组合导航系统的量测信息。
其中,步骤S109,具体包括:
建立地心惯性系下的惯性/天文紧组合导航系统的状态方程;
通过天文导航系统的测量信息与状态量之间的关系建立组合导航系统的量测方程。
其中,所述建立地心惯性系下的惯性/天文紧组合导航系统的状态方程的步骤,具体包括:
取组合导航系统状态量为惯导的位置误差、度误差、姿态误差、加速度计量误差和陀螺误差;
根据惯导系统误差方程状态量建立惯性/天文紧组合导航系统的状态方程。
具体的,建立i系下的惯性/天文紧组合导航系统的状态方程。将i系下惯导系统误差方程作为组合导航系统的状态方程。假设速度误差、加速度计量测误差、姿态误差以及地球引力加速度计算误差分别为
Figure GDA0003253613660000161
δfb、φ,且
Figure GDA0003253613660000162
Figure GDA0003253613660000163
取系统状态量为:惯导的位置误差、速度误差、姿态误差、加速度计误差、陀螺误差,即:
Figure GDA0003253613660000164
建立惯性/天文紧组合导航系统的状态方程为:
X=f(X(t))=FX+w(t);
式中:E[w(t)w(t)T=Q为状态模型噪声的协方差阵;
Figure GDA0003253613660000165
其中非零元素为:
F12=I3×3
Figure GDA0003253613660000166
Figure GDA0003253613660000167
Figure GDA0003253613660000168
Figure GDA0003253613660000171
其中,所述通过所述状态方程得到所述惯性/天文紧组合导航系统的量测方程的步骤,具体包括:
计算惯导解算的姿态矩阵和星敏感器测量的姿态矩阵的姿态矩阵差;
根据所述姿态矩阵差得到惯性/天文紧组合导航系统的姿态量测方程;
将惯导系统解算的位置和天文导航系统解算的位置作为滤波器的量测值;
根据滤波器的量测值和组合导航系统状态量之间的关系得到所述惯性/天文紧组合导航系统的量测方程。
具体的,惯性/天文紧组合导航系统量测信息包括姿态量测和位置量测。
惯导解算的姿态矩阵
Figure GDA0003253613660000172
和星敏感器测量的姿态矩阵
Figure GDA0003253613660000173
的差为:
Figure GDA0003253613660000174
其中,Va是星敏感器的噪声矩阵。
取组合导航系统的姿态量测值:
Figure GDA0003253613660000181
量测方程为:
Z1=H1X+V1
其中,H1=[03×6 I3×3 03×6],V1主要来源于星敏感器姿态误差,视为方差阵为R1的零均值高斯白噪声。
同时,将惯导系统解算的位置
Figure GDA0003253613660000182
和天文导航系统解算的位置
Figure GDA0003253613660000183
的差作为滤波器的量测值:
Figure GDA0003253613660000184
其中,H2=[I3×3 03×12],V2主要来源于星敏感器位置误差,视为方差阵为R2的零均值高斯白噪声。
Z1作为滤波器的姿态量测信息,对惯导系统的陀螺漂移和姿态误差进行估计;Z2作为组合导航系统的位置量测信息,对惯导系统的加速度计零偏、速度误差、位置误差进行估计。联立得到组合导航系统的量测方程:
Figure GDA0003253613660000191
这样,系统的量测信息包括天文系统的位置信息和载体相对于惯性空间的高精度姿态信息,最终所有的导航参数,包括位置、速度、姿态、陀螺漂移和加速度计偏置都能被估计出来,实现全面最优组合导航。
请参阅图3,为本发明另一实施例中航空系统导航定位的方法的流程示意图,所述方法包括:
S301、建立基于地心惯性系的惯导系统;
S303、对惯导系统进行解算得到载体的惯导解算结果;
S305、利用惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;
S307、根据高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;
S309、根据所述投影得到惯性/天文紧组合导航系统的量测信息;
S311、对惯性/天文紧组合导航系统进行仿真验证。
具体的,通过仿真结果对一种基于高精度数字水平基准的惯性/天文紧组合导航方法和装置的性能和导航精度进行了验证。图4为本发明提出的紧组合方法与传统松方法姿态误差对比曲线;图5为本发明提出的紧组合方法与传统松方法位置误差对比曲线。本发明一种基于高精度数字水平基准的惯性/天文紧组合导航方法在构造数字水平基准时考虑了惯导水平姿态误差和位置误差对水平的影响,本质上是一种位置加姿态匹配的组合模式。从仿真结果可以看出,图4中紧组合模式下系统姿态误差能够快速收敛并稳定在较高精度,惯导水平基准的误差得到补偿后,可以提高天文导航系统定位精度,保证系统得到较高的定位精度。而传统松组合方法是一种位置组合模式,天文定位对惯导姿态误差和陀螺漂移的估计校正作用并不显著,因此姿态误差较大。图5中,紧组合模式的定位精度稳定在百米左右;而传统松组合模式下,天文定位的精度依赖于惯导提供的水平基准精度,从图4的结果知道传统惯性/天文松组合导航系统的姿态精度较差,进而影响组合导航定位的精度。
请参见图6,为本发明一实施例中航空系统导航定位的系统的结构示意图,所述航空系统导航定位的系统包括:
惯导设备61,用于量测惯性数据并将惯性数据送入导航计算机;
星敏感器62,用于量测天文导航信息并将导航数据送入导航计算机;
导航计算机63,用于将导航解算结果发送至上位机;
高度计64,用于测量飞行器的高度;
上位机65,用于对导航计算机进行控制。
具体的,惯导设备61和星敏感器62将数据送入导航计算机63,导航计算机63进行处理后将导航解算结果送入上位机65实时显示,上位机65同时对导航计算机63进行控制,惯导设备61包括陀螺仪和加速度计,星敏感器62为大视场星敏感器,将PC机或Windows的嵌入式模块作为导航计算机。
其中,导航计算机63包括:
建立模块631,用于建立基于地心惯性系的惯导系统;
解算模块632,用于对所述惯导系统进行解算得到载体的惯导解算结果;
构造模块633,用于利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;
判断模块634,用于根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;
输出模块635,用于根据所述投影得到惯性/天文紧组合导航系统的量测信息;
验证模块636,用于对惯性/天文紧组合导航系统进行仿真验证。
上述实施例基于高精度数字水平基准的惯性/天文紧组合导航方法和系统的优点在于:
(1)利用惯导设备和星敏感器提供的信息,构造了一种新的高精度的数字水平,无需单独的水平基准就可以使天文导航系统得到高精度的定位结果。
(2)利用较少的传感器(惯导设备和星敏感器)对载体进行高精度的定姿定位,实现全面最优导航。
(3)本发明实施例提供的方法和系统所需元减少、成本低、系统结构简单、导航精度高,且不易受外界影响,自主性强。
以上各实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中各个技术所有可能组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。

Claims (9)

1.一种航空系统导航定位的方法,其特征在于,包括步骤:
建立基于地心惯性系的惯导系统;
对所述惯导系统进行解算得到载体的惯导解算结果;
利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准,其具体方法包括:
根据所述惯导系统解算出的载体在地心惯性系中的位置信息得到包含位置误差的位置矩阵;
所述解算的位置为(LINS,λINS),所述得到包含位置误差的位置矩阵具体为:
根据解算的位置得到由地球固联坐标系e到t系的位置矩阵;所述e到t系的位置矩阵的表达式为:
Figure FDA0003253613650000011
式中,
Figure FDA0003253613650000012
为e到t系的位置矩阵;
利用e系下组合导航滤波器估计位置误差以对所述位置矩阵的误差进行校正;所述校正公式为:
Figure FDA0003253613650000013
式中,δP为位置误差;
根据惯导输出得到i系到b系的姿态矩阵;对i系到b系的姿态矩阵进行校正,校正公式为:
Figure FDA0003253613650000014
式中,
Figure FDA0003253613650000015
为组合导航滤波器估计的姿态误差角预设值,
Figure FDA0003253613650000016
为i系到b系的姿态矩阵;
由i系到e系的坐标变换矩阵为:
Figure FDA0003253613650000017
式中,t为导航当前时刻,
Figure FDA0003253613650000018
为i系到e系的坐标变换矩阵;
根据坐标变换关系,得到b系到t的坐标变换矩阵为高精度的数字水平基准,其表达式为:
Figure FDA0003253613650000019
根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;
根据所述投影得到惯性/天文紧组合导航系统的量测信息。
2.根据权利要求1所述的航空系统导航定位的方法,其特征在于,还包括步骤:
对所述惯性/天文紧组合导航系统进行仿真验证。
3.根据权利要求1所述的航空系统导航定位的方法,其特征在于,所述对所述惯导系统进行解算得到载体的惯导解算结果的步骤,具体包括:
利用陀螺仪量测输出的载体相对于惯性空间的转动角速度和加速度计的量测输出的载体相对于惯性空间的比力,获取惯导设备的输出数据;
对所述输出数据进行解算获得所述地心惯性系下载体的姿态、速度、位置信息。
4.根据权利要求3所述的航空系统导航定位的方法,其特征在于,所述计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影的步骤,具体包括:
利用高度差法计算天文定位经纬度;
根据所述天文定位经纬度得到天文导航系统输出的位置;
结合所述天文导航系统输出的位置和高度计算输出的高度信息获得载体的位置矢量;
根据所述载体的位置矢量得到所述天文导航系统解算出的位置信息在惯性坐标系中的投影。
5.根据权利要求4所述的航空系统导航定位的方法,其特征在于,所述根据所述投影得到惯性/天文紧组合导航系统的量测信息的步骤,具体包括:
建立地心惯性系下的惯性/天文紧组合导航系统的状态方程;
通过天文导航系统的测量信息与状态量之间的关系建立组合导航系统的量测方程。
6.根据权利要求5所述的航空系统导航定位的方法,其特征在于,所述建立地心惯性系下的惯性/天文紧组合导航系统的状态方程的步骤,具体包括:
取组合导航系统状态量为惯导的位置误差、速度误差、姿态误差、加速度计量误差和陀螺误差;
根据惯导系统误差方程建立惯性/天文紧组合导航系统的状态方程。
7.根据权利要求6所述的航空系统导航定位的方法,其特征在于,所述通过所述天文导航系统的量测信息与状态量之间的关系得到所述惯性/天文紧组合导航系统的量测方程的步骤,具体包括:
计算惯导解算的姿态矩阵和星敏感器测量的姿态矩阵的姿态矩阵差;
根据所述姿态矩阵差得到惯性/天文紧组合导航系统的姿态量测方程;
将惯导系统解算的位置和天文导航系统解算的位置作为滤波器的量测值;
根据所述滤波器的量测值与组合导航系统状态量之间进行估计后再联立的关系得到所述惯性/天文紧组合导航系统的量测方程。
8.一种航空系统导航定位的系统,应用于权利要求1-7任一项所述的方法,其特征在于,包括:
惯导设备,用于量测惯性导航数据并将惯导数据送入导航计算机;
星敏感器,用于量测天文导航信息并将导航数据送入导航计算机;
导航计算机,用于将导航解算结果发送至上位机;
高度计,用于测量飞行器的高度;
上位机,用于对所述导航计算机进行控制。
9.根据权利要求8所述的一种航空系统导航定位的系统,其特征在于,所述导航计算机包括:
建立模块,用于建立基于地心惯性系的惯导系统;
解算模块,用于对所述惯导系统进行解算得到载体的惯导解算结果;
构造模块,用于利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;
判断模块,用于根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航系统解算出的位置信息在所述惯导系统中的投影;
输出模块,用于根据所述投影得到惯性/天文紧组合导航系统的量测信息;
验证模块,用于对所述惯性/天文紧组合导航系统进行仿真验证。
CN201810763578.0A 2018-07-12 2018-07-12 一种航空系统导航定位的方法及系统 Active CN109099911B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810763578.0A CN109099911B (zh) 2018-07-12 2018-07-12 一种航空系统导航定位的方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810763578.0A CN109099911B (zh) 2018-07-12 2018-07-12 一种航空系统导航定位的方法及系统

Publications (2)

Publication Number Publication Date
CN109099911A CN109099911A (zh) 2018-12-28
CN109099911B true CN109099911B (zh) 2021-10-26

Family

ID=64846187

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810763578.0A Active CN109099911B (zh) 2018-07-12 2018-07-12 一种航空系统导航定位的方法及系统

Country Status (1)

Country Link
CN (1) CN109099911B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113155149B (zh) * 2020-07-27 2024-03-19 西安天和防务技术股份有限公司 天文/惯性组合导航半物理仿真系统
CN117664116B (zh) * 2024-01-29 2024-04-26 中国人民解放军国防科技大学 一种组合导航的初始位置确定方法及组合导航系统

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101788296A (zh) * 2010-01-26 2010-07-28 北京航空航天大学 一种sins/cns深组合导航系统及其实现方法
CN101813481A (zh) * 2010-03-26 2010-08-25 南京航空航天大学 用于机载的基于虚拟水平基准修正的惯性与天文定位方法
CN103604428A (zh) * 2013-11-22 2014-02-26 哈尔滨工程大学 基于高精度水平基准的星敏感器定位方法
CN103994763A (zh) * 2014-05-21 2014-08-20 北京航空航天大学 一种火星车的sins/cns深组合导航系统及其实现方法
CN105180928A (zh) * 2015-07-30 2015-12-23 哈尔滨工程大学 一种基于惯性系重力特性的船载星敏感器定位方法
CN105371844A (zh) * 2015-12-02 2016-03-02 南京航空航天大学 一种基于惯性/天文互助的惯性导航系统初始化方法
US9702702B1 (en) * 2015-06-15 2017-07-11 The Charles Stark Draper Laboratory, Inc. Methods and apparatus for navigational aiding using celestial object tracking

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101788296A (zh) * 2010-01-26 2010-07-28 北京航空航天大学 一种sins/cns深组合导航系统及其实现方法
CN101813481A (zh) * 2010-03-26 2010-08-25 南京航空航天大学 用于机载的基于虚拟水平基准修正的惯性与天文定位方法
CN103604428A (zh) * 2013-11-22 2014-02-26 哈尔滨工程大学 基于高精度水平基准的星敏感器定位方法
CN103994763A (zh) * 2014-05-21 2014-08-20 北京航空航天大学 一种火星车的sins/cns深组合导航系统及其实现方法
US9702702B1 (en) * 2015-06-15 2017-07-11 The Charles Stark Draper Laboratory, Inc. Methods and apparatus for navigational aiding using celestial object tracking
CN105180928A (zh) * 2015-07-30 2015-12-23 哈尔滨工程大学 一种基于惯性系重力特性的船载星敏感器定位方法
CN105371844A (zh) * 2015-12-02 2016-03-02 南京航空航天大学 一种基于惯性/天文互助的惯性导航系统初始化方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Stellar Refraction-Based SINS/CNS Integrated Navigation System for Aerospace Vehicles;Yang, Shujie等;《Journal of Aerospace Engineering》;20150909;第29卷(第2期);第1-11页 *
弹载SINS/CNS组合导航系统在线标定方法;杨功流等;《弹箭与制导学报》;20141031;第34卷(第5期);第29-32页 *

Also Published As

Publication number Publication date
CN109099911A (zh) 2018-12-28

Similar Documents

Publication Publication Date Title
CN105371844B (zh) 一种基于惯性/天文互助的惯性导航系统初始化方法
CN101344391B (zh) 基于全功能太阳罗盘的月球车位姿自主确定方法
CN108051866B (zh) 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法
CN103994763B (zh) 一种火星车的sins/cns深组合导航系统及其实现方法
CN101788296B (zh) 一种sins/cns深组合导航系统及其实现方法
CN103323026B (zh) 星敏感器和有效载荷的姿态基准偏差估计与修正方法
CN106342284B (zh) 一种飞行载体姿态确定方法
CN103196448B (zh) 一种机载分布式惯性测姿系统及其传递对准方法
CN103900576B (zh) 一种深空探测自主导航的信息融合方法
CN103900565B (zh) 一种基于差分gps的惯导系统姿态获取方法
CN109556631B (zh) 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法
CN106767787A (zh) 一种紧耦合gnss/ins组合导航装置
CN113551668B (zh) 一种航天器惯性/恒星星光矢量/星光折射组合导航方法
CN110954102B (zh) 用于机器人定位的磁力计辅助惯性导航系统及方法
Yao et al. Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas
CN110631567B (zh) 一种差分天空偏振罗盘大气折射误差的反演及修正方法
CN104833375B (zh) 一种借助星敏感器的imu两位置对准方法
CN109073388B (zh) 旋磁地理定位系统
CN108731674A (zh) 一种基于单轴旋转调制的惯性天文组合导航系统及计算方法
CN112880669B (zh) 一种航天器星光折射和单轴旋转调制惯性组合导航方法
CN103968844B (zh) 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法
CN109489661B (zh) 一种卫星初始入轨时陀螺组合常值漂移估计方法
CN103604428A (zh) 基于高精度水平基准的星敏感器定位方法
CN112902956A (zh) 一种手持式gnss/mems-ins接收机航向初值获取方法、电子设备、存储介质
CN112179334B (zh) 基于两步Kalman滤波的星光导航方法及系统

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