[发明专利]AGV地图的基准点查找方法及装置、电子设备、存储介质在审
申请号: | 202110921738.1 | 申请日: | 2021-08-12 |
公开(公告)号: | CN113377094A | 公开(公告)日: | 2021-09-10 |
发明(设计)人: | 罗庇鹏 | 申请(专利权)人: | 浙江华睿科技股份有限公司 |
主分类号: | G05D1/00 | 分类号: | G05D1/00;G05D1/02 |
代理公司: | 北京乐知新创知识产权代理事务所(普通合伙) 11734 | 代理人: | 江宇 |
地址: | 310051 浙江省杭*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | agv 地图 基准点 查找 方法 装置 电子设备 存储 介质 | ||
1.一种AGV地图的基准点查找方法,其特征在于,所述方法包括:
获取AGV的当前坐标,并基于所述当前坐标在AGV地图中确定所述当前坐标所属的网格区域,其中,AGV地图按照预设网格尺寸被网格化为多个网格区域;
查询与所述当前坐标所属的网格区域对应的基准点集合,其中,所述基准点集合包括至少一个基准点的坐标,所述至少一个基准点包括:与所述当前坐标所属的网格区域及其相邻网格区域内的基准点,和/或经过当前坐标所属的网格区域或其扩展网格区域的基准点连接线的端点的基准点;
将所述基准点集合中与所述当前坐标的距离最小的基准点作为查找结果。
2.根据权利要求1所述的方法,其特征在于,获取AGV的当前坐标之前,所述方法包括:
确定AGV地图中的每一基准点的所在的第一网格区域,沿所述第一网格区域的边线向四周扩展为包围所述第一网格区域的网格,得到扩展网格;其中,所述第一网格区域和所述扩展网格中其余所述第一网格区域记录相同的基准点。
3.根据权利要求1所述的方法,其特征在于,所述方法还包括:
获取AGV地图中的连接线,确定所述连接线经过的至少一个第一网格区域,以所述连接线经过的第一网格区域为基础,确定所述连接线经过的第一网格区域的扩展网格;将扩展网格中包含的连接线端点与扩展网格及其包含的第一网格区域相关联。
4.根据权利要求3所述的方法,其特征在于,所述方法还包括:
根据扩展网格及其包含的第一网格区域相关联的基准点或连接线端点,排除与当前AGV坐标的距离非最小的基准点。
5.根据权利要求4所述的方法,其特征在于,所述排除与当前AGV坐标的距离非最小的基准点,包括:
确定所有第一网格区域或扩展网格与其关联的基准点或连接线端点,计算基准点与对应的第一网格区域或扩展网格的中心点之间的距离;
对所计算的距离按从小到大的顺序进行排序,依次判断相邻两个距离的差值,当相邻距离差值大于第一网格区域或扩展网格的对角线长度时,从该第一网格区域或扩展网格起,删除其后的所有第一网格区域或扩展网格。
6.根据权利要求2所述的方法,其特征在于,所述第一网格区域为正方形方格时,沿所述第一网格区域的边线扩展B个所述第一网格区域单位,构成扩展网格,所述扩展网格包含(1+B)2个所述第一网格区域。
7.一种AGV地图的基准点查找装置,其特征在于,所述装置包括:
确定单元,用于获取AGV的当前坐标,并基于所述当前坐标在AGV地图中确定所述当前坐标所属的网格区域,其中,AGV地图按照预设网格尺寸被网格化为多个网格区域;
查找单元,用于查询与所述当前坐标所属的网格区域对应的基准点集合,其中,所述基准点集合包括至少一个基准点的坐标,所述至少一个基准点包括:与所述当前坐标所属的网格区域及其相邻网格区域内的基准点,和/或经过当前坐标所属的网格区域或其扩展网格区域的基准点连接线的端点的基准点;将所述基准点集合中与所述当前坐标的距离最小的基准点作为查找结果。
8.根据权利要求7所述的装置,其特征在于,所述装置还包括:
第一区域划分单元,用于确定AGV地图中的每一基准点的所在的第一网格区域,沿所述第一网格区域的边线向四周扩展为包围所述第一网格区域的网格,得到扩展网格;其中,所述第一网格区域和所述扩展网格中其余所述第一网格区域记录相同的基准点。
9.根据权利要求7所述的装置,其特征在于,所述装置包括:
第二区域划分单元,用于获取AGV地图中的连接线,确定所述连接线经过的至少一个第一网格区域,以所述连接线经过的第一网格区域为基础,确定所述连接线经过的第一网格区域的扩展网格;将扩展网格中包含的连接线端点与扩展网格及其包含的第一网格区域相关联。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江华睿科技股份有限公司,未经浙江华睿科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110921738.1/1.html,转载请声明来源钻瓜专利网。