insgps组合导航系统仿真分析

《insgps组合导航系统仿真分析》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、INS/GPS组合导航系统仿真分析INS/GPS组合导航系统程序流程度初值的选取在程序开始时，必须要有初值才能进行卡尔曼滤波。卡尔曼滤波要求初值条件为：这样卡尔曼滤波才具有无偏性和估计均方差最小的特性。卡尔曼滤波要求系统噪声和量测噪声是互不相关的零均值的白噪声序列，有：其中：组合导航系统误差方程当组合系统采用线型卡尔曼滤波器时，常常利用间接法进行估计，所谓“系统”实际上是导航系统的各种误差的“组合体”，滤波器估值的主要部分是导航参数误差估值，然后用去校正惯导系统INS的导航参数。惯性导航系统的误差方程包括：平台误差角方程；速度误差方程；位置误差方程等。平台

2、误差角方程惯性导航系统的平台系要模拟的导航坐标系为当地地理坐标系(t),由于平台有误差，平台系(P)和导航系(t)不能完全重合，平台系(P)与地理系(t)总存在小姿态误差角将平台误差角写成(t)系中的列向量有：地理系(t)和平台系(P)之间的坐标变换阵，取一阶近似，可写成：在捷联惯导系统中，由于误差的影响理想的当地地理系与计算所得的地理系有小角度误差，坐标变换阵与上式完全一样，即：平台式INS中，平台相对于惯性空间的转动角速度为：亦可写成:平台误差角方程又其中：上式有关项可写成：于是平台误差角方程的矢量表达式为：综合以上平台误差角方程的矩阵表达式可写成：速

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

4、考虑高度通道，位置量测矢量为：式中：INS的的速度量测信息，可表示为地理系下的真值与相应的速度误差之和：GPS的速度量测信息，同样可表示为地理系下的真值与相应的测速误差之差：不考虑天向速度，速度量测矢量为：式中：状态转移阵系统的状态方程和观测方程为：其中：