海洋论坛▏USV地形测量路径自主规划研究与应用 -地形测量数据处理

" r t% R' ]. g4 f" j

一直以来，近岸海域水上水下地形测量是海洋工程领域的一项重要内容，对于海运安全、港口领航、维护国家主权、沿海城市及岛礁的海洋开发、规划决策等都具有重要意义。近岸海域周围具有环境复杂、缺乏先验信息和海况恶劣等特点，而无人水面艇作为一种小型智能无人平台，具备自主感知环境信息、路径规划、自主航行的能力，可通过人工预置或自主信息采集处理的方式完成环境感知、目标识别与探测、自主规划等多种任务。近年来，相关研究人员针对不同的任务需求进行水运航道、水库、岛屿等水域的水上水下地形测量。但在测量过程中，多以人工设定测量路径的方式为主，在测量区域较大或较为复杂的情况下，需耗费巨大人力、物力和财力，且布设测量路径带有人为主观性，影响最终测量效果。

操文芷使用电子海图与雷达图像叠加匹配方式，在此基础上进行无人水面艇路径规划，可有效进行障碍物规避以及局部路径规划动任务。刘强等采用船载多传感器一体化测量技术对海岛礁、港口地区与水中构筑物、湖泊、库区进行测量，完成了对测量区域的水上水下一体化点云无缝拼接。苗润龙等使用基于重复海湾和遗漏海湾的搜索行为设计方法完成了海洋自主航行器多海湾区域完全遍历路径规划试验，规划结果在遍历性、重复率方面优于其他遍历方法。上海大学“精海3号”无人艇水面船在金塘大桥附近按设定的规划航线进行测绘工作，因人为规划航线只能扫测航线所覆盖部分的区域，钟雨轩等提出一种考虑主动方向的动态栅格法与启发式搜索算法的无人水面艇岛礁海域完全遍历路径规划方法，并通过了仿真验证。

本图图片来自云洲智能

. a6 x e# ~8 C9 p2 e. T4 ^3 ^1 g

由现研究现状分析知，在进行水上水下一体化测量时均将海图作为已知输人，若在未知地形复杂的近岸海域进行测量工作时，无法进行测量相关的路径规划工作，同时易出现搁浅、刮底事故，不能保障研究人员及设备安全。因此，设计一种能够适应近岸复杂的水上水下环境，准确感知周围态势信息并合理规划测量路径的方法是解决以上问题的关键。现阶段，采用具有自主定位、导航、感知及控制功能的无人水面艇，携带相关测量设备，无疑是解决上述问题、并可以更快、更经济和更安全地完成近岸水上水下地形测量任务的一种理想手段。本文以USV为研究平台，搭载导航雷达、深度计、POSMV、多波束测深仪及激光扫描仪和其他必要设备，面向近岸地形测量任务需求，基于离线电子海图，实现测量路径在线规划，以完全覆盖预设待测量海域，最终获取未知环境的水上水下地形地貌。首先，基于感知、测量设备信息，实现在线地图构建工作，本文的在线地图信息输人来自于雷达感知及深度计信息，其中，雷达感知数据提供无人水面艇所在环境周围态势信息，由深度计提供无人水面艇实时深度信息，通过POSMV获取USV实时位姿，融合信息输人，实时构建测量地图。在此基础上，采用基于神经元激励方法下的完全遍历路径规划设计，结合A星算法路径搜寻优势防止路径规划锁死，为USV提供安全有效的规划路径，提高USV测量工作的安全性、合理性、有效性。同时，考虑实时水深对测量设备扫测的影响，自主调节测量路径的梳型间距，以达到要求的扫描重叠率，实现完全覆盖预定测量区域。

一、地图构建方法设计

