GPS_INS位置组合

代码说明：

应用背景将飞机和舰船等运载体上的两种或两种以上的导航设备组合在一起的导航系统。组合导航是近代导航理论和技术发展的结果。每种单一导航系统都有各自的独特性能和局限性。把几种不同的单一系统组合在一起，就能利用多种信息源，互相补充，构成一种有多余度和导航准确度更高的多功能系统。新的数据处理方法，特别是卡尔曼滤波（见波形估计）方法的应用是产生组合导航的关键。卡尔曼滤波通过运动方程和测量方程，不仅考虑当前所测得的参量值，而且还充分利用过去测得的参量值，以后者为基础推测当前应有的参量值，而以前者为校正量进行修正，从而获得当前参量值的最佳估算。当有多种分系统参与组合时，就可利用状态矢量概念。通常，取误差本身作为状态矢量，不是对速度、方位本身等作出最佳估计，而是对速度误差、方位误差等作出最佳估计。把这一估算从实际测得的速度、方位中减去，就得到此时此刻的速度、方位等参量。组合导航实际上是以计算机为中心，将各个导航传感器送来的信息加以综合和最优化数学处理，然后进行综合显示。导航传感器包括各种导航设备和计算机外部设备等，而显示设备等都是