文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 自然科学 > 天文/地理 > SINS_北斗组合导航Kalman滤波仿真
侵权投诉

SINS_北斗组合导航Kalman滤波仿真

文章编号: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·

第1页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email