摘要
本发明公开了一种基于流函数的水下搜救机器人路径规划方法,包括如下步骤:步骤1:通过声呐和摄像头获取水下环境,进行地形建模;步骤2:当前方障碍物出现重叠时,建立前方障碍物的虚拟障碍物;步骤3:根据所述步骤2中建立的虚拟障碍物,并基于流函数法重新规划路径;步骤4:基于水下搜救机器人约束条件对所述步骤3中重新规划的路径进行路径优化,完成路径规划过程。本发明利用中值滤波和灰度化处理,解决声呐杂音多、图像不清楚的问题,其次利用拉普拉斯金字塔融合的方法对摄像头采集的图像进行图像增强,能够更好地获取机器人周边信息,提高地图模型的准确性。