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 输出校正


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

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

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

(m/s)
V/(m/s)
t/s

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

p/m
p/m
t/s
V/(m/s)
V/(m/s)
t/s
t/s
图4 采用反馈校正的紧密组合
图2 采用输出校正的紧密组合
·28·
采用输出校正时,误差随时间增长变大,这是
因误差方程线性化时仅保留一阶小量,(下转第31页)
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 接收机技术...
热门文档