[发明专利]路径搜寻方法、装置、智能设备及存储介质在审
申请号: | 202111004524.4 | 申请日: | 2021-08-30 |
公开(公告)号: | CN113720344A | 公开(公告)日: | 2021-11-30 |
发明(设计)人: | 不公告发明人 | 申请(专利权)人: | 深圳市银星智能科技股份有限公司 |
主分类号: | G01C21/34 | 分类号: | G01C21/34 |
代理公司: | 北京市京大律师事务所 11321 | 代理人: | 姚维 |
地址: | 518110 广东省深圳市龙*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 路径 搜寻 方法 装置 智能 设备 存储 介质 | ||
1.一种路径搜寻方法,其特征在于,包括:
在栅格地图中确定起点网格和终点网格,并从所述起点网格向两侧横向延伸,生成第一线段,其中,所述栅格地图包括多个网格;
从所述第一线段开始向所述终点网格的方向进行区域搜寻,生成第一搜寻区域;
从所述第一搜寻区域向所述终点网格方向进行区域搜寻,生成第二搜寻区域;
在所述第一搜寻区域和所述第二搜寻区域中确定至少一个中间节点网格,所述中间节点网格用于指示目标路径的部分区域;
根据所述起点网格、所述终点网格和所述至少一个中间节点网格在所述目标区域中生成所述目标路径,所述目标区域包括所述第一搜寻区域和所述第二搜寻区域。
2.根据权利要求1所述的路径搜寻方法,其特征在于,所述从所述第一线段开始向所述终点网格的方向进行区域搜寻,生成第一搜寻区域,包括:
以所述第一线段的横向长度为扩散宽度,从起点网格向终点网格的方向进行竖向扩散;
当遇到至少一个障碍物且能竖向扩散时,缩小扩散宽度并按照缩小后的扩散宽度向所述终点网格的方向进行竖向扩散;
当遇到目标障碍物且不能竖向扩散时,沿着所述目标障碍物向两侧进行横向延伸,生成至少一个候选扩散线段;
从所述至少一个候选扩散线段中选择第一目标扩散线段向所述终点网格的方向竖向扩散,其中,所述第一目标扩散线段与所述终点网格的距离最小;
重复执行区域搜寻操作,直至已扩散区域的最大纵坐标与所述终点网格的纵坐标相同,所述区域搜寻操作包括竖向扩散和横向延伸;
根据已搜寻的网格区域生成第一搜寻区域,所述已搜寻的网格区域包括多个已扩散网格和多个已延伸网格。
3.根据权利要求2所述的路径搜寻方法,其特征在于,在所述从所述至少一个候选扩散线段中选择第一目标扩散线段向所述终点网格的方向竖向扩散之后,在所述重复执行区域搜寻操作之前,所述路径搜寻方法还包括:
当遇到目标障碍物且不能竖向扩散和横向延伸时,退回至上一次选择的扩散线段;
将所述上一次选择的扩散线段标记为不可扩散线段;
从所述至少一个候选扩散线段中选择第二目标扩散线段进行竖向扩散,所述第二目标扩散线段与所述第一目标扩散线段不同。
4.根据权利要求2所述的路径搜寻方法,其特征在于,所述根据已搜寻的网格区域生成第一搜寻区域,包括:
在所述已搜寻的网格区域中标记第一标记网格,所述第一标记网格与所述终点网格之间的距离最小;
若所述第一标记网格与所述终点网格之间无障碍物,则将所述已搜寻的网格区域确定为第一搜寻区域。
5.根据权利要求2所述的路径搜寻方法,其特征在于,所述根据已搜寻的网格区域生成第一搜寻区域,包括:
在所述已搜寻的网格区域中标记第一标记网格,所述第一标记网格与所述终点网格之间的距离最小;
若所述第一标记网格与所述终点网格之间存在障碍物,则从所述第一标记网格处回退至所述已搜寻的网格区域中的可延伸线段;
根据所述可延伸线段在所述已搜寻的网格区域确定可延伸区域;
将所述可延伸区域确定为第一搜寻区域。
6.根据权利要求5所述的路径搜寻方法,其特征在于,在所述将所述可延伸区域确定为第一搜寻区域之后,所述路径搜寻方法还包括:
将回退后所在的当前网格确定为第二标记网格,所述第二标记网格为所述可延伸区域中与所述终点网格之间距离最小的网格。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市银星智能科技股份有限公司,未经深圳市银星智能科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111004524.4/1.html,转载请声明来源钻瓜专利网。