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

说明书

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

技术领域

本发明涉及一种定位与导航，尤其涉及一种多机器人协同水下地形匹配导航系统及方法，属于水下定位与导航技术。

背景技术

水下机器人在商业领域和国防工业领域受到了越来越多的重视，由于在水下环境中，高频信号衰减快，所以GPS等常规定位方式并不适用，由于定位与导航是水下机器人能否安全返航的重要技术因素，所以地形匹配导航成为了可选的选项之一。

多机器人协同编队运行由于其可以更方便地完成多样化、复杂化的任务，具有更高的鲁棒性等优点近年来受到了更多的关注。而如何利用多个机器人的传感器传输回的数据进行定位和导航也成为了各国家研究机构研究的新热点，其中多水下机器人协同地形匹配导航技术上还属于空白状态。

发明内容

本发明的目的是为了提供一种多机器人协同水下地形匹配导航系统及方法，包括多机器人利用多波束声纳收集深度信息，汇总处理数据得出待匹配地形和与先验地图进行匹配等技术环节，最终得到每个机器人的精确位置。

本发明的目的是这样实现的：一种多机器人协同水下地形匹配导航系统，包括负责采集数据的机器人1…机器人I…机器人N和主机器人共N+1个机器人；

机器人1…机器人N均携带有多波束声纳，可互相进行水声通信，能将多波束声纳数据在声速修正和潮位修正后得到探测地型深度数据，能通过水声通信确定相对位置以及互相传输数据，能通过主机器人传输来的机器人位置信息确定其潜器状态；

主机器人可与其他机器人进行水声通信，存储先验地图，能将收到的机器人相对位置信息结合探测地型数据处理为待匹配地形，再结合先验地图进行匹配操作，得到各机器人位置，最终返回给各机器人。

本发明还包括这样一些结构特征：

1.一种多机器人协同水下地形匹配导航方法，

步骤一：N个机器人编队运行，由各个机器人将多波束声纳数据进行声速修正、潮位修正后得到待验地图深度数据，并将待验地图深度数据通过水声通信传递给主机器人；

步骤二：将各个机器人间的相对位置信息通过水声通信传递给主机器人；

步骤三：主机器人结合得到的相对位置信息以及待验地图深度数据进行汇总整理，经过计算得到待匹配地形；

步骤四：主机器人提取先验地图中的地形数据，利用极大似然估计来找出待匹配地形在先验地图中的最佳匹配点(x_match,y_match)，x、y分别对应大地坐标系中的经度值、纬度值；

步骤五：主机器人通过最佳匹配点(x_match,y_match)与各个机器人的相对位置信息，计算出每一个机器人对应的位置信息(x₂,y₂)，(x₃,y₃)…(x_n,y_n)后，再返回给各个机器人，完成多机器人协同地形匹配定位。

2.步骤三中的汇总整理包括：

第一：结合得到的待验地图深度数据和相对位置信息得到这些水深数据点的位置与数据信息；