一种水下机器人能耗优化路径规划方法

本发明公开了一种水下机器人能耗优化路径规划方法。本发明用纳维‑斯托克斯方程建立海洋洋流模型，模拟海洋中复杂水流；用山峰模型模拟复杂海底地形，用球体模型模拟海洋中随机障碍物；路径规划器外层采用粒子群优化算法，内层采用序列二次规划算法，可以得到路径点的同时，求得每段路径的最优速度；用B‑样条曲线拟合路径点，生成平滑路径；采用特殊的适应度函数计算方式，并且结合重规划策略，提升算法计算效率。本发明能计算出机器人在不同环境下最优航行速度，在保证机器人航行时间和安全性的基础上，降低了规划出的路径的能耗，通过多算法组合的双层路径规划器和动态重规划机制，有效提升了路径规划的效率和鲁棒性。