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

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

1.2 测量方程

Z(t)=H(t)X(t)+v(t) (5)

(1) 松散组合测量方程

Z=[LB LSλB λShB hSVBE VSEVBN VSNVBU VSU]T(6) H=[diag{111}O3×6;O3×3diag{111}O3×3]

测量方程中v是测量噪声。下式中B和S分别代表北斗和捷联惯导系统的测量值。

a11 aHρ= 21

a31 a41

a12a22a32a42

a13 a23 a33 a43

b11 b 21Hρ = b31 b41

(2) 紧密组合测量方程

b12b22b32b42

b13 b23 b33 b43

1B ρ 1Sρ 2B ρ 2Sρ 3B ρ 3Sρ 4B ρ 4S]TZ=[ρ1B ρ1Sρ2B ρ2Sρ3B ρ3Sρ4B ρ4Sρ HρO4×12

H=

OHO 4349×ρ×

(7)

分别代表伪距与伪距率,Hρ中的上式中ρ和ρ

aij与Hρ 中的bij(i=1,2,3,4, j=1,2,3)的定义见文献[2]。

2 仿真比较

整个组合导航仿真所需数据由MATLAB程序产生,仿真时间均为2400s,选用北斗二代卫星导航系统的其中4颗卫星,由程序产生卫星位置及用户真实位置、速度等数据,即可计算出北斗系统的伪距、伪距率数据,及用户位置、速度数据。另外惯性测量器件(IMU)输出数据也由仿真程序产生,可计算惯导系统测得用户位置、速度数据。再经组合导航算法反解出组合导航系统的用户位置、速度等数据,将其与真实数据比较,即可得误差数据。 2.1 输出校正

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

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

图1是松散组合的仿真结果,误差随时间增长略有增大,仿真结束时位置误差约为40m,速度误差约为10m/s。图2是紧密组合的仿真结果,误差随时间增长明显变大,仿真结束时位置误差约为900m,速度误差约为25m/s。 2.2 反馈校正

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

图3是松散组合仿真结果,误差不随时间增长

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

明显变化,最大位置误差约为200m,速度误差约为30m/s。图4是紧密组合的仿真结果,误差同样不随时间增长明显变化,最大位置误差约为15m,速度误差约为8m/s。

p/m

p/m

t/s

t/s t/s

V/

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

(m/s)

V/(m/s)

t/s

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

图3 采用反馈校正的松散组合

图1 采用输出校正的松散组合

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

p/m

p/m

t/s

V/(m/s)

V/(m/s)

t/s

t/s

图4 采用反馈校正的紧密组合

图2 采用输出校正的紧密组合

·28·

采用输出校正时,误差随时间增长变大,这是

因误差方程线性化时仅保留一阶小量,(下转第31页)

上一页第2页

你可能喜欢

热门文档

相关文档

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