摘要

为克服水下航行器在极区航行时地理经线收敛导致的航向角定义失效、定位计算失效等问题,设计了格网惯性导航算法编排方案,以直接获得格网航向,并采用ECEF位置坐标代替传统经纬度进行水下航行器定位。对格网惯性导航的误差进行建模,并据此设计了格网惯导系统的"速度匹配"传递对准算法,以满足水下航行器在极区的对准需求。仿真结果表明,在格网惯性导航下,采用高精度惯性器件,15 min内水平姿态角误差小于0.5′,方位姿态角误差小于0.2′,水平速度误差小于0.5 m/s,ECEF坐标系下的位置误差全程小于200 m;应用"速度匹配"传递对准算法,水平失准角在10 s内即可收敛到1.5′以内,同时,加速对方位失准角有激励作用,30 s内方位对准精度在4′以内。