SINSGPS紧组合与松组合导航系统性能仿真分析

合集下载
  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。

SINS/GPS紧组合与松组合导航系统性能仿真分析
王君帅,王新龙
(北京航空航天大学宇航学院,北京 100191)
摘 要:SINS/GPS组合可以有效提高导航系统的性能。

建立SINS/GPS全系统仿真模型,构建SINS仿真器、GPS星座,并给出最佳导航星的选择方法。

在建立SINS/GPS组合导航系统状态模型和量测模型的基础上,分别以位置、速度为观测量和以伪距、伪距率为观测量设计了松组合与紧组合导航系统的Kalman滤波器。

在相同的条件下,对这两种不同组合模式的导航系统进行仿真验证。

仿真结果表明,与松组合导航系统相比,紧组合导航系统的收敛性能更好,尤其是在受到外界干扰或遮挡,使可用的导航星数目不足四颗时,紧组合导航系统具有更好的导航性能。

关键词:组合导航;位置;速度;伪距;伪距率
中图分类号:V249.32+8 文献标识码:A 文章编号:1673-5048(2013)02-0014-06
SimulationandAnalysisofSINS/GPSTightlyCoupledandLooselyCoupledIntegratedNavigationSystem
WANGJun-shuai,WANGXin-long
(SchoolofAstronautics,BeijingUniversityofAeronauticsandAstronautics,Beijing100191,China)
Abstract:TheperformanceofnavigationsystemcanbeeffectivelyaugmentedbySINSandGPSinte-gration.Thesimulationmodeloftheintegratedsystemisestablished,SINSsimulatorandGPSsatellitegroupsareconstructed,andthealgorithmofchoosingthebestsatellitegroupisalsopresented.Basedontheestablishedstateandmeasurementmodelsoftheintegratedsystem,theKalmanfiltersoflooselyandtightlycouplednavigationsystemsaredesigned,whichrespectivelychoosesposition,velocityandpseudo-range,pseudo-rangerateasmeasurements.Underthesameconditions,thetwodifferentintegratednavi-gationmodesaresimulatedandverifiedrespectively.Thesimulationresultsshowthatthetightlycoupledsystemhasbetterperformanceinconvergencecomparingwiththelooselyone,andespeciallywhenthenumberofavailablenavigationsatellitesarelessthanfourwhichiscausedbyoutsideinterferenceorshel-tered,thetightlycouplednavigationsystemhasbetterperformance.
Keywords:integrationnavigation;position;velocity;pseudo-range;pseudo-rangerate
0 引 言
捷联惯性导航系统(SINS)利用陀螺仪、加速
收稿日期:2012-08-15
基金项目:国家自然科学基金(61074157)资助项目;航空科学基金(20090151004)资助项目
作者简介:王君帅(1987-),男,河北邢台人,硕士研究生,研究方向为GPS导航。

度计惯性元件得到移动目标的位置和速度;仅靠系统本身能在全天候条件下,全球范围内自主地、隐蔽地提供多种较高精度的导航参数,其缺点是误差(尤其是位置误差)随时间积累。

全球卫星导航系统(GPS)定位和测速精度高,基本不受地域、时间限制;但是,当载体作大机动飞行或有地形遮挡时,GPS导航信息有可能中断,或动态误差过大,不能使用。

因此,SINS与GPS具有优势互补的
2013年第2期2013年4月
航空兵器
AEROWEAPONRY 2013No.2
Apr.2013
特点,SINS/GPS组合导航系统可以大大提高系统
整体的导航精度和性能[1]。

从结构上或信息交换及组合程度上,GPS与SINS的组合方式分为:松组合和紧组合。

松组合是一种最简单的组合应用方式,在这种方式下,SINS和GPS各自独立工作,组合滤波器融合两者的数据并给出最优的估计结果,最后反馈给SINS进行修正。

该组合方式可以提供比单独GPS或单独SINS更好的导航结果。

但是,当卫星信号中断无法提供定位信息时,系统的组合就被完全破环,整个导航系统性能就会迅速恶化。

紧组合是一种相对复杂的组合方式。

紧组合中,GPS提供给组合滤波器的量测信息是接收机用于定位的原始信息,即伪距、伪距率和多普勒频率等,而松组合的量测信息是通常有时间相关性的位置和速度,因此紧组合可以获得更高的定位精度[1-2]。

当载体动态运动或外界干扰使可见星数目不足4颗时,紧组合系统可以利用仅有的可用星实现信息融合,避免系统转换为纯惯导系统,因此紧组合系统比松组合系统有更强的抗干扰性能,更适用于高动态的导航应用。

