INSGPS组合导航系统仿真分析_第1页
INSGPS组合导航系统仿真分析_第2页
INSGPS组合导航系统仿真分析_第3页
INSGPS组合导航系统仿真分析_第4页
INSGPS组合导航系统仿真分析_第5页
已阅读5页,还剩13页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

INS/GPS组合导航系统仿真分析INS/GPS组合导航系统程序流程度初值的选取

在程序开始时,必须要有初值才能进行卡尔曼滤波。卡尔曼滤波要求初值条件为:这样卡尔曼滤波才具有无偏性和估计均方差最小的特性。卡尔曼滤波要求系统噪声和量测噪声是互不相关的零均值的白噪声序列,有:

其中:组合导航系统误差方程

当组合系统采用线型卡尔曼滤波器时,常常利用间接法进行估计,所谓“系统”实际上是导航系统的各种误差的“组合体”,滤波器估值的主要部分是导航参数误差估值,然后用去校正惯导系统INS的导航参数。惯性导航系统的误差方程包括:平台误差角方程;速度误差方程;位置误差方程等。

平台误差角方程惯性导航系统的平台系要模拟的导航坐标系为当地地理坐标系(t),由于平台有误差,平台系(P)和导航系(t)不能完全重合,平台系(P)与地理系(t)总存在小姿态误差角

将平台误差角写成(t)系中的列向量有:地理系(t)和平台系(P)之间的坐标变换阵,取一阶近似,可写成:在捷联惯导系统中,由于误差的影响理想的当地地理系与计算所得的地理系有小角度误差,坐标变换阵与上式完全一样,即:平台式INS中,平台相对于惯性空间的转动角速度为:亦可写成:

平台误差角方程又其中:

上式有关项可写成:于是平台误差角方程的矢量表达式为:综合以上平台误差角方程的矩阵表达式可写成:速度误差方程及位置误差方程速度误差方程矩阵表达式为:位置误差方程:根据直接写出误差方程为:组合导航系统的状态方程忽略天向速度误差和高度误差,INS/GPS组合导航系统的状态变量为:系统的噪声向量为:陀螺,加速度计误差考虑为白噪声,即:所以系统状态误差方程如下:组合导航系统的状态方程组合导航系统的状态方程组合导航系统的状态方程上述各式中,下标E、N、U代表东、北、天的坐标轴方向;综合以上列举的方程,误差模型可写成:系统量测方程INS的位置量测信息可表达为地理系下的真值与相应误差之和:GPS接收机给出的位置量测信息,可表示为地理系下的真值与相应误差之差:式中:不考虑高度通道,位置量测矢量为:式中:INS的的速度量测信息,可表示为地理系下的真值与相应的速度误差之和:GPS的速度量测信息

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论