一种水下航行器的最优路径规划与避障设计方法

摘要

本发明公开了一种水下航行器的最优路径规划与避障设计方法，是基于二叉堆加速算法、26邻域NA*算法与“圆弧‑直线‑圆弧”转弯策略相融合进行的水下航行器最优路径规划与避障。本发明首先采用离散三维网格图的方式建立水下环境模型，网格图将水下环境划分为若干相同大小的单元格；然后采用26邻域NA*算法规划路径，消除路径锯齿效应并避免部分碰撞；再应用“圆弧‑直线‑圆弧”转弯策略，避免航行器本体宽度以及转弯半径的影响。本发明的优点在于提出了面向三维场景的26邻域NA*算法并将其应用于水下航行器自主导航，考虑并利用了水下航行器转弯半径较大的特点，有效避免因为航行器自身宽度造成的碰撞，所规划路径较平滑且拐点较少。