本文分别采用紧组合和松组合两种组合方式构建了SINS/GPS组合导航系统,并对两种组合系统的性能进行了仿真与对比分析。

1 SINS/GPS组合导航系统结构方案1.1 紧组合结构设计方案
紧组合结构框图见图1。

图中,紧组合导航系统主要由惯导子系统、GPS子系统和卡尔曼滤波器3部分组成[2]。

其中,惯导子系统利用轨迹发生器模拟飞机状态,惯导模拟器根据飞机状态产生对应的比力和角速率,惯导解算单元则根据惯导模拟器的输出,解算出SINS系统的导航输出信息,即位置和速度。

GPS子系统主要包括导航星模拟器和伪距计算等。

导航模拟器利用星历计算卫星的位置和速度,并根据载体位置选出可用性最好的卫星,随后根据载体位置、速度与卫星位置、速度得到伪距和伪距率。

伪距计算模块根据这些卫星的速度和位置信息与惯导子系统输出的位置和速度信息计算出惯导伪距和伪距率。

最后,惯导伪距和伪距率与GPS接收机的伪距和伪距率之差作为卡尔曼滤波器的输入,得到惯导系统状态误差估计值。

将状态误差估计值的陀螺仪和加速度计漂移反馈给惯导系统以对其进行校正,状态误差估计值中的位置和速度误差对惯导解算后的位置和速度信息进行校准,输出为紧组
合系统的最终导航结果。

图1 紧组合结构框图
1.2 松组合结构设计方案
图2是松组合系统的结构框图。

与紧组合系统的区别在于,松组合系统中采用的量测信息是位置和速度,利用GPS子系统解算得到的位置、速度与惯导解算出的位置、速度之差作为卡尔曼滤波器的输入。

松组合卡尔曼滤波器的反馈校正和结
果校正与紧组合相同。

图2 松组合结构框图
2 SINS仿真器
2.1 飞行轨迹发生器
选取高动态的战斗机为载体,作为模拟导航的飞行器。

根据预先设定的飞行状态,产生相应的速度、加速度、位置、比力和姿态等信息,作为惯导系统的输入。

飞行轨迹包括起飞、爬升、转弯、加速、减速、平飞等飞行状态。

2.2 惯性测量模拟器
(1)陀螺仪
陀螺仪是惯性测量中测量载体角运动的器件。

陀螺仪的输出可以表示为
ω~ib=ωib+ε(1)式中:ωib为轨迹发生器得到的角速率;ε为陀螺误
·51·
王君帅等:SINS/GPS紧组合与松组合导航系统性能仿真分析
差。

陀螺误差主要表现在陀螺漂移和噪声。

陀螺误差的表达式为
ε=εb+ωg(2)式中:εb为陀螺常值漂移率;ωg为白噪声。

(2)加速度计
考虑到加速度计在测量过程中存在零偏误差,则加速度计的输出在载体系可以表示为a~ib=aib+Δ+ωa(3)式中:aib为轨迹发生器的比力输出;Δ为加速度计零偏;ωa为白噪声。

2.3 导航解算
根据惯性测量模拟器的输出,即角速率和比力信息,对惯导系统进行解算,得到飞行器的位置、速度和姿态等导航信息。

具体解算过程如图3
所示。

图3 惯导解算原理框图
3 GPS导航模拟器
GPS空间卫星星座(BLOCKΠ)共由24颗卫星组成,均匀分布在6个轨道中,各个轨道面与赤道面的夹角都为55°,这样可以保证全球任何位置、任何时刻的用户所看到的卫星数目都足以满足导航要求。

3.1 基于广播星历的卫星轨道计算
精确的轨道信息是精密定位的基础,通过GPS广播星历和相应算法可以得到所需时刻卫星的轨道信息[3],这些信息可以实现卫星星座实时仿真,还可以用于计算SINS的伪距和伪距率,以实现SINS/GPS的紧组合导航。

3.2 导航星座的选择
选择最佳的导航星座,对提高GPS的定位精度具有重要的意义。

选择最佳导航星座主要考虑两个方面:一方面是选取GPS可见星,选取可见星的基本原则是观测仰角需大于15°,这是因为仰角过低时,卫星到接收机的大气传播误差增大,造成伪距精度明显下降;另一方面是使几何精度衰减因子GDOP最小,以获得最好的定位精度[4]。

通常选择GDOP因子最小的导航星座的方法有两种:一种是对所有能观测到的卫星进行组合计算GDOP,总共需要计算C4n次GDOP数值(n为可见卫星数),计算量很大;另一种是根据几何精度因子GDOP与由接收机和卫星组成的四面体的体积V成反比,来选择星座[4]。

