一种基于动态规划思想的船舶路径规划方法

摘要

本发明公开了一种基于动态规划思想的船舶路径规划方法，属于船舶路径规划领域。本发明步骤包括：(1)径向栅格地图的建立；(2)栅格地图航行信息的赋予；(3)建立评价函数和状态转移方程；(4)利用动态规划思想在径向栅格寻找最优路径；本发明的有益效果在于依据船舶航线建立径向栅格地图，使规划出来的航线更加符合船舶的运动特性，并且有利于使用动态规划算法进行决策阶段的划分；运用动态规划的思想通过建立的评价函数进行条件约束能够规划耗时最少，符合舵角限制，航线与原航线偏差最小且能避开多条障碍船的航线。该算法计算速度快，并且能够得到符合条件约束的最优航线。