水下机器人三维航路规划方法及系统

摘要

本发明实施例提供一种水下机器人三维航路规划方法及系统，该方法包括：建立水下机器人的三维环境模型；在三维环境模型中初始化天牛群算法中的每个天牛个体的速度属性和位置属性，并根据速度属性和位置属性获得天牛群的全局极值；通过更新每个天牛个体的速度属性和位置属性对全局极值进行迭代更新，并在迭代完成后根据最终获得的目标全局极值获得目标规划航路。本发明实施例通过采用天牛群算法对水下机器人的三维航路进行规划，相对于传统的航路规划方法更加灵活，且对复杂的水下非结构化环境适应能力强；相对于基本的粒子群算法具有迭代收敛速度快的特点；能够降低陷入局部最优解的概率。