本文采用的星座选择方法是在第二种方法的基础上加以改进,提高了计算速度和精度。

算法实现过程如下:
(1)根据SINS所确定的载体位置计算卫星高度角,选择高度角最大的一颗卫星s1。

(2)然后分别在北方和东方选择与s1有最大角距的两颗卫星s2和s3。

(3)从剩余的可见星中,按最小GDOP原则选择第四颗星s4。

得到的s1,s2,s3和s4即为GDOP因子最小的星座。

4 SINS/GPS组合滤波器的设计
4.1 SINS/GPS系统的状态方程
4.1.1 SINS误差状态方程
SINS误差状态由位置误差、速度误差、姿态误差角、加速度计零偏误差以及陀螺漂移误差等组成[5]。

误差状态向量为
XI=[δL δλ δh δvx δvy δvz φx φy
φz εbx εby εbz Δbx Δby Δbz]坐标系的定义为:i为地心惯性系,t为当地地理坐标系,e为地心地固坐标系,p为惯导平台坐标系,b为载体坐标系,c为大地坐标系。

SINS系统的误差状态方程表达式[6]:
X·I=FIXI+GIWI(4)式中,系统噪声为
WI=wgxwgywgzwaxwaywazT(5)4.1.2 GPS误差状态方程
在紧组合中,采用伪距和伪距率作为量测信息,通常选取两个与时间有关的误差:一个是与时钟误差等效的距离误差bclk,即时钟误差与光速的积;另一个是与时钟频率误差等效的距离率误差dclk,即时钟频率误差与光速的积[6]。

则GPS的误差状态方程可以表示为
b·clk=dclk+ωb
d·clk=-1T
clk
dclk+ωd(6)
·61·航空兵器 2013年第2期
式(6)的矩阵表示形式为
X·
G=FGXG+GGWG
(7)
其中:Tclk为相关时间;XG=[bclkdclk]T;WG=
[ωb
ωd]T。

4.1.3 SINS/GPS组合系统的状态方程
将式(4)与式(7)合并,可以得到组合导航系统状态方程:
X·IX
·G

FI




XI
XG

GI00
GG
WI
WG
(8)

X·
t=FtXt+GtWt(9)其中:Xt=[δL δλ δh δvx δvy δvz φx φy φz εbx εby εbz Δbx Δby Δbz bclk dclk]。

4.2 SINS/GPS组合系统的量测方程4.2.1 SINS/GPS紧组合系统的量测方程
紧组合系统采用SINS推算的伪距和伪距率与GPS测量得到的伪距和伪距率之差作为量测信息[5]。

在紧组合系统中,GPS接收机测得的伪距为ρGi,由SINS测量得到的载体位置(xI,yI,zI)和由卫星星历给出第i颗卫星位置(xi
s,yi
s,zi
s)所确定的卫星伪距为ρIi。

两者之差可以得到伪距量测方程:
δρi=ρIi-ρGi=liδx+miδy+niδz-bclk-υρi
(10)
其中:li=x-xis
ri,mi=y-yis
ri,ni=z-zis
ri
,为载体到
卫星Si的向量的方向余弦,ri=
x-xi


+y-yi


+z-zi
s2。

由GPS测得的伪距率ρ·
Gi和SINS得到的伪距
率ρ·
Ii之差可以得到伪距率量测方程:
δρ·i=ρ·Ii-ρ·Gi=liδx·+miδ痹y+niδz·-dclk-υρ·i(11)在导航时,可以根据可用星的数目,选择卫星数量,选择所用伪距和伪距率的个数,这样在可用星少于4颗时,仍然可以继续导航。

将式(10)与式(11)合并,可以得到紧组合系统的量测方程:
Zt=
HtXt+Vt(12)4.2.2 SINS/GPS松组合系统的量测方程
松组合系统采用SINS解算的位置和速度与
GPS测量到的位置和速度之差作为量测信息[7]。

设载体的真实位置为x,y,z,速度为
vx,vy,vz,SINS解算出的位置为xI,yI,zI,速度
为vxI,vyI,vzI,GPS给出的位置为xG,yG,zG,速
度为vxG,vyG,vzG。

量测信息是地理系中的位置差
和速度差。

