一种基于双位置校准切换的深海AUV快速组合导航方法

本发明公开一种基于双位置校准切换的深海AUV快速组合导航方法，属于组合导航技术领域，用于AUV组合导航，包括在AUV进行下潜和上浮过程中根据深度、测距和开角判定条件，决定采用LBL/USBL双位置校准模式，AUV在近底作业过程中根据在阵内/阵外判定条件，在阵内以LBL提供位置校准，在阵外则以与阵的距离或观测误差作为判定条件，决定采用LBL/USBL位置校准切换的模式，获取AUV全航程精准的最优轨迹信息，且水声定位均采用提出的简化声速剖面。本发明大幅度简化声速剖面，在保证精度前提下提高水声定位效率，快速实现导航算法计算效率，通过模式切换在任意状态下均能获得最优的组合导航模式。