【技术实现步骤摘要】
一种水面无人艇路径规划方法
[0001]本专利技术应用领域主要为多礁分布类型的水上自主巡航与船舶密集航行的水面路径规划和避障领域，是一种基于全局栅格地图的，能实现局部实时避障的路径规划方法。
技术介绍
[0002]单体水面无人艇自主航行与避障一直是无人船领域的热门研究课题之一。如何在布满礁石或其他障碍物，以及船舶密集航行的水面上进行安全高效的自主航行是目前正在发展的自主船技术研究内容中较为重要的一个研究方向。现今无人系统的智能化程度越来越高，对于复杂环境自主航行的适应能力的要求也随之增强，在动态环境里航行，如何规划最优路径对无人船的航行效率和安全性也是很大的考验。因此，需要设计一种在复杂障碍物环境下可以快速进行动态路径规划，控制成本的同时保证无人船安全和高校行驶的路径规划方法。
[0003]路径规划方法发展到目前，已经有许多传统自主智能规划算法来解决无人艇的路径规划问题，比如基于采样的Voronoi图方法、快速搜索随机树方法；基于节点的Dijkstra、A*算法、D*算法；基于模型的人工势场法、动态窗口法；基于生物启...
【技术保护点】
【技术特征摘要】
1.一种水面无人艇路径规划方法，其特征在于，步骤如下：步骤1：通过航空器航摄影像得到水面环境的全局遥感图像，从而对航摄图像进行分类与二值化处理，将图像转为二维栅格地图；步骤2：基于水面环境全局栅格地图，标定无人艇航行的出发点和到达点，利用优化距离启发函数的LPA*算法进行全局路径规划，得到初始的无人艇航行全局路径；步骤3：基于LPA*算法的固定路径与动态窗口法，在存在移动障碍物的情况下进行局部再规划避障。2.根据权利要求1所述的一种水面无人艇路径规划方法，其特征在于，步骤1具体包括：101：获取航摄影像，对其进行图像切割与二值化处理；102：对处理后的二值图像进行分类处理，得到二维栅格矩阵D
n
×
n
，并根据矩阵元素进行二维栅格地图的绘制：3.根据权利要求1所述的一种水面无人艇路径规划方法，其特征在于，步骤2具体包括：201：在航摄图像二值分割处理后得到的全局栅格地图上标定无人艇航行的出发点和到达点，初始化两个节点遍历储存数组A star D1和A star D2；其中D1为已遍历节点，D2为未遍历节点；202：以栅格地图的出发点节点为中心，初始化起点的rhs(n)＝s(n)＝0，其他未遍历节点的rhs(n)＝s(n)＝∞，开始向8邻域栅格进行启发式遍历搜索；比较相邻节点的代价函数F(n)，选取F(n)值最小的点作为下一扩展节点，基于LPA*算法设计的代价函数为；F(n)＝s(n)+h(n)+G其中：s(n)为起始点代价函数，表示起始点S到当前遍历节点N的路径代价，μ为对角线参数；rhs(n)LPA*算法中的邻接系数，对于S的所有邻接节点，其到S的距离加上邻接节点自身的St值的最小值作为rhs值；c(n',n)为两节点之间的代价函数；h(n)为启发函数，为当前节点N到目标点T的代价估计函数，G为环境变量；继续遍历节点时，根据代价函数选取节点作为下一遍历节点；203：遍历到下一节点，将其作为当前节点并继续根据代价函数选取遍历相邻节点，计算全部下一节点的代价值F(n)，并选取代价最小的节点作为后继节点；204：对代价函数F(n)＝s(n)+h(n)+G中的起始点代价函数s(n)值与启发函数h(n)进行更新，重新回到步骤202进行迭代，使得无人艇路径迭代向后继节点移动，直到无人艇当前节点迭代到预定终止点T为止；205：节点迭代更新的同时，LPA*算法内对计算得的最优栅格地图路径进行2次插值平滑处理，以简化无人艇路径减少损失；206：删除路径冗余节点，消除不必要折线优化路径成本：
利用进行平滑处理前得到的最优路径，对其中的各个节点按路径延伸方向进行排列，并标为(a1,a2....a
n
),a
n
＝T；207：设k初始值＝0，依次连接a
k
,a
k+1
,k∈N
+
；判断连线是否穿过障碍物，从而确保平滑处理后的无人艇移动的最终路线能够合理在固定栅格地图中避障；208：初始化k，依次连接a
k
,a
j
,k,j∈N
+
,j＞k；，继续对路径节点进行依次相同操作，当节点k和节点j之间的路径穿过障碍物时停止；209：根据停止之前的状态...
【专利技术属性】
技术研发人员：张兰勇，王天靖，阳定康，常佳程，谭逸凡，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。