由SINS解算的位置与GPS测量的位置之差,并将位置误差转换到大地坐标系中,可以得到位置量测方程:
Δx=xI-
xG=δx+nxΔy=yI-yG=δy+nyΔz=zI-zG=δz+nz
(13)
同理可以得到速度量测方程:
Δvx=vxI-vxG=δvx+nvx
Δvy=vyI-vyG=δvy+nvyΔvz=vzI-vzG=δvz+nvz
(14)
将式(13)与式(14)合并,可以得到松组合系统的量测方程:
Zl=HlXl+Vl
(15)5 仿真及结果分析
5.1 仿真条件
仿真过程中,在等效初始条件下,分别采用SINS/GPS紧组合和松组合方式对SINS的导航结果进行校正。

通过对比最终的导航误差来比较两种组合方式的导航性能。

同时,为了对比两种组合
方式的抗干扰性能,在90~130s期间,可用星数目降为2颗。

利用轨迹发生器产生的战斗机飞行轨迹,飞机飞行过程包括起飞、爬升、转弯、加速、减速、平飞等飞行状态。

利用SINS模拟器产生SINS测量数据。

具体仿真条件为:飞机初始位置为东经116°,北纬40°,导航坐标系为当地地理坐标系,飞行过程约300s;陀螺仪的常值漂移为2(°)/h,白噪声均方差为0.02(°)/h;加速度计的常值零偏为1×10
-4
g,
加速度计白噪声均方差为1×10-6
g;伪距、伪距率的白噪声均方差分别为30m和0.05m/s;SINS系统的输出频率为100Hz,GPS系统的输出频率为10Hz,组合系统的数据输出频率为100Hz。

5.2 仿真结果及分析5.2.1 无干扰情况下的仿真对比
根据上述仿真条件,在无干扰情况(即可用星数目一直大于3时)下,分别得到紧组合和松组合系统仿真结果。

图4为单纯SINS的位置误差,图5~7分别为紧组合与松组合系统位置误差对比结果。

表1为仿真的结果对比。

·
71·王君帅等:SINS/GPS紧组合与松组合导航系统性能仿真分析
图4 单纯
SINS位置误差图
5 东向位置误差图
6 北向位置误差对比图7 高度误差对比
表1 无干扰时,紧组合与松组合仿真结果对比
紧组合
东向北向天向
松组合
东向北向天向
位置误差均值/m1.81.94.34.14.17.5
位置误差范围/m-1.0~7.8-2.2~110.7~13.1-1.8~10.3-2.9~12.3-3.1~15.5位置误差标准差/m2.33.23.53.43.45.5
通过图4可以看到,单纯SINS导航系统的位置误差随着时间的增加而逐渐积累发散。

图5~7的结果表明,利用GPS与SINS进行组合导航,无论是紧组合还是松组合都可以有效抑制惯导误差的发散,提供更精确的导航结果。

紧组合和松组合系统都是基于最优估计理论,利用GPS的导航信息与SINS的导航信息,估计出SINS的导航误差估计值,并对SINS的导航结果进行校正,因此两种组合都可以使导航误差收敛,提高导航精度。

通过对比图5~7及表1中的数据可以看到,紧组合比松组合系统收敛速度更快,稳态误差更小。

松组合利用的量测信息是GPS输出的位置和速度,GPS的位置和速度通常是相关的(在GPS接收机内部采用卡尔曼滤波器的情况下尤为严重),而紧组合系统采用的是接收机用于定位解算的原始信息伪距和伪距率,克服了松组合方式中相关量测问题,提高了系统的导航精度。

GPS接收机中的位置和速度解算过程中,利用了伪距和伪距率,因此,在得到的位置和速度中,除了包含有GPS中伪距和伪距率误差外,还有数据计算误差和数据延迟,使得利用伪距和伪距率作为量测信息的紧组合系统比采用位置、速度作为量测信息的松组合系统的误差收敛更快,误差更小。

5.2.2 有干扰情况下的仿真对比
为了验证,在不良的导航环境下,紧组合系统比松组合系统导航性能更好。

在90~130s期间,可用星数目减小为2颗,随后恢复成4颗。

图8和图9分别是在受干扰情况下,松组合与紧组合的位置误差。

表2为各个图中曲线的具体对比结果。

通过图8的曲线和表2,可以看出,松组合导航系统在受干扰期间位置误差持续发散,其中东向和北向的最大位置误差分别达到47m和49.2m,而高度最大误差达到36.9m,当可用星数目恢复4颗后,误差逐渐变小。

整个仿真过程中松组合的东北天三个方向的位置误差均值分别是18
m、20.5m和18.8m。

图9和表2可以看到,紧组
·81·航空兵器 2013年第2期

