文章编号:1006-1576(2007)09-0027-02
SINS/北斗组合导航Kalman滤波仿真
吴韦华,李玉柏
(电子科技大学 通信与信息工程学院,四川 成都 610054)
摘要:在SINS/北斗组合导航中,比较松散组合与紧密组合两种方式。分别使用输出校正和反馈校正进行Kalman滤波,其中松散组合采用的是位置、速度组合,紧密组合采用的是伪距、伪距率组合,仿真结果表明采用反馈校正的紧密组合能在较长时间保持更高的导航精度。
关键词:组合导航;Kalman滤波;松散组合;紧密组合;导航精度 中图分类号:V249.32; TP391.9 文献标识码:A
Kalman Filtering Simulation of SINS/Triones Combined Navigation
WU Wei, LI Yu-bai
(School of Communication & Information Engineering, University of Electronic Science &
Technology of China, Chengdu 610054, China)
Abstract: In SINS/Triones combined navigation, two modes, the loosely coupled and the tightly coupled, are compared. Kalman filtering is applied to both output correction and feedback correction, the loosely coupled mode adopts position and velocity combination and the tightly coupled mode adopts pseudo range and rate of pseudo range combination, simulation result shows that the tightly coupled mode with feedback correction has better navigation precision in longer time.
Keywords: Combined navigation; Kalman filtering; Loosely coupled; Tightly coupled; Navigation precision
0 引言
捷联惯导系统(SINS)和北斗二代在性能上具有互补性,故将两者构成组合导航系统。采用卡尔曼滤波方法实现组合导航,从概率统计最优角度估计出系统误差并消除[1],故采用间接法进行卡尔曼滤波。SINS与北斗的组合方式按组合深度的不同分为松散组合和紧密组合,经仿真比较采用位置、速度方式的松散组合与伪距、伪距率方式紧密组合。
状态方程中的导航坐标系采用的是东北天坐标系,L、λ、h分别表示纬度、经度、高度,V和φ分别表示速度和姿态角, 和ε分别是加速度计和陀螺误差,w是系统噪声。下式中的RM为子午圈曲率半径,RN为卯酉圈曲率半径,E、N、U分别表示东、北、天方向,ωie为地球自转角速度。
位置误差方程如下:
=δL =δλ
δVNVN
δh
RM+h(RM+h)2
1 组合导航滤波器的数学模型
1.1 状态方程
(t)=φ(t)X(t)+w(t)X
X=[δLδλδhδVEδVNδVU E N U x y zεxεyεz]T
(2) VEVEδVE
secLtanLδL secLhsecL+δRN+hRN+h(RN+h)2
=δVδhU
(1)
速度误差方程如下:
δVNδVN δVEδVE VEVN2 =f f + δVENUUN R+htanL R+h δVE+ 2ωiesinL+R+htanL δVN 2ωiecosL+R+h δVU+ 2ωiecosLVN+R+hsecL+2ωiesinLVU δL+ E
MNNN M
22 VEVNVU VEVNVUVE2 =f f 2 δh+ N +δ δ δ ω+δVωδ+secLLtanL+V2VcosLVtanLVsinLNUEEUENUEie2 ie RN+hRM+hRM+hRN+h(RM+h)2 (RM+h) 22 VE2VNVNVE
=f f 2 δh+ U δVω+δ δ ωδ +cosLtanLVV2VcosLLUENNEENEie ie RN+hRM+h(RN+h) (RM+h)
(3)
姿态角误差方程如下:
E= N= U
VN(RM+h)
δh
δVNVEVE
tanL N ωiecosL++ ωiesinL+ RM+h RN+hRN+h
U+εE
VN δVEVEVE
E+εN E ωiesinLδL δh ωiesinL+tanL 2 RM+h RN+h(RN+h)RN+h
VNδVEVEVEVE
E+=ωiecosL+δL ωiecosL++εUtanL tanLδh sec2L 2
RN+hRN+hRN+h RM+h(RN+h)
(4)
收稿日期:2007-07-07;修回日期:2007-09-10 作者简介:吴韦 华(1981-),男,四川人,电子科技大学在读硕士,从事信号与信息处理研究。
·27·
SINS/北斗组合导航Kalman... 2人阅读 3页 2.00元 基于联邦式Kalman滤波的...本文设计了基于联邦Kalman滤波的组合导航技术,进行了相应的数据仿真实验,并使用...
间接Kalman滤波器在航天器CNS/SINS组合导航中的应用_专业资料。为了利用最优估计法实现捷联惯导系统和天文导航系统的组合,讨论了捷联惯导和天文导航两子系统的组合...
DSS/SINS组合导航实时滤波仿真_专业资料。北斗双星定位系统的定位原理决定了其存在导航定位实时性较差的缺点。为了解决双星定位实时性差的问题,提出了一种新的北斗...
然后,在联邦滤波理论的基础上,研究并给出了一种基于故障 检测函数的信息分配新方法。最后,将以上两种方法运用到 SINS/SAR/北斗组合导航系统中进行了计算仿真。 仿真...
navigation system,SINS)组合导航系统Kalmanfilter, 中无法实现较高的定住精度且计算的冗余度大的缺点,提出一种基于无迹卡尔曼滤波(unscented UKF)的新型组合系统滤波...
Key words: federal filt er ing , int egrat ed navigat ion, kalman f ... 因此由 SINS / 北斗/ GPS 组合而成的基于联邦滤波算法的导航系统是一种理 ...
H ∞滤波在无源北斗/SINS组合导航系统中的应用_专业资料。无源北斗接收机输出有色噪声大,数据跳变点多,噪声分析和建模工作困难。而传统的卡尔曼滤波存在不确定...
GP S/ SINS 组合导航有效地克服 了惯导系统误差状态的发散现象, 大大地提高了...最后在 M at lab 环 境下实现了 Kalman 滤波方程, 并对仿真结 果进行 了...
INS北斗组合导航系统的关键技术_信息与通信_工程...参与码环滤波,并将 Kalman 滤波器的最优估计结果...P 码接收机,并应用了 SINS 辅助 GPS 接收机技术...
热门文档