[发明专利]一种多机器人协同水下地形匹配导航系统及方法

摘要

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

主权项

1.一种多机器人协同水下地形匹配导航方法，其特征在于：依据一种多机器人协同水下地形匹配导航系统，系统包括负责采集数据的机器人1…机器人I…机器人N和主机器人共N+1个机器人；机器人1…机器人N均携带有多波束声纳，可互相进行水声通信，能将多波束声纳数据在声速修正和潮位修正后得到探测地型深度数据，能通过水声通信确定相对位置以及互相传输数据，能通过主机器人传输来的机器人位置信息确定其潜器状态；主机器人可与其他机器人进行水声通信，存储先验地图，能将收到的机器人相对位置信息结合探测地型数据处理为待匹配地形，再结合先验地图进行匹配操作，得到各机器人位置，最终返回给各机器人；还包括如下步骤：步骤一：N个机器人编队运行，由各个机器人将多波束声纳数据进行声速修正、潮位修正后得到待验地图深度数据，并将待验地图深度数据通过水声通信传递给主机器人；步骤二：将各个机器人间的相对位置信息通过水声通信传递给主机器人；步骤三：主机器人结合得到的相对位置信息以及待验地图深度数据进行汇总整理，经过计算得到待匹配地形；步骤四：主机器人提取先验地图中的地形数据，利用极大似然估计来找出待匹配地形在先验地图中的最佳匹配点(x_match,y_match)，x、y分别对应大地坐标系中的经度值、纬度值；步骤五：主机器人通过最佳匹配点(x_match,y_match)与各个机器人的相对位置信息，计算出每一个机器人对应的位置信息(x₁,y₁)、(x₂,y₂)，(x₃,y₃)…(x_n,y_n)后，再返回给各个机器人，完成多机器人协同地形匹配定位。