CN103076015A - 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 - Google Patents
一种基于全面最优校正的sins/cns组合导航系统及其导航方法 Download PDFInfo
- Publication number
- CN103076015A CN103076015A CN2013100011514A CN201310001151A CN103076015A CN 103076015 A CN103076015 A CN 103076015A CN 2013100011514 A CN2013100011514 A CN 2013100011514A CN 201310001151 A CN201310001151 A CN 201310001151A CN 103076015 A CN103076015 A CN 103076015A
- Authority
- CN
- China
- Prior art keywords
- information
- centerdot
- error
- navigation
- refraction
- 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
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明提出一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法,属于组合导航技术领域。该组合导航系统包括天文导航子系统、惯性导航子系统和信息融合子系统;该导航方法包括:基于星光折射的解析天文定位、导航系统状态方程建立、导航系统量测方程的建立和基于卡尔曼滤波的组合导航系统信息融合。本发明利用星光折射间接敏感地平的基本原理和大视场星敏感器可以同时观测多颗恒星的特点,将星光折射间接敏感地平方法应用于不满足轨道动力学模型的飞行器,解决了天文导航系统高精度自主地平的问题。且本发明充分利用天文导航系统的位置和姿态信息,对SINS误差进行全面最优校正,显著地提高了组合导航精度。
Description
技术领域
本发明涉及一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法,属于组合导航技术领域。
背景技术
高空长航时飞行器由于飞行距离远,航行时间长,对导航精度提出了很高的要求。目前适合高空长航时飞行器的导航系统主要有捷联惯导系统(SINS)、GPS、天文导航系统(CNS)、地形匹配导航系统(TAN)和多普勒导航系统等。
捷联惯导系统是一种完全自主的导航技术,具有短时精度高、输出连续、抗干扰能力强、导航信息完整等优点。但是其导航误差随时间积累,难以长时间独立工作,需要与其他导航系统进行组合以提高导航性能。天文导航系统主要利用恒星来进行导航,隐蔽性好、自主性强,并且导航精度不受时间、距离长短的影响,能够提供高精度的姿态与位置信息;但是其输出不连续。由于SINS、CNS各有优缺点,将两者结合起来进行组合导航,可以实现优势互补。惯性/天文组合导航以惯性导航为主体,利用CNS量测信息构造观测量,采用卡尔曼滤波算法对惯导误差进行估计,进而获得高精度的导航信息。
目前,SINS/CNS组合导航由于自主性强、导航精度高,受到了越来越多的关注,并已获得了广泛的应用。SINS/CNS组合导航系统主要采用以下两种工作模式。
(1)简单组合模式。该组合模式是最简单的组合模式,SINS独立工作,提供全面的导航信息,CNS利用SINS的导航信息计算出飞行器的位置和姿态,直接对SINS的位置、姿态输出进行校正;
(2)基于陀螺仪漂移校正的组合模式。该模式下,SINS利用CNS高精度的姿态信息对姿态误差和陀螺仪漂移进行估计和补偿。
简单组合模式中,由于陀螺仪漂移与加速度计零偏无法被估计、校正,所以该模式定位精度较低。相对于简单组合模式,基于陀螺仪漂移校正的组合模式可以有效地校正陀螺仪漂移引起的导航误差,提高了组合导航系统的导航精度;但该组合模式无法消除加速度计零偏累积的导航误差,因此该组合导航方案的误差随时间缓慢发散。
提高CNS导航系统精度的关键是如何获得不随时间漂移的、高精度的地平信息,目前常用的提供地平信息的方法主要有惯导辅助提供地平法、直接敏感地平法和星光折射间接敏感地平法。惯导辅助提供地平法以惯导系统的平台坐标系作为地平信息,该方法简单、易于实现;但该方法提供的地平信息耦合了SINS误差,随着SINS误差的累积,将导致地平信息误差的发散。直接敏感地平法利用红外地平仪直接确定地心矢量方向,但是该方法得到的地平信息精度较低,且由于高度限制无法应用于高空长航时飞行器。星光折射间接敏感地平法是一种低成本、高精度的地平确定方法,该方法利用飞行器的轨道动力学模型、高精度的星敏感器和大气折射模型,精确敏感地平,进而实现精确定位。但是,传统的基于星光折射间接敏感地平的天文导航方法需要飞行器的轨道动力学模型,无法应用于高空长航时飞行器。
目前,随着星敏感器技术的发展,天文导航系统(CNS)可以提供高精度的姿态、位置信息,对SINS导航误差进行全面最优地校正。因此,采用基于全面最优校正的SINS/CNS组合导航方案可以满足高空长航时飞行器对导航性能的要求。
发明内容
针对现有技术中存在的问题,本发明提出一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法,根据星光折射间接敏感地平的基本原理,提出一种基于星光折射的解析天文定位方法,充分利用天文导航系统和惯性导航系统提供的位置、姿态信息,通过卡尔曼滤波方法进行信息融合,显著的提高了组合导航系统的可靠性。
本发明一种基于全面最优校正的SINS/CNS组合导航系统,包括天文导航子系统、惯性导航子系统和信息融合子系统;三者之间的关系是:天文导航子系统和惯性导航子系统为信息融合子系统提供位置、姿态信息,信息融合子系统为惯性导航子系统提供估计误差。
所述天文导航子系统,包括大视场星敏感器、大气折射模型、数字滤波器、天文定位单元和天文定姿单元;其间关系是:大视场星敏感器将观测到的星光折射角提供给大气折射模型;大气折射模型根据星光折射角计算折射恒星的视高度,并将其提供给数字滤波器;数字滤波器对视高度信息进行降噪处理,并将处理后的信息发送给天文定位单元;天文定位单元利用基于星光折射间接敏感地平的解析天文定位方法得到位置信息和地平信息;天文定姿单元利用大视场星敏感器提供的惯性姿态信息和天文定位单元提供的地平信息确定姿态信息。该大视场星敏感器是采用数学仿真可以同时观测多颗恒星,直接输出飞行器的惯性姿态信息和折射恒星的星光折射角;该大气折射模型是国际参考大气(CIRA)1986,利用该大气折射模型可以根据星光折射角计算出折射恒星的视高度;该数字滤波器是二阶数字低通滤波器;该天文定位单元是利用视高度信息计算飞行器的位置;该天文定姿单元是直接利用惯性姿态信息和地平信息计算飞行器相对于导航坐标系的姿态信息;
所述惯性导航子系统,包括惯性测量单元和SINS解算单元,其间关系是:SINS解算单元利用惯性测量元件的输入解算出飞行器的位置和姿态信息;并利用信息融合子系统提供的估计误差对SINS导航误差进行校正。该惯性测量单元是由三个加速度计和三个陀螺仪组成,可以测量飞行器的加速度和角速度;该SINS解算单元是SINS解算过程,利用飞行器的加速度和加速度信息计算飞行器的位置、速度、姿态等导航信息;
所述信息融合子系统,包括失准角计算单元和卡尔曼滤波器,其间关系是:失准角计算单元利用天文导航子系统和惯性导航子系统提供的姿态信息求得平台失准角,并提供给卡尔曼滤波器;卡尔曼滤波器以SINS误差方程为状态方程,以位置误差和平台失准角作为观测量进行卡尔曼滤波,得到平台失准角、位置误差和陀螺仪漂移误差的估计值。该失准角计算单元是根据惯性导航子系统和天文导航子系统姿态输出的误差角计算系统的失准角;该卡尔曼滤波器采用标准卡尔曼滤波算法,以SINS误差方程为状态方程,以位置误差和平台失准角作为观测量,对平台失准角、位置误差和陀螺仪漂移误差进行估计;
本发明一种基于全面最优校正的SINS/CNS组合导航方法,具体包括以下步骤:
步骤一:天文导航信息和惯性导航信息的计算
a、天文导航信息的计算
利用大视场星敏感器观测多颗导航恒星和折射恒星,可以得到星光折射角;大气折射模型利用星光折射角计算出视高度,利用数字滤波器对视高度进行预处理,得到的处理结果可用于天文定位单元;天文定位单元利用基于星光折射的解析天文定位方法实现天文定位,具体过程如下:
根据星光折射的几何原理,可以得到:
其中:α为折射后的星光矢量与飞行器位置矢量之间的夹角;Re为地球半径;ha为视高度;rs为地心距,即飞行器到地心的距离。
当观测到n颗折射恒星时,根据夹角α的定义可得:
将公式(1)代入方程组(2),可得
其中:hai(i=1,2,...,n)为第i颗折射恒星的视高度。
方程组(3)中,地球半径Re为已知量,折射后的星光矢量可以由大视场星敏感器获得,视高度hai可利用大视场星敏感器、大气折射模型和数字滤波器得到,因此该方程组实际上含有rx,ry,rz和rs四个未知数。这样,根据的约束条件,如果同时观测三颗或三颗以上的折射恒星,就可以确定地心距rs和地心单位矢量进而求得飞行器的三维位置信息(经度、纬度和高度)。目前,随着大视场星敏感器技术的发展,同时观测多颗折射恒星变成了可能。当大视场星敏感器观测到n≥3颗折射恒星时,方程组(3)可以写成:
其中:
式中,B=(UTU)-1UT为矩阵U的广义逆矩阵。
采用牛顿迭代法解算方程(6),具体迭代步骤如下:
(1)选取一个初始的地心距rs(0);
(2)利用迭代公式计算出下一时刻的地心距;
迭代公式为:
其中:rs(k)、rs(k+1)分别为第k次和第k+1次的地心距估计值;A为F(rs)对rs的微分,即:
(3)若|rs(k+1)-rs(k)|<τ(τ为给定的小量),则迭代结束,且rs(k+1)为地心距rs的数值解;否则,以rs(k+1)作为新的初始条件返回第(2)步重新进行计算。
然后,根据牛顿迭代法解算出地心距rs的数值解,并将其数值解代入公式(5),即得到地心单位矢量
根据地心距的定义,由地心距rs可以确定飞行器的高度h为:
h=rs-Re (8)
因此,根据公式(9)可以确定飞行器的赤经αd、赤纬δd为
αd=arctan(ry/rx),δd=arcsin(rz) (10)其中:αd∈(0~2π),δd∈(-π/2~π/2)。
将惯性系下的坐标赤经、赤纬(αd,δd)转变为地理系下的经、纬度坐标(λ,L),即:
λ=αd-tG,L=δd (11)其中:(λ,L)为飞行器的经、纬度;tG为春分点的格林时角,可由时间基准得到。
这样,天文定位单元可以输出天文位置信息和地平信息。
天文姿态信息可由天文定姿单元求得。天文定姿单元利用惯性姿态信息和地平信息,直接计算出天文姿态信息。
b、惯性导航信息的计算
惯性位置信息和惯性姿态信息可由SINS解算单元求出。惯性导航子系统利用惯性测量单元测量飞行器的加速度信息和角速度信息;SINS解算单元根据加速度信息和角速度信息解算出飞行器的位置信息和姿态信息。
步骤二:组合导航系统状态方程的建立
选择东北天地理坐标系作为导航坐标系,组合导航系统的状态方程为SINS的误差方程,可以表示为:
FN是平台失准角误差、速度误差和位置误差对应的状态转移矩阵;G为噪声驱动矩阵:
步骤三:组合导航系统量测方程的建立
选取平台失准角误差和位置误差作为系统观测量,建立量测方程;
a、平台失准角误差的量测方程建立
δθ=θs-θc
δγ=γs-γc
失准角计算单元利用姿态误差角求得平台失准角φx,φy,φz为:
根据公式(14)、(15),可以根据天文导航子系统和惯性导航子系统的姿态输出求的平台失准角。进而可得平台失准角对应的观测方程为:
Z1=H1X+V1 (16)其中:Z1=[φx φy φz]T为平台失准角的观测量;H1=[I3×3 03×12]为平台失准角对应的观测矩阵;V1为观测噪声。
b、位置误差的量测方程建立
将天文导航子系统与惯性导航子系统位置输出的差值作为位置误差的观测量,则位置误差对应的观测方程为:
Z2=H2X+V2 (17)
其中:Z2=[Ls-Lc λs-λc]T为位置误差的观测量;Lc,λc为天文导航子系统输出的位置信息,Ls,λs为惯性导航子系统输出的位置信息;H2=[02×6 I2×2 02×7]为位置误差对应的观测矩阵;V2为CNS的定位误差。
步骤四:基于卡尔曼滤波的组合导航系统信息融合
卡尔曼滤波器利用捷联惯导的误差方程作为状态方程,将天文导航子系统和惯性导航子系统位置输出的差值和失准角计算单元输出的平台失准角作为观测值,利用卡尔曼滤波算法对导航误差进行实时估计,并将估计误差发送到SINS解算单元,对导航误差进行校正,提高导航精度。
本发明的优点在于:
(1)本发明提出一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法,利用大视场根据星敏感器可同时观测多颗折射恒星的特点,将基于星光折射的间接敏感地平方法应用于不满足轨道动力学特性的高空长航时无人机,实现了基于星光折射的解析天文定位;
(2)本发明提出一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法,利用卡尔曼滤波算法对惯性导航系统和天文导航系统输出的姿态、位置信息进行信息融合,进而对导航误差进行全面最优地估计、校正,提高了组合导航系统的精度;
(3)本发明提出一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法,具有计算量小、可靠性高等优点,并且还可以应用于临近空间飞行器、空天往返飞行器、弹道导弹、变轨航天器等飞行器,具有广阔的应用前景。
附图说明
图1为本发明提出的一种基于全面最优校正的SINS/CNS组合导航系统结构示意图;
图2为本发明组合导航方法的流程框图
图3为本发明中基于星光折射的解析天文定位方法的原理图。
图1中:
1-天文导航子系统 2-惯性导航子系统 3-信息融合子系统
101-大视场星敏感器 201-惯性测量元件 301-失准角计算单元
102-大气折射模型 202-SINS解算单元 302-卡尔曼滤波器
103-数字滤波器 fb-加速度信息 φ-失准角
105-天文定姿单元 λs,Ls-惯性位置信息
-地平信息
λc,Lc-天文位置信息
图3中:
R-星光折射角 ha-视高度 Re-地球半径
失量
矢量 矢量 矢量
具体实施方式
下面将结合附图对本发明作进一步的详细说明。
本发明提出一种基于全面最优校正的SINS/CNS组合导航系统及其导航方法。根据SINS的误差方程建立系统状态方程;以天文位置信息(Lc,λc)、天文姿态信息(θc,γc)和惯性位置信息(Ls,λs)、惯性姿态信息(θs,γs)输出构造观测值;利用卡尔曼滤波算法估计、校正导航误差,提高组合导航系统的精度。
见图1,本发明提出一种基于全面最优校正的SINS/CNS组合导航系统,包括天文导航子系统1、惯性导航子系统2和信息融合子系统3;
天文导航子系统1包括大视场星敏感器101、大气折射模型102、数字滤波器103、天文定位单元104和天文定姿单元105;大视场星敏感器101将观测到的星光折射角(R)提供给大气折射模型102;星光折射模型102根据星光折射角计算折射恒星的视高度并将其提供给数字滤波器103;数字滤波器103对视高度信息进行降噪处理,并将处理后的信息发送给天文定位单元104;天文定位单元104利用基于星光折射间接敏感地平的解析天文定位方法得到位置信息(Lc,λc)和地平信息;天文定姿单元105利用大视场星敏感器101提供的惯性姿态信息和天文定位单元104提供的地平信息确定姿态信息(θc,γc)。
惯性导航子系统2包括惯性测量单元201和SINS解算单元202,SINS解算单元202利用惯性测量元件201的输入(fb,)解算出飞行器的位置(Ls,λs)和姿态(θs,γs)信息;并利用信息融合子系统3提供的估计误差对SINS导航误差进行校正。
信息融合子系统3包括失准角计算单元301和卡尔曼滤波器302,失准角计算单元301利用天文导航子系统1和惯性导航子系统2提供的姿态信息求得平台失准角(φ),并提供给卡尔曼滤波器302;卡尔曼滤波器302以SINS误差方程为状态方程,以位置误差和平台失准角作为观测量进行卡尔曼滤波,得到平台失准角、位置误差和陀螺仪漂移误差的估计值。
见图2,本发明提出一种基于全面最优校正的SINS/CNS组合导航方法,具体包括以下步骤:
步骤一:天文导航信息和惯性导航信息的计算
a、天文导航信息的计算
利用大视场星敏感器101观测多颗导航恒星和折射恒星,可以得到星光折射角(R);大气折射模型102利用星光折射角(R)计算出视高度利用数字滤波器103对视高度进行预处理,得到的处理结果可用于天文定位单元104;天文定位单元104利用基于星光折射的解析天文定位方法实现天文定位,具体过程如下:
如图3所示,根据星光折射的几何原理,可以得到:
其中:α为折射后的星光矢量与飞行器位置矢量之间的夹角;Re为地球半径;ha为视高度;rs为地心距,即飞行器到地心的距离。
当观测到n颗折射恒星时,根据夹角α的定义可得:
将公式(1)代入方程组(2),可得
其中:hai(i=1,2,...,n)为第i颗折射恒星的视高度。
方程组(3)中,地球半径Re为已知量,折射后的星光矢量可以由大视场星敏感器101获得,视高度hai可利用大视场星敏感器101、大气折射模型102和数字滤波器103得到,因此该方程组实际上含有rx,ry,rz和rs四个未知数。这样,根据的约束条件,如果同时观测三颗或三颗以上的折射恒星,就可以确定地心距rs和地心单位矢量进而求得飞行器的三维位置信息(经度、纬度和高度)。目前,随着大视场星敏感器技术的发展,同时观测多颗折射恒星变成了可能。当大视场星敏感器101观测到n≥3颗折射恒星时,方程组(3)可以写成:
其中:
式中,B=(UTU)-1UT为矩阵U的广义逆矩阵。
采用牛顿迭代法解算方程(6),具体迭代步骤如下:
(3)选取一个初始的地心距rs(0);
(4)利用迭代公式计算出下一时刻的地心距;
迭代公式为:
其中:rs(k)、rs(k+1)分别为第k次和第k+1次的地心距估计值;A为F(rs)对rs的微分,即:
其中:为Z对地心距rs的偏微分,即:
(3)若|rs(k+1)-rs(k)|<τ(τ为给定的小量),则迭代结束,且rs(k+1)为地心距rs的数值解;否则,以rs(k+1)作为新的初始条件返回第(2)步重新进行计算。
根据地心距的定义,由地心距rs可以确定飞行器的高度h为:
h=rs-Re (8)
因此,根据公式(9)可以确定飞行器的赤经αd、赤纬δd为
αd=arctan(ry/rx),δd=arcsin(rz) (10)其中:αd∈(0~2π),δd∈(-π/2~π/2)。
将惯性系下的坐标赤经、赤纬(αd,δd)转变为地理系下的经、纬度坐标(λ,L),即:
λ=αd-tG,L=δd (11)
其中:(λ,L)为飞行器的经、纬度;tG为春分点的格林时角,可由时间基准得到。
b、惯性导航信息的计算
惯性位置信息(λs,Ls)和惯性姿态信息(θc,γc)可由SINS解算单元202求出。惯性导航子系统2利用惯性测量单元201测量飞行器的加速度信息(fb)和角速度信息SINS解算单元202根据加速度信息(fb)和角速度信息解算出飞行器的位置信息(λs,Ls)和姿态信息(θs,γs)。
步骤二:组合导航系统状态方程的建立
选择东北天地理坐标系作为导航坐标系,组合导航系统的状态方程为SINS的误差方程,可以表示为:
FN是平台失准角误差、速度误差和位置误差对应的状态转移矩阵;G为噪声驱动矩阵:
步骤三:组合导航系统量测方程的建立
选取平台失准角误差和位置误差作为系统观测量,建立量测方程;
a、平台失准角误差的量测方程建立
平台失准角可由天文导航子系统1和惯性导航子系统2输出的姿态信息求得。令表示天文导航子系统1和惯性导航子系统2的姿态误差角,其可以定义为:
δθ=θs-θc
δγ=γs-γc
失准角计算单元301利用姿态误差角求得平台失准角φx,φy,φz为:
根据公式(14)、(15),可以根据天文导航子系统1和惯性导航子系统2的姿态输出求的平台失准角。进而可得平台失准角对应的观测方程为:
Z1=H1X+V1 (16)其中:Z1=[φx φy φz]T为平台失准角的观测量;H1=[I3×3 03×12]为平台失准角对应的观测矩阵;V1为观测噪声。
b、位置误差的量测方程建立
将天文导航子系统1与惯性导航子系统2位置输出的差值作为位置误差的观测量,则位置误差对应的观测方程为:
Z2=H2X+V2 (17)
其中:Z2=[Ls-Lc λs-λc]T为位置误差的观测量;Lc,λc为天文导航子系统1输出的位置信息,Ls,λs为惯性导航子系统2输出的位置信息;H2=[02×6 I2×2 02×7]为位置误差对应的观测矩阵;V2为CNS的定位误差。
步骤四:基于卡尔曼滤波的组合导航系统信息融合
卡尔曼滤波器302利用捷联惯导的误差方程作为状态方程,将天文导航子系统1和惯性导航子系统2位置输出的差值和失准角计算单元301输出的平台失准角作为观测值,利用卡尔曼滤波算法对导航误差进行实时估计,并将估计误差发送到SINS解算单元202,对导航误差进行校正,提高导航精度。
Claims (2)
1.一种基于全面最优校正的SINS/CNS组合导航系统,其特征在于:包括天文导航子系统、惯性导航子系统和信息融合子系统;天文导航子系统和惯性导航子系统为信息融合子系统提供位置、姿态信息,信息融合子系统为惯性导航子系统提供估计误差;
所述天文导航子系统,包括大视场星敏感器、大气折射模型、数字滤波器、天文定位单元和天文定姿单元;大视场星敏感器将观测到的星光折射角提供给大气折射模型;大气折射模型根据星光折射角计算折射恒星的视高度,并将其提供给数字滤波器;数字滤波器对视高度信息进行降噪处理,并将处理后的信息发送给天文定位单元;天文定位单元利用基于星光折射间接敏感地平的解析天文定位方法得到位置信息和地平信息;天文定姿单元利用大视场星敏感器提供的惯性姿态信息和天文定位单元提供的地平信息确定姿态信息;该大视场星敏感器是采用数学仿真同时观测多颗恒星,直接输出飞行器的惯性姿态信息和折射恒星的星光折射角;该大气折射模型是国际参考大气(CIRA)1986,利用该大气折射模型根据星光折射角计算出折射恒星的视高度;该数字滤波器是二阶数字低通滤波器;该天文定位单元是利用视高度信息计算飞行器的位置;该天文定姿单元是直接利用惯性姿态信息和地平信息计算飞行器相对于导航坐标系的姿态信息;
所述惯性导航子系统,包括惯性测量单元和SINS解算单元;INS解算单元利用惯性测量元件的输入解算出飞行器的位置和姿态信息;并利用信息融合子系统提供的估计误差对SINS导航误差进行校正;该惯性测量单元是由三个加速度计和三个陀螺仪组成,测量飞行器的加速度和角速度;该SINS解算单元是SINS解算过程,利用飞行器的加速度和加速度信息计算飞行器的位置、速度和姿态导航信息;
所述信息融合子系统,包括失准角计算单元和卡尔曼滤波器;失准角计算单元利用天文导航子系统和惯性导航子系统提供的姿态信息求得平台失准角,并提供给卡尔曼滤波器;卡尔曼滤波器以SINS误差方程为状态方程,以位置误差和平台失准角作为观测量进行卡尔曼滤波,得到平台失准角、位置误差和陀螺仪漂移误差的估计值;该失准角计算单元是根据惯性导航子系统和天文导航子系统姿态输出的误差角计算系统的失准角;该卡尔曼滤波器采用标准卡尔曼滤波算法,以SINS误差方程为状态方程,以位置误差和平台失准角作为观测量,对平台失准角、位置误差和陀螺仪漂移误差进行估计。
2.一种基于全面最优校正的SINS/CNS组合导航方法,其特征在于:具体包括以下步骤:
步骤一:天文导航信息和惯性导航信息的计算
a、天文导航信息的计算
利用大视场星敏感器观测多颗导航恒星和折射恒星,得到星光折射角;大气折射模型利用星光折射角计算出视高度,利用数字滤波器对视高度进行预处理,得到的处理结果用于天文定位单元;天文定位单元利用基于星光折射的解析天文定位方法实现天文定位,具体过程如下:
根据星光折射的几何原理,得到:
其中:α为折射后的星光矢量与飞行器位置矢量之间的夹角;Re为地球半径;ha为视高度;rs为地心距,即飞行器到地心的距离;
当观测到n颗折射恒星时,根据夹角α的定义得:
将公式(1)代入方程组(2),得
其中:hai(i=1,2,...,n)为第i颗折射恒星的视高度;
方程组(3)中,地球半径Re为已知量,折射后的星光矢量由大视场星敏感器获得,视高度hai利用大视场星敏感器、大气折射模型和数字滤波器得到,因此该方程组实际上含有rx,ry,rz和rs四个未知数;这样,根据的约束条件,如果同时观测三颗或三颗以上的折射恒星,就确定地心距rs和地心单位矢量进而求得飞行器的三维位置信息即经度、纬度和高度;当大视场星敏感器观测到n≥3颗折射恒星时,方程组(3)写成:
其中:
式中,B=(UTU)-1UT为矩阵U的广义逆矩阵;
采用牛顿迭代法解算方程(6),具体迭代步骤如下:
(1)选取一个初始的地心距rs(0);
(2)利用迭代公式计算出下一时刻的地心距;
迭代公式为:
其中:rs(k)、rs(k+1)分别为第k次和第k+1次的地心距估计值;A为F(rs)对rs的微分,即:
其中:为Z对地心距rs的偏微分,即:
(3)若|rs(k+1)-rs(k)|<τ,τ为给定的小量,则迭代结束,且rs(k+1)为地心距rs的数值解;否则,以rs(k+1)作为新的初始条件返回第(2)步重新进行计算;
根据地心距的定义,由地心距rs确定飞行器的高度h为:
h=rs-Re (8)
因此,根据公式(9)确定飞行器的赤经αd、赤纬δd为
αd=arctan(ry/rx),δd=arcsin(rz) (10)
其中:αd∈(0~2π),δd∈(-π/2~π/2);
将惯性系下的坐标赤经、赤纬(αd,δd)转变为地理系下的经、纬度坐标(λ,L),即:
λ=αd-tG,L=δd (11)
其中:(λ,L)为飞行器的经、纬度;tG为春分点的格林时角,由时间基准得到;
这样,天文定位单元输出天文位置信息和地平信息;
天文姿态信息由天文定姿单元求得,天文定姿单元利用惯性姿态信息和地平信息,直接计算出天文姿态信息;
b、惯性导航信息的计算
惯性位置信息和惯性姿态信息由SINS解算单元求出,惯性导航子系统利用惯性测量单元测量飞行器的加速度信息和角速度信息;SINS解算单元根据加速度信息和角速度信息解算出飞行器的位置信息和姿态信息;
步骤二:组合导航系统状态方程的建立
选择东北天地理坐标系作为导航坐标系,组合导航系统的状态方程为SINS的误差方程,表示为:
FN是平台失准角误差、速度误差和位置误差对应的状态转移矩阵;G为噪声驱动矩阵:
步骤三:组合导航系统量测方程的建立
选取平台失准角误差和位置误差作为系统观测量,建立量测方程;
a、平台失准角误差的量测方程建立
δθ=θs-θc
δγ=γs-γc
其中:θc,γc是天文导航子系统输出的姿态信息,θs,γs是惯性导航子系统输出的姿态信息;
失准角计算单元利用姿态误差角求得平台失准角φx,φy,φz为:
根据公式(14)、(15),根据天文导航子系统和惯性导航子系统的姿态输出求的平台失准角,进而得平台失准角对应的观测方程为:
Z1=H1X+V1 (16)
其中:Z1=[φx φy φz]T为平台失准角的观测量;H1=[I3×3 03×12]为平台失准角对应的观测矩阵;V1为观测噪声;
b、位置误差的量测方程建立
将天文导航子系统与惯性导航子系统位置输出的差值作为位置误差的观测量,则位置误差对应的观测方程为:
Z2=H2X+V2 (17)
其中:Z2=[Ls-Lc λs-λc]T为位置误差的观测量;Lc,λc为天文导航子系统输出的位置信息,Ls,λs为惯性导航子系统输出的位置信息;H2=[02×6 I2×2 02×7]为位置误差对应的观测矩阵;V2为CNS的定位误差;
步骤四:基于卡尔曼滤波的组合导航系统信息融合
卡尔曼滤波器利用捷联惯导的误差方程作为状态方程,将天文导航子系统和惯性导航子系统位置输出的差值和失准角计算单元输出的平台失准角作为观测值,利用卡尔曼滤波算法对导航误差进行实时估计,并将估计误差发送到SINS解算单元,对导航误差进行校正,提高导航精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310001151.4A CN103076015B (zh) | 2013-01-04 | 2013-01-04 | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310001151.4A CN103076015B (zh) | 2013-01-04 | 2013-01-04 | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103076015A true CN103076015A (zh) | 2013-05-01 |
CN103076015B CN103076015B (zh) | 2015-10-28 |
Family
ID=48152628
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310001151.4A Expired - Fee Related CN103076015B (zh) | 2013-01-04 | 2013-01-04 | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103076015B (zh) |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103630109A (zh) * | 2013-12-08 | 2014-03-12 | 北京航空航天大学 | 一种基于星光折射确定地心矢量的方法 |
CN103674021A (zh) * | 2013-11-25 | 2014-03-26 | 哈尔滨工业大学 | 基于捷联惯导与星敏感器的组合导航系统及方法 |
CN103838914A (zh) * | 2013-12-30 | 2014-06-04 | 北京航空航天大学 | 一种高超声速飞行器滑翔段弹道解析求解方法 |
CN103913169A (zh) * | 2014-03-12 | 2014-07-09 | 哈尔滨工程大学 | 一种飞行器的捷联惯性/星光折射组合导航方法 |
CN104034334A (zh) * | 2014-06-05 | 2014-09-10 | 哈尔滨工程大学 | 一种小视场星敏感器的单星及双星定姿方法 |
CN104251701A (zh) * | 2013-06-26 | 2014-12-31 | 上海新跃仪表厂 | 火星大气制动轨道确定方法 |
CN103994763B (zh) * | 2014-05-21 | 2016-11-02 | 北京航空航天大学 | 一种火星车的sins/cns深组合导航系统及其实现方法 |
CN103968835B (zh) * | 2014-05-14 | 2017-02-15 | 哈尔滨工程大学 | 一种折射星的模拟方法 |
CN106568446A (zh) * | 2016-10-18 | 2017-04-19 | 北京航空航天大学 | 一种自旋状态下的姿态确定系统 |
CN107356786A (zh) * | 2017-07-31 | 2017-11-17 | 北京京东尚科信息技术有限公司 | 加速度计的校准方法和装置、计算机可读存储介质 |
CN107677266A (zh) * | 2017-09-03 | 2018-02-09 | 陈应天 | 基于自旋‑仰角跟踪理论的星光导航系统及其解算方法 |
CN108594272A (zh) * | 2018-08-01 | 2018-09-28 | 北京航空航天大学 | 一种基于鲁棒卡尔曼滤波的抗欺骗干扰组合导航方法 |
CN110088561A (zh) * | 2016-12-16 | 2019-08-02 | 赛峰电子与防务公司 | 用于安装在移动载体上的通过恒星重置的目标定位装置 |
CN110672128A (zh) * | 2019-11-05 | 2020-01-10 | 中国人民解放军国防科技大学 | 一种星光/惯性组合导航及误差在线标定方法 |
CN111060097A (zh) * | 2020-01-15 | 2020-04-24 | 东南大学 | 一种提高位置误差估计精度的惯性/天文组合导航方法 |
CN111351480A (zh) * | 2020-03-17 | 2020-06-30 | 北京航空航天大学 | 一种基于转动的飞行器调姿路径优化方法 |
CN111537003A (zh) * | 2020-06-19 | 2020-08-14 | 北京航空航天大学 | 一种基于折射面共线的星光大气折射测量校正方法 |
CN111707259A (zh) * | 2020-06-16 | 2020-09-25 | 东南大学 | 一种校正加速度计误差的sins/cns组合导航方法 |
CN112461511A (zh) * | 2020-11-10 | 2021-03-09 | 中国科学院长春光学精密机械与物理研究所 | 浮空平台望远镜指向获取方法、装置、设备及存储介质 |
CN113551667A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN114646312A (zh) * | 2022-03-07 | 2022-06-21 | 西北工业大学 | 一种基于星光折射信息的天文解析定位方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101788296A (zh) * | 2010-01-26 | 2010-07-28 | 北京航空航天大学 | 一种sins/cns深组合导航系统及其实现方法 |
RU2442108C1 (ru) * | 2010-10-27 | 2012-02-10 | Открытое акционерное общество "Московский институт электромеханики и автоматики" | Способ астроинерциальной навигации и устройство для его реализации |
-
2013
- 2013-01-04 CN CN201310001151.4A patent/CN103076015B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101788296A (zh) * | 2010-01-26 | 2010-07-28 | 北京航空航天大学 | 一种sins/cns深组合导航系统及其实现方法 |
RU2442108C1 (ru) * | 2010-10-27 | 2012-02-10 | Открытое акционерное общество "Московский институт электромеханики и автоматики" | Способ астроинерциальной навигации и устройство для его реализации |
Non-Patent Citations (2)
Title |
---|
宁晓琳 等: "一种星光折射卫星自主导航系统方案设计", 《宇航学报》 * |
李旻珺 等: "星光折射导航星的改进三角识别捕获", 《航天控制》 * |
Cited By (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104251701A (zh) * | 2013-06-26 | 2014-12-31 | 上海新跃仪表厂 | 火星大气制动轨道确定方法 |
CN103674021A (zh) * | 2013-11-25 | 2014-03-26 | 哈尔滨工业大学 | 基于捷联惯导与星敏感器的组合导航系统及方法 |
CN103630109A (zh) * | 2013-12-08 | 2014-03-12 | 北京航空航天大学 | 一种基于星光折射确定地心矢量的方法 |
CN103838914A (zh) * | 2013-12-30 | 2014-06-04 | 北京航空航天大学 | 一种高超声速飞行器滑翔段弹道解析求解方法 |
CN103838914B (zh) * | 2013-12-30 | 2017-01-18 | 北京航空航天大学 | 一种高超声速飞行器滑翔段弹道解析求解方法 |
CN103913169B (zh) * | 2014-03-12 | 2017-01-25 | 哈尔滨工程大学 | 一种飞行器的捷联惯性/星光折射组合导航方法 |
CN103913169A (zh) * | 2014-03-12 | 2014-07-09 | 哈尔滨工程大学 | 一种飞行器的捷联惯性/星光折射组合导航方法 |
CN103968835B (zh) * | 2014-05-14 | 2017-02-15 | 哈尔滨工程大学 | 一种折射星的模拟方法 |
CN103994763B (zh) * | 2014-05-21 | 2016-11-02 | 北京航空航天大学 | 一种火星车的sins/cns深组合导航系统及其实现方法 |
CN104034334B (zh) * | 2014-06-05 | 2016-09-14 | 哈尔滨工程大学 | 一种小视场星敏感器的单星及双星定姿方法 |
CN104034334A (zh) * | 2014-06-05 | 2014-09-10 | 哈尔滨工程大学 | 一种小视场星敏感器的单星及双星定姿方法 |
CN106568446B (zh) * | 2016-10-18 | 2019-07-30 | 北京航空航天大学 | 一种自旋状态下的姿态确定系统 |
CN106568446A (zh) * | 2016-10-18 | 2017-04-19 | 北京航空航天大学 | 一种自旋状态下的姿态确定系统 |
CN110088561A (zh) * | 2016-12-16 | 2019-08-02 | 赛峰电子与防务公司 | 用于安装在移动载体上的通过恒星重置的目标定位装置 |
CN110088561B (zh) * | 2016-12-16 | 2020-04-07 | 赛峰电子与防务公司 | 用于安装在移动载体上的通过恒星重置的目标定位装置 |
CN107356786A (zh) * | 2017-07-31 | 2017-11-17 | 北京京东尚科信息技术有限公司 | 加速度计的校准方法和装置、计算机可读存储介质 |
CN107356786B (zh) * | 2017-07-31 | 2020-02-07 | 北京京东尚科信息技术有限公司 | 加速度计的校准方法和装置、计算机可读存储介质 |
CN107677266A (zh) * | 2017-09-03 | 2018-02-09 | 陈应天 | 基于自旋‑仰角跟踪理论的星光导航系统及其解算方法 |
CN108594272A (zh) * | 2018-08-01 | 2018-09-28 | 北京航空航天大学 | 一种基于鲁棒卡尔曼滤波的抗欺骗干扰组合导航方法 |
CN110672128A (zh) * | 2019-11-05 | 2020-01-10 | 中国人民解放军国防科技大学 | 一种星光/惯性组合导航及误差在线标定方法 |
CN110672128B (zh) * | 2019-11-05 | 2021-07-02 | 中国人民解放军国防科技大学 | 一种星光/惯性组合导航及误差在线标定方法 |
CN111060097A (zh) * | 2020-01-15 | 2020-04-24 | 东南大学 | 一种提高位置误差估计精度的惯性/天文组合导航方法 |
CN111351480A (zh) * | 2020-03-17 | 2020-06-30 | 北京航空航天大学 | 一种基于转动的飞行器调姿路径优化方法 |
CN111351480B (zh) * | 2020-03-17 | 2021-10-15 | 北京航空航天大学 | 一种基于转动的飞行器调姿路径优化方法 |
CN111707259A (zh) * | 2020-06-16 | 2020-09-25 | 东南大学 | 一种校正加速度计误差的sins/cns组合导航方法 |
CN111707259B (zh) * | 2020-06-16 | 2022-08-05 | 东南大学 | 一种校正加速度计误差的sins/cns组合导航方法 |
CN111537003A (zh) * | 2020-06-19 | 2020-08-14 | 北京航空航天大学 | 一种基于折射面共线的星光大气折射测量校正方法 |
CN111537003B (zh) * | 2020-06-19 | 2021-09-07 | 北京航空航天大学 | 一种基于折射面共线的星光大气折射测量校正方法 |
CN112461511A (zh) * | 2020-11-10 | 2021-03-09 | 中国科学院长春光学精密机械与物理研究所 | 浮空平台望远镜指向获取方法、装置、设备及存储介质 |
CN112461511B (zh) * | 2020-11-10 | 2022-03-25 | 中国科学院长春光学精密机械与物理研究所 | 浮空平台望远镜指向获取方法、装置、设备及存储介质 |
CN113551667A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN113551667B (zh) * | 2021-07-21 | 2024-05-24 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN114646312A (zh) * | 2022-03-07 | 2022-06-21 | 西北工业大学 | 一种基于星光折射信息的天文解析定位方法 |
CN114646312B (zh) * | 2022-03-07 | 2024-04-26 | 西北工业大学 | 一种基于星光折射信息的天文解析定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103076015B (zh) | 2015-10-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 | |
CN101344391B (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
CN101893440B (zh) | 基于星敏感器的天文自主导航方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航系统及其实现方法 | |
CN103323026B (zh) | 星敏感器和有效载荷的姿态基准偏差估计与修正方法 | |
CN104165640B (zh) | 基于星敏感器的近空间弹载捷联惯导系统传递对准方法 | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导系统初始对准方法 | |
CN103674030B (zh) | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 | |
CN103913181B (zh) | 一种基于参数辨识的机载分布式pos传递对准方法 | |
CN102519470B (zh) | 多级嵌入式组合导航系统及导航方法 | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 | |
CN103900611B (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN102829781B (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN1995916A (zh) | 一种基于星敏感器标定的深综合组合导航方法 | |
CN103033189A (zh) | 一种深空探测巡视器惯性/视觉组合导航方法 | |
CN103217159A (zh) | 一种sins/gps/偏振光组合导航系统建模及动基座初始对准方法 | |
CN101915579A (zh) | 一种基于ckf的sins大失准角初始对准新方法 | |
CN101706284A (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 | |
CN103630136A (zh) | 冗余传感器配置下基于三级滤波的导航参数最优融合方法 | |
CN112880669B (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
CN103884340A (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN102645223A (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 | |
CN102944241A (zh) | 基于多胞型线性微分包含的航天器相对姿态确定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20151028 Termination date: 20170104 |