一种水下无人航行器编队平面航迹规划方法

摘要

本发明涉及一种水下无人航行器编队平面航迹规划方法，属于无人水下航行器和航迹规划技术领域。包括根据环境信息数据库或传感器探测的环境信息，构建任务空间模型；基于静态环境信息采用APF算法和RRT算法的改进与融合算法进行全局航迹规划；将全局规划路径点作为子目标点，基于动态环境信息分段进行局部规划。本发明在全局规划算法中，通过一定的改进方案，解决了APF的目标不可达和局部最优问题，改善了RRT非确定、非最优、收敛慢三大特性，将确定性与随机性航迹规划方法结合、静态规划与动态规划结合、位置规划与速度规划结合，航迹约简算法实现了进一步优化航迹的效果，保证了多水下无人航行器航迹规划的安全性、最优性与实时性的任务要求。