8 有干扰情况下松组合位置误差图9 有干扰情况下紧组合位置误差表2 有干扰情况下,紧组合与松组合对比结果
紧组合
东向北向天向
松组合
东向北向天向
位置误差均值/m2.02.64.51820.518.8
位置误差范围/m-0.3~5.6-1.4~8.12.4~8.04.8~47.06.4~49.26.0~36.9位置误差标准差/m1.42.31.512.212.78.2
合导航系统在受到干扰时,有小的波动,但可以维持导航系统的性能,东北天三个方向的位置误差均值分别为2m、2.6m和4.5m,比松组合的误差均值小很多。

通过对比紧组合与松组合在导航系统因受干扰而可用星数目小于4颗时的误差曲线,可以看出,紧组合系统在可用星数目不足时,可提高系统的导航性能,这也增强了导航系统的环境适应能力。

在90~130s期间,可用星数目减小到2,由于
GPS接收机在可用星数目大于等于4时,才能解算出接收机的位置和速度,因此,在松组合系统,GPS不能提供量测信息,导航系统就转换为纯惯导系统,导航误差会随时间增大,逐渐发散。

而紧组合系统的量测信息是卫星伪距和伪距率,可以根据可用星的个数来调节量测方程的维数,仅需一颗可见星的伪距和伪距率,就可以实现滤波,但考虑到误差状态可观测度,可见星数目越多,可观测度越好,当有2或3颗可见星时,导航性能不如4颗卫星时好,但仍可以避免紧组合系统转换为纯惯导系统,因此可大大提高系统的抗干扰性能。

6 结 论
本文通过对SINS/GPS组合导航系统结构、SINS仿真器、GPS模拟器、卡尔曼滤波器等的设计,建立了基于位置和速度的SINS/GPS松组合以及基于伪距和伪距率的SINS/GPS紧组合导航系统。

两种组合系统都可以抑制单独SINS系统误差的发散,得到比单独SINS好很多的导航结果。

紧组合导航系统比松组合系统误差收敛速度快,导航精度更高;当导航环境受到外界影响,造成可用星数目不足时,紧组合系统可以利用仅有的可用星实现信息融合,避免系统转换为纯惯导系统,因此紧组合系统比松组合系统有更强的抗干扰性能,更适用于高动态的导航环境。

参考文献:
[1]黄汛,高启孝,李安,等.INS/GPS超紧耦合技术研究现状及展望[J].控制与制导,2009(1):42-43.[2]AlbanS,AkosDM,RockSM.PerformanceAnalysisandArchitecturesforINS-AidedGPSTrackingLoops[C]∥Proceedingsofthe2003NationalTechnicalMeetingofthe
InstituteofNavigation,2003:611-622.
[3]刘磊,盛峥,王迎强.利用广播星历计算GPS卫星位置及误差分析[J].解放军理工大学学报,2006,7(6):593
-595.
[4]于洁,王新龙.GPS紧组合导航系统仿真研究[J].航空兵器,2008(6):8-13.
[5]王惠南.GPS导航原理与应用[M].北京:科学出版社,2003.
[6]YuJie,WangXin-long,JiJia-xing.DesignandAnalysisforanInnovativeSchemeofSINS/GPSUltra-TightInte-gration[J].AircraftEngineeringandAerospaceTechnolo-gy:AnInternationalJournal,2010,82(1):4-11.[7]张宗麟.惯性导航与组合导航[M].北京:航空工业出版社,2000.
·91·
王君帅等:SINS/GPS紧组合与松组合导航系统性能仿真分析
SINS/GPS 紧组合与松组合导航系统性能仿真分析
作者:王君帅, 王新龙
作者单位:北京航空航天大学宇航学院,北京 100191
刊名:
航空兵器
英文刊名:Aero Weaponry
年,卷(期):2013(2)
1.黄汛;高启孝;李安INS/GPS 超紧耦合技术研究现状及展望 2009(01)
2.Alban S;Akos D M;Rock S M Performance Analysis andArchitectures for INS -Aided GPS Tracking Loops 2003
3.刘磊;盛峥;王迎强利用广播星历计算GPS 卫星位置及误差分析[期刊论文]-解放军理工大学学报 2006(06)
4.于洁;王新龙GPS 紧组合导航系统仿真研究 2008(06)
5.王惠南GPS 导航原理与应用 2003
6.Yu Jie;Wang Xin-long;Ji Jia-xing Design and Analysisfor an Innovative Scheme of SINS/GPS Ultra -Tight Integration 1201(01)
7.张宗麟惯性导航与组合导航 2000
引用本文格式:王君帅.王新龙SINS/GPS 紧组合与松组合导航系统性能仿真分析[期刊论文]-航空兵器 2013(2)。

相关文档
最新文档