基于地形特征提取的UUV海底地形跟踪系统及跟踪方法

摘要

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