一种三维水下欠驱动AUV回收路径规划方法

摘要

本发明提供本发明公开了一种三维水下欠驱动AUV回收路径规划方法及装置，方法包括：基于小山丘的位置构建水下三维环境模型；基于AUV在回收过程中起点位置、起点姿态、终点位置及终点姿态设置中间候选路径点；构建路径规划约束条件，所述路径规划约束条件包括硬约束条件和软约束条件；基于所述硬约束条件由候选路径中筛选出可行路径；通过改进的遗传算法对可行路径进行迭代，当到达指定迭代次数后，终止算法得到最优的全局路径，所述改进的遗传算法中对种群的交叉系数以及变异系数进行自适应的处理。本发明利用优化的自适应参数以及考虑多种约束条件对传统遗传方法中过早出现的局部最优问题进行全局寻优，从而提高路径规划的效率。