: b R3 Q8 r8 L( u+ l' m

首先，存在一个基本问题，即如何使用地图描述测量区域环境，目前已存在多种地图表示方法，主要分为栅格地图、特征地图和拓扑地图3类。本文采用栅格地图方式，使用占据概率的栅格地图将测量区域分成若干相同边长的栅格，将每个栅格分配概率值以表示被障碍物占据的可能性大小。无人艇搭载导航雷达和深度计设备，实时更新栅格地图，根据路径规划方法生成符合海底地形测量要求的实时梳型路径，能应对复杂环境下各类问题，在实时性和安全性方面具有较强优势。

: e5 m5 i9 Q& H8 [

在线地图构建过程如图1所示。其中，基准地图是指由初始离线地图和实时的雷达感知信息以及水深等信息所构建的实时地图，地图北向为等深线由深至浅方向；测量地图是由基准地图作为输人，根据水深情况以及海底地形测量标准需求更新栅格大小，该地图直接用于测量路径规划算法输人。

0 k# ]) J/ H% T" y

图1 在线地图构建流程图

$ \; b6 c" _+ R2 f6 w/ P' o

（以下本段正文略）

二、全遍历路径规划方法

* x6 |7 c7 S, ]

在k时刻测量地图zkˊ为M×Nc二值化矩阵，令每个栅格等效为神经元，并被赋予活性值，邻近活性值最大的神经元具有被选择优先性。神经元活性值由固定活性值和外部激励确定，当为障碍物时，设其活性值为-1，若不为障碍物则其活性值计算公式为：

⑴

式中：入为该栅格的活性值，由其所在位置及遍历方向决定，遍历方向与等深线方向垂直；x为在测量地图坐标系横轴坐标值；c为常数。T为神经元活性值外部激励，由于在海底地形测量过程中，无人艇频繁的转弯会使多波束测深仪扫描点云数据拼接后误差增大，为保证无人艇的良好运动姿态，设t为关于转弯角度和移动距离的函数，则有：

⑵

式中：S为当前规划路径方向转向预规划栅格所需要的角度；dm为当前所在栅格位置移动到预规划栅格的距离。

+ o0 f: u5 U5 S9 N+ [

将式⑵代人式⑴，分别选择当前栅格周围的7个栅格(不计上一周期所在栅格，尽量避免USV原地掉头）作为下一移动目标，在其中选择活性值最大的作为移动目标。

, \; b; k5 y' ?6 D9 D# m# S s2 A

在实际海底地形测量过程中，无人艇所在区域环境复杂，由于海底地形测量要求以及无人艇操纵性限制，在路径规划过程中可能出现锁死现象，因此加入A*算法作为疏导策略，寻找距离当前位置最近的非障碍物栅格位置。同时，对A*所规划路径进行平滑处理，使得无人艇最快速度到达指定栅格位置。

此外，在出现危险状况时，如突然进入测量区域的非合作船舶、水深变浅等，伴随测量地图的变化，进行路径重规划工作，为防止再次将已完成测量的区域作为规划区域，在进行测量路径重规划时，将历史形式区域神经元活性值置-1，以保证测量工作的高效性。

在Matlab仿真平台下，设定测量地图z栅格化后，行数Mc＝30，列数Nc＝29。随机设置障碍物的位置及形状，其仿真结果如图2所示。

图2 完全遍历路径规划仿真结果

可知，该路径规划方法可在复杂环境中较好地规划出符合海底地形测量标准的梳型路径，对所测区域进行全覆盖遍历，且有效避免了规划过程中出现规划锁死现象，以最快方式到达符合要求的下一规划位置，继续完成路径规划任务。这种方法在实际的复杂环境中具有较好的环境适应性和安全性，尤其可较好地应对未知海域岛岸环境。

三、实航验证情况

基于水上水下一体化无人测量任务需求，以中科院沈阳自动化研究所研制的“问海”号无人水面测量艇作为试验平台，对本文提出的在线地图构建方法和完全遍历路径规划方法在松花湖某区域进行实航验证。

设定测量区域为700m×800m近岸水域，多波束扫描重复率设置值n＝21%，测量状态下的多波束开角Q＝120°，基准地图栅格边长L＝15，完全遍历梳型路径间距Lsd＝50，即栅格边长，多波束射线可扫描的最远距离dj＝200，则有行数Mc＝15，列数Nc＝13。输入空白初始离线地图，设定测量艇航行速度为4kn，“问海”号USV通过搭载的导航雷达、深度计、多波束、激光扫描仪等设备，自主感知环境信息按照文中所设计方法进行地图构建，实时更新基准地图，当历史规划路径与现地图环境冲突时，进行路径重规划，无人艇对规划路径进行实时的轨迹跟踪，按此步骤直至完成设定区域的水上水下一体化测量。考虑到水深变化导致的USV安全问题，在实际应用中加入等深线方向思路，同时自主更改测量区域的边界情况，以此方式提高测量工作的效率。其实航试验结果如图3所示。

图3 初始全局完全遍历路径规划结果

由试验结果分析可知，在设定测量区域后，问海号USV可实时感知周围环境。经过实时的雷达感知信息栅格化处理以及占据概率计算形成数据更新源，实时改变基准地图，最终构建测量地图，经过与实际的测量区域卫星图比对，地图构建精度满足测量路径规划要求。

图4 初次基准地图构建结果

# E5 {7 b" @# T: K. T( u( p2 _6 P

基准地图的实时更新驱动路径规划方法的重规划功能，如图5和图7所示。

+ Q% K* Y) P3 Q+ `

图5 初次路径重规划结果

$ K7 b5 t* ]- H% R( o

图6 二次雷达感知信息处理结果

图7 二次路径重规划结果

' d' g0 u3 F$ w: N7 @; ^

此时USV在图中所示的起点位置附近，按照路径规划方法设计，其能够在此种环境中进行任意的梳型路径规划，且可保证避免规划过程中的锁死情况。通过图8和图10可知，基于完全遍历路径规划方法，可实现待测区域的测量路径全覆盖。

图8 测量地图构建结果

' E0 }( R: @* q/ I6 f V3 z, V c

图9 测量区域卫星图截图

图10 USV航行路径结果

5 L+ t8 j8 j- S

图11为一体化成图效果，完成了水上水下的文提出的在线地图构建方法以及完全遍历路径规划方法设计合理可行，测量结果满足海洋工程地形测量规范要求。

9 |9 g: [1 R9 i% v

图11 水上水下一体化无人测量结果效果图

9 J6 _1 Y% _) W( z

四、结语

) R- x6 u+ c" ]/ n0 S' l

针对近岸水域周边的地形测量需求，本文提出基于贝叶斯估计的在线地图构建方法和完全遍历路径规划方法，给出了一种解决方案，并利用无人水面测量艇进行了实航验证，测量结果满足海洋工程地形测量规范要求。通过试验结果，分析可得出结论如下：

# T" R$ A% Z9 l4 a: B

⑴USV搭载导航雷达、深度计、多波束测深仪及激光测距仪等设备，使用基于贝叶斯估计的在线地图构建方法，该基准地图与实际环境相比平均误差不大于15m，可保证无人艇航行安全；

⑵基于在线地图构建结果，通过完全遍历路径规划方法得到符合近岸水域地形测量要求的规划路径。USV依据规划路径内容执行，实现了对预定水域水上水下地形测量的全覆盖，可使多波束点云数据进行无缝拼接，测量结果满足海洋工程地形测量规范标准，即表明了设计方案的可行性。

9 K; J' `* v- m" ^

按本文方法设计，USV在搭载指定设备后，可自主完成近岸水域地形的测量工作。

* l1 X- p+ n! v

来源：溪流之海洋人生

$ S6 \" u2 f/ z5 b/ m$ N, k. G" q% f

END

腊八已至岁寒人暖诸事粥全