CN109099911B - 一种航空***导航定位的方法及*** - Google Patents
一种航空***导航定位的方法及*** Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000005259 measurement Methods 0.000 claims abstract description 48
- 239000011159 matrix material Substances 0.000 claims description 46
- 239000013598 vector Substances 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 10
- 230000009466 transformation Effects 0.000 claims description 9
- 238000012795 verification Methods 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 8
- 238000004088 simulation Methods 0.000 claims description 8
- 238000012937 correction Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000007792 addition Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000007429 general method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 230000001131 transforming effect 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
- 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
- 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/20—Instruments for performing navigational calculations
-
- 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)
- 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具体包括:
利用个陀螺仪量测出的载体相对于惯性空间的转动角速和加速度计的量测输出的载体相对于惯性空间的比力,获取惯导设备的输出数据;
对输出数据进行解算获得地心惯性系下载体的姿态、速度、位置信息。
利用陀螺仪量测输出的载体相对于惯性空间的转动角速度和加速度计的量测输出的载体相对于惯性空间的比力其中上标“~”表示量测值。获取到惯导器件的输出数据后,进行导航解算获得地心惯性系i下载体的姿态,速度,位置,信息,一路用于组合导航,另一路用于构造数字水平基准。
地心惯性系i下惯导设备的导航方程可表示为:
请参见图2,为本发明实施例中地心惯性系i下的惯导***导航算法的流程示意图。解算出的地心惯性系i下载体的位置ri=(x y z)T和载体相对于地心惯性系i的姿态矩阵惯导***结算的结果用于构造高精度数字水平基准。
S105、利用惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准。
其中,步骤S105具体包括:
根据惯导***结算出的载体在地心惯性系中位置信息得到包含位置误差的位置矩阵;
利用组合导航滤波器估计位置误差以对位置矩阵的误差进行校正;
通过坐标变换和误差补偿,计算得到当地地理系的水平信息;
根据当地地理系的水平信息构造高精度数字水平基准。
具体的,惯导***相对于平台惯导***,没有物理平台,是通过计算进行姿态变幻得到数字平台,本发明实施例利用地心惯性系下的惯导解算结果以及组合导航滤波器输出的导航误差估计,通过一系列的坐标变换和误差补偿,计算得到当地地理系的水平信息,也就是构造出了高精度的数字水平基准。
利用该惯导***测量得到的比力及角速度解算出地心惯性系i下飞行器的位置ri=(x y z)T,那么载体在赤道坐标系中的投影为P(r,αd,δd),则:
δd=arcsin(z);
其中,αd∈(0,2π),δd∈(-π/2,π/2)。
惯导解算出的载体在地理坐标系t中的位置为:
λINS=αd+tG,LINS=δd;
其中,tG为春分点的格林尼治时角,大小与位置无关。
位置矩阵包含位置误差带来的误差,可以用组合导航滤波器估计位置误差,对位置矩阵的误差进行校正。假设滤波器估计的位置误差为δPi=[δx δy δz]t,是位置误差在i系下的投影,不能直接位置矩阵进行校正,下面将其换算到e系。
根据球面天文学,坐标在天球上的微小变化,是由观测点的微小位移,或者天体在空间位置的微小变化造成的,通常可以用球面坐标对空间位置的关系推得的微分公式足够精确地表示。对于一个载体,在赤道坐标系中的投影P(r,αd,δd)在与其相联系的直角坐标系中的坐标为:x=rcosαcosδ,y=rsinαcosδ,z=rsinδ,将其微分得:
dr=cosδdcosαdδx+cosδdsinαdδy+sinδddz;
载体在天球中的位置(αdδd)与在e系中位置(L,λ)的关系为:
λ=αd+tG,L=δd;
两边微分得:
e系下的估计位置误差δP=[-δL δλcosLINS δλsinLINS]T,对位置矩阵误差进行校正:
接着根据坐标变换关系,得到了b系到t的坐标变换矩阵,也就是高精度的数字水平基准:
S107、根据高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航***解算出的位置信息在惯导***中的投影。
其中,所述计算得到天文导航***解算出的位置信息在惯导***中的投影的步骤具体包括:
利用高度差法计算天文定位经纬度;
根据天文定位经纬度得到天文导航***输出的位置;
结合天文导航***输出的位置和高度计算输出的高度信息获得载体的位置矢量;
根据载体的位置矢量得到天文导航***解算出的位置信息在惯性坐标系中的投影。
星敏感器同时还观测两颗以上的恒星星光矢量,利用构造的高精度水平基准获得星光矢量的高度角后,用高度差法进行天文定位。
自然天体的运动规律是固定不变的,因此星光矢量在某个时刻在固定坐标系的中位置是可以精确得到的。在地球上,只要载体的纬度L和经度λ已知,根据球面三角公式,恒星在当地地理系t中的高度角H和方位角A与恒星在天球中的坐标和地理位置间存在以下关系:
sinH=sinL·sinDec+cosL·cosDec·cosLHA:
其中,恒星的格林时角GHA和赤纬Dec可以查询星历获得。地方时角LHA可由下面公式求得:
求取反三角函数可以得到高度角H和方位角A,
H=arcsin(sinLsinDec+cosLcosDeccosLHA);
高度差法定位的过程:选取两颗导航星,星敏感器观测天体得到观测高度角Ho1、Ho2,选择一个假定位置AP(可由惯导***提供),求天体在AP的计算高度角Hc1、Hc2和计算方位角Ac1、Ac1。天文导航***的观测高度角和计算高度角的高度角差值为:
ΔHi=Ho1-Hc1,i=1,2;
引入辅助量:
观测点的经纬度可通过下式求得:
利用解析高度差法计算天文定位经纬度,一般经过1-2次迭代就快速收敛到足够高的精度,收敛速度取决于假定位置AP和真实位置之间差多少。
为了进行后续的滤波计算,需要将惯导***和天文导航***的位置信息转换到同一坐标系下,这里将地理位置(LCNS,λCNS)投影到惯性系。
根据载体在天球中的位置与在e系中位置的关系,可知:
因此天文导航***解算出的位置信息在惯性系中的投影为:
S109、根据投影得到惯性/天文紧组合导航***的量测信息。
其中,步骤S109,具体包括:
建立地心惯性系下的惯性/天文紧组合导航***的状态方程;
通过天文导航***的测量信息与状态量之间的关系建立组合导航***的量测方程。
其中,所述建立地心惯性系下的惯性/天文紧组合导航***的状态方程的步骤,具体包括:
取组合导航***状态量为惯导的位置误差、度误差、姿态误差、加速度计量误差和陀螺误差;
根据惯导***误差方程状态量建立惯性/天文紧组合导航***的状态方程。
具体的,建立i系下的惯性/天文紧组合导航***的状态方程。将i系下惯导***误差方程作为组合导航***的状态方程。假设速度误差、加速度计量测误差、姿态误差以及地球引力加速度计算误差分别为δfb、φ,且 取***状态量为:惯导的位置误差、速度误差、姿态误差、加速度计误差、陀螺误差,即:
建立惯性/天文紧组合导航***的状态方程为:
X=f(X(t))=FX+w(t);
式中:E[w(t)w(t)T=Q为状态模型噪声的协方差阵;
其中非零元素为:
F12=I3×3;
其中,所述通过所述状态方程得到所述惯性/天文紧组合导航***的量测方程的步骤,具体包括:
计算惯导解算的姿态矩阵和星敏感器测量的姿态矩阵的姿态矩阵差;
根据所述姿态矩阵差得到惯性/天文紧组合导航***的姿态量测方程;
将惯导***解算的位置和天文导航***解算的位置作为滤波器的量测值;
根据滤波器的量测值和组合导航***状态量之间的关系得到所述惯性/天文紧组合导航***的量测方程。
具体的,惯性/天文紧组合导航***量测信息包括姿态量测和位置量测。
其中,Va是星敏感器的噪声矩阵。
取组合导航***的姿态量测值:
量测方程为:
Z1=H1X+V1;
其中,H1=[03×6 I3×3 03×6],V1主要来源于星敏感器姿态误差,视为方差阵为R1的零均值高斯白噪声。
其中,H2=[I3×3 03×12],V2主要来源于星敏感器位置误差,视为方差阵为R2的零均值高斯白噪声。
Z1作为滤波器的姿态量测信息,对惯导***的陀螺漂移和姿态误差进行估计;Z2作为组合导航***的位置量测信息,对惯导***的加速度计零偏、速度误差、位置误差进行估计。联立得到组合导航***的量测方程:
这样,***的量测信息包括天文***的位置信息和载体相对于惯性空间的高精度姿态信息,最终所有的导航参数,包括位置、速度、姿态、陀螺漂移和加速度计偏置都能被估计出来,实现全面最优组合导航。
请参阅图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系的位置矩阵的表达式为:
利用e系下组合导航滤波器估计位置误差以对所述位置矩阵的误差进行校正;所述校正公式为:
根据惯导输出得到i系到b系的姿态矩阵;对i系到b系的姿态矩阵进行校正,校正公式为:
由i系到e系的坐标变换矩阵为:
根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航***解算出的位置信息在所述惯导***中的投影;
根据所述投影得到惯性/天文紧组合导航***的量测信息。
2.根据权利要求1所述的航空***导航定位的方法,其特征在于,还包括步骤:
对所述惯性/天文紧组合导航***进行仿真验证。
3.根据权利要求1所述的航空***导航定位的方法,其特征在于,所述对所述惯导***进行解算得到载体的惯导解算结果的步骤,具体包括:
利用陀螺仪量测输出的载体相对于惯性空间的转动角速度和加速度计的量测输出的载体相对于惯性空间的比力,获取惯导设备的输出数据;
对所述输出数据进行解算获得所述地心惯性系下载体的姿态、速度、位置信息。
4.根据权利要求3所述的航空***导航定位的方法,其特征在于,所述计算得到天文导航***解算出的位置信息在所述惯导***中的投影的步骤,具体包括:
利用高度差法计算天文定位经纬度;
根据所述天文定位经纬度得到天文导航***输出的位置;
结合所述天文导航***输出的位置和高度计算输出的高度信息获得载体的位置矢量;
根据所述载体的位置矢量得到所述天文导航***解算出的位置信息在惯性坐标系中的投影。
5.根据权利要求4所述的航空***导航定位的方法,其特征在于,所述根据所述投影得到惯性/天文紧组合导航***的量测信息的步骤,具体包括:
建立地心惯性系下的惯性/天文紧组合导航***的状态方程;
通过天文导航***的测量信息与状态量之间的关系建立组合导航***的量测方程。
6.根据权利要求5所述的航空***导航定位的方法,其特征在于,所述建立地心惯性系下的惯性/天文紧组合导航***的状态方程的步骤,具体包括:
取组合导航***状态量为惯导的位置误差、速度误差、姿态误差、加速度计量误差和陀螺误差;
根据惯导***误差方程建立惯性/天文紧组合导航***的状态方程。
7.根据权利要求6所述的航空***导航定位的方法,其特征在于,所述通过所述天文导航***的量测信息与状态量之间的关系得到所述惯性/天文紧组合导航***的量测方程的步骤,具体包括:
计算惯导解算的姿态矩阵和星敏感器测量的姿态矩阵的姿态矩阵差;
根据所述姿态矩阵差得到惯性/天文紧组合导航***的姿态量测方程;
将惯导***解算的位置和天文导航***解算的位置作为滤波器的量测值;
根据所述滤波器的量测值与组合导航***状态量之间进行估计后再联立的关系得到所述惯性/天文紧组合导航***的量测方程。
8.一种航空***导航定位的***,应用于权利要求1-7任一项所述的方法,其特征在于,包括:
惯导设备,用于量测惯性导航数据并将惯导数据送入导航计算机;
星敏感器,用于量测天文导航信息并将导航数据送入导航计算机;
导航计算机,用于将导航解算结果发送至上位机;
高度计,用于测量飞行器的高度;
上位机,用于对所述导航计算机进行控制。
9.根据权利要求8所述的一种航空***导航定位的***,其特征在于,所述导航计算机包括:
建立模块,用于建立基于地心惯性系的惯导***;
解算模块,用于对所述惯导***进行解算得到载体的惯导解算结果;
构造模块,用于利用所述惯导解算结果及组合导航滤波器输出的导航误差估计构造高精度数字水平基准;
判断模块,用于根据所述高精度数字水平基准判断当前的天文导航数据是否可用,若是,计算得到天文导航***解算出的位置信息在所述惯导***中的投影;
输出模块,用于根据所述投影得到惯性/天文紧组合导航***的量测信息;
验证模块,用于对所述惯性/天文紧组合导航***进行仿真验证。
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)
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)
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 |
-
2018
- 2018-07-12 CN CN201810763578.0A patent/CN109099911B/zh active Active
Patent Citations (7)
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)
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/偏振/地磁组合导航***对准方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航***及方法 | |
CN113551668B (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
Yao et al. | Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas | |
CN109931955A (zh) | 基于状态相关李群滤波的捷联惯性导航***初始对准方法 | |
CN110631567B (zh) | 一种差分天空偏振罗盘大气折射误差的反演及修正方法 | |
CN104833375B (zh) | 一种借助星敏感器的imu两位置对准方法 | |
CN109073388B (zh) | 旋磁地理定位*** | |
CN112880669B (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN108731674A (zh) | 一种基于单轴旋转调制的惯性天文组合导航***及计算方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 | |
CN112179334B (zh) | 基于两步Kalman滤波的星光导航方法及*** | |
CN103278165A (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 |