INSGPS组合导航系统仿真分析.ppt

INS/GPS组合导航系统程序流程度 初值的选取 在程序开始时，必须要有初值才能进行卡尔曼滤波。卡尔曼滤波要求初值条件为： 这样卡尔曼滤波才具有无偏性和估计均方差最小的特性。 卡尔曼滤波要求系统噪声和量测噪声是互不相关的零均值的白噪声序列，有： 其中： 组合导航系统误差方程 当组合系统采用线型卡尔曼滤波器时，常常利用间接法进行估计，所谓“系统”实际上是导航系统的各种误差的“组合体”，滤波器估值的主要部分是导航参数误差估值 ，然后用 去校正惯导系统INS的导航参数。 惯性导航系统的误差方程包括： 平台误差角方程；速度误差方程；位置误差方程等。 平台误差角方程 惯性导航系统的平台系要模拟的导航坐标系为当地地理坐标系(t),由于平台有误差，平台系(P)和导航系(t)不能完全重合，平台系(P)与地理系(t)总存在小姿态误差角 将平台误差角写成(t)系中的列向量有： 地理系(t)和平台系(P)之间的坐标变换阵，取一阶近似，可写成： 在捷联惯导系统中，由于误差的影响理想的当地地理系与计算所得的地理系有小角度误差，坐标变 换阵与上式完全一样，即： 平台式INS中，平台相对于惯性空间的转动角速度为： 亦可写成: 平台误差角方程 又 其中： 上式有关项可写成： 于是平台误差角方程的矢量表达式为： 综合以上平台误差角方程的矩阵表达式可写成： 速度误差方程及位置误差方程 速度误差方程矩阵表达式为： 位置误差方程： 根据 直接写出误差方程为： 组合导航系统的状态方程 忽略天向速度误差和高度误差，INS/GPS组合导航系统的状态变量为： 系统的噪声向量为： 陀螺，加速度计误差考虑为白噪声，即： 所以系统状态误差方程如下： 组合导航系统的状态方程 组合导航系统的状态方程 组合导航系统的状态方程 上述各式中，下标E、N、U代表东、北、天的坐标轴方向； 综合以上列举的方程，误差模型可写成： 系统量测方程 INS的位置量测信息可表达为地理系下的真值与相应误差之和： GPS接收机给出的位置量测信息，可表示为地理系下的真值与相应误差之差： 式中： 不考虑高度通道，位置量测矢量为： 式中： INS的的速度量测信息，可表示为地理系下的真值与相应的速度误差之和： GPS的速度量测信息，同样可表示为地理系下的真值与相应的测速误差之差： 不考虑天向速度，速度量测矢量为： 式中： 状态转移阵 系统的状态方程和观测方程为： 其中： * * INS/GPS组合导航系统仿真分析