移动USBL测距辅助的UUV协同导航定位方法

Cooperative UUV navigation and positioning assisted by mobile USBL distance measurement

中文关键词  无人水下航行器  无人水面船  自适应卡尔曼滤波  组合导航系统

英文关键词  unmanned underwater vehicles  unmanned surface vehicles  adaptive Kalman filter  integrated navigation systems

中文摘要

      针对无人水下航行器(UUV) 导航精度受惯性导航(INS) 影响较大的问题, 本文提出一种基于无人水面船 (USV)携带超短基线(USBL)对UUV进行移动式辅助导航定位的方法. 文中以USV上高精度INS和全球导航卫星系 统(GNSS)组合后的导航结果作为基准, 利用USBL测量得到的USV和UUV相对位置和姿态信息, 结合UUV的INS误 差方程, 建立了UUV协同导航系统的状态方程和观测方程, 并基于自适应卡尔曼滤波方法对UUV状态进行滤波估 计. 仿真和湖上实验结果表明, 文中所提方法可有效提升UUV导航精度.

英文摘要

      The navigation accuracy of unmanned underwater vehicles (UUV) can be easily affected by inertial navigation systems (INS), which may cause severe consequences to the UUV system. To solve the above problem, this paper introduces a mobile navigation and positioning method for the UUVs by using an unmanned surface vehicle (USV)-assisted ultra short base line (USBL) system. Firstly, based on the highly accurate navigation results from the integration of INS and global navigation satellite system (GNSS) in the USV, the relative positions and attitudes are measured using USBL. Secondly, the state-space model and the observation model of the UUV-aided cooperative navigation system are then established by fusing INS error dynamics of the UUV. Thirdly, an estimation and filter scheme based on adaptive Kalman filters is used for obtaining the accurate estimates of the UUV states. Simulation and experimental results show that the proposed algorithm can effectively increase the UUV navigation and positioning accuracy.