一种新的INS/LOG组合导航算法

针对电磁计程仪引入的海流速度可能会导致INS/LOG组合导航系统的卡尔曼滤波器输出发散问题,设计一种新的INS/LOG组合方式。以计程仪速度2次采样的差分值(即速度增量)作为系统观测量以抑制慢变海流的影响,采用基于延迟状态卡尔曼滤波算法,推导这种组合方式的观测方程,实现INS误差的最优估计。为抑制计程仪速度差分对其高频噪声的放大效应,采用巴特沃斯低通滤波器对其输出进行平滑处理。通过对3种INS/LOG组合方式的仿真比较,验证该算法的有效性。