[发明专利]一种多机器人协同水下地形匹配导航系统及方法有效
申请号: | 201710054066.2 | 申请日: | 2017-01-24 |
公开(公告)号: | CN106842209B | 公开(公告)日: | 2019-04-23 |
发明(设计)人: | 李晔;丛正;姜言清;马腾;王汝鹏;贡雨森;郭宏达;安力;龚昊;何佳雨 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01S15/88 | 分类号: | G01S15/88;G01S15/87 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 机器人 协同 水下 地形 匹配 导航系统 方法 | ||
1.一种多机器人协同水下地形匹配导航方法,其特征在于:依据一种多机器人协同水下地形匹配导航系统,系统包括负责采集数据的机器人1…机器人I…机器人N和主机器人共N+1个机器人;
机器人1…机器人N均携带有多波束声纳,可互相进行水声通信,能将多波束声纳数据在声速修正和潮位修正后得到探测地型深度数据,能通过水声通信确定相对位置以及互相传输数据,能通过主机器人传输来的机器人位置信息确定其潜器状态;
主机器人可与其他机器人进行水声通信,存储先验地图,能将收到的机器人相对位置信息结合探测地型数据处理为待匹配地形,再结合先验地图进行匹配操作,得到各机器人位置,最终返回给各机器人;
还包括如下步骤:
步骤一:N个机器人编队运行,由各个机器人将多波束声纳数据进行声速修正、潮位修正后得到待验地图深度数据,并将待验地图深度数据通过水声通信传递给主机器人;
步骤二:将各个机器人间的相对位置信息通过水声通信传递给主机器人;
步骤三:主机器人结合得到的相对位置信息以及待验地图深度数据进行汇总整理,经过计算得到待匹配地形;
步骤四:主机器人提取先验地图中的地形数据,利用极大似然估计来找出待匹配地形在先验地图中的最佳匹配点(xmatch,ymatch),x、y分别对应大地坐标系中的经度值、纬度值;
步骤五:主机器人通过最佳匹配点(xmatch,ymatch)与各个机器人的相对位置信息,计算出每一个机器人对应的位置信息(x1,y1)、(x2,y2),(x3,y3)…(xn,yn)后,再返回给各个机器人,完成多机器人协同地形匹配定位。
2.根据权利要求1所述的一种多机器人协同水下地形匹配导航方法,其特征在于:步骤三中的所述汇总整理包括:
第一:结合得到的待验地图深度数据和相对位置信息得到这些水深数据点的位置与数据信息;
第二:将水深数据点的位置与数据信息逐个读取,结合各个机器人的相对位置信息,判断该水深数据点是否已写入待匹配地形:若未写入,则进行第三步,若已写入,则进行第四步;
第三:将未写入的水深数据点写入待匹配地形;
第四:保存已写入的水深数据点对应的所有数据,取平均值作为数据写入待匹配地形;
第五:所有数据点写入完毕,整理数据,得到待匹配地形。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710054066.2/1.html,转载请声明来源钻瓜专利网。
- 上一篇:活鱼振动分选筛
- 下一篇:一种基于悬挂链的多站点工艺追溯自动分拣装置