本发明提供一种多机器人协同水下地形匹配导航系统及方法，包括负责采集数据的机器人1…机器人I…机器人N和主机器人共N+1个机器人；保持多水下机器人(AUV)编队运行，采集多波束声纳数据，记录机器人相对位置信息，结合二者给出待匹配地形。利用概率相关的方法确定与之匹配的地形，进而结合机器人相对位置信息确定水下机器人所在的精确位置。本发明无需GPS、声学基阵的辅助，依靠自身传感器信号与相互通信，进行计算给出精确位置，完成导航。本发明可应用于多水下机器人协同地形匹配导航，且具有较高的鲁棒性。