公开(公告)号：CN105607646A

公开(公告)日：2016-05-25

申请号：CN201610082314.X

申请日：2016-02-05

Applicant: 哈尔滨工程大学

Inventor： 王宏健 ,  张雪莲 ,  李庆 ,  陈涛 ,  严浙平

IPC: G05D1/10

CPC classification number: G05D1/10

Abstract: 一种障碍环境下有必经点的UUV航路规划方法，属于UUV控制技术领域。为了使UUV从布放点出发遍历完必经点后回到回收点，且路径长度最短。计算在障碍环境下UUV布放点和回收点以及所有必经点的两两间航路估计距离；以布放点为起点、回收点为终点，使用TSP算法规划出UUV所有必经点的遍历顺序，使UUV从布放点出发、遍历完所有必经点后回到回收点的航路估计距离总和最短；经优化得出从布放点出发经过所有必经点最终到达回收点且能避开所有障碍的航路。仅使用几何判断估算两两必经点间的路径代价，然后使用蚁群算法基于估算代价规划出一个TSP方案，即必经点遍历顺序，最后再使用可变子目标点的蚁群算法规划出最终能避开障碍物的航路。