公开(公告)号：CN110456786A

公开(公告)日：2019-11-15

申请号：CN201910618905.8

申请日：2019-07-10

Applicant: 哈尔滨工程大学

Inventor： 陈涛 ,  皮棋棋 ,  徐达 ,  戚琪 ,  袁永粼

IPC: G05D1/02

Abstract: 本发明提供的是一种基于地形特征提取的UUV海底地形跟踪系统及跟踪方法。海底地形特征提取模块根据三个测距声呐的安装角度及海底距离、姿态传感器测量的纵倾角和艏向角、深度计测量的实际航行深度、惯性导航仪测量的经度和纬度，提取当前所处的海底地形的特征，并解算出距海底的实际高度；高度指令生成模块根据提海底地形特征、多普勒测量的航行速度，结合期望航行高度，生成指令航行高度；高度指令转深度指令模块将指令航行高度转换成指令航行深度；深度控制器根据PID控制算法产生水平舵角控制指令。本发明可以使UUV具备对局部海底地形的在线构建能力和变化趋势的预判能力，在保证航行安全性的前提下，实现对未知海底地形的良好跟踪。

公开(公告)号：CN110456786B

公开(公告)日：2023-04-07

申请号：CN201910618905.8

申请日：2019-07-10

Applicant: 哈尔滨工程大学

Inventor： 陈涛 ,  皮棋棋 ,  徐达 ,  戚琪 ,  袁永粼

IPC: G05D1/02

Abstract: 本发明提供的是一种基于地形特征提取的UUV海底地形跟踪系统及跟踪方法。海底地形特征提取模块根据三个测距声呐的安装角度及海底距离、姿态传感器测量的纵倾角和艏向角、深度计测量的实际航行深度、惯性导航仪测量的经度和纬度，提取当前所处的海底地形的特征，并解算出距海底的实际高度；高度指令生成模块根据提海底地形特征、多普勒测量的航行速度，结合期望航行高度，生成指令航行高度；高度指令转深度指令模块将指令航行高度转换成指令航行深度；深度控制器根据PID控制算法产生水平舵角控制指令。本发明可以使UUV具备对局部海底地形的在线构建能力和变化趋势的预判能力，在保证航行安全性的前提下，实现对未知海底地形的良好跟踪。