路径规划方法、装置及计算机可读存储介质与流程

文档序号:23844802发布日期:2021-02-05 10:35阅读:69来源:国知局
路径规划方法、装置及计算机可读存储介质与流程

[0001]
本发明涉及人工智能技术领域,尤其涉及一种路径规划方法、装置及计算机可读存储介质。


背景技术:

[0002]
随着科技的快速发展,机器人已逐渐深入到人类生活的方方面面。目前,机器人在商场、餐厅、酒店、ktv等服务场所得到了广泛应用。通常,利用机器人进行迎宾、带领客人进入包厢、送餐和将物品送达包厢等服务,以节约人力成本。因此,当机器人执行一个任务时,需进行路径规划,以避开障碍物,并成功到达目的地。
[0003]
目前,机器人规划路径只能依据机器人当前所检测出来的环境信息,而无法估计到其他环境信息。在复杂环境中,当其他环境中出现障碍物时,机器人无法及时得知障碍信息,从而无法及时规划新路径,导致机器人被障碍物阻挡后才重新规划路径,使得机器人路径规划效率低。


技术实现要素:

[0004]
本发明的主要目的在于提供一种路径规划方法、装置及计算机可读存储介质,旨在提高机器人路径规划效率。
[0005]
为实现上述目的,本发明提供一种路径规划方法,所述路径规划方法包括以下步骤:
[0006]
获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;
[0007]
根据所述环境信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0008]
若所述初始路径存在通行障碍物,则控制所述第一机器人重新规划路径。
[0009]
可选地,所述若所述初始路径存在通行障碍物,则控制所述第一机器人重新规划路径的步骤包括:
[0010]
若所述初始路径存在通行障碍物,则获取所述第一机器人所在区域的数字地图;
[0011]
根据所述数字地图及所述环境信息,确定所述第一机器人的当前位置;
[0012]
将所述环境信息及所述第二机器人的障碍信息进行结合,得到信息集合;
[0013]
根据所述数字地图、所述当前位置及所述信息集合,控制所述第一机器人重新规划路径。
[0014]
可选地,所述数字地图为栅格地图;
[0015]
所述根据所述数字地图、所述当前位置及所述信息集合,控制所述第一机器人重新规划路径的步骤包括:
[0016]
将所述信息集合转换为以所述数字地图为参考系的地图坐标;
[0017]
根据所述地图坐标,建立障碍栅格地图;
[0018]
将所述数字地图与所述障碍栅格地图进行合并,得到环境栅格地图;
[0019]
根据所述当前位置及所述环境栅格地图,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0020]
可选地,所述根据所述当前位置及所述环境栅格地图,控制所述第一机器人利用最短路径搜索算法重新规划路径的步骤包括:
[0021]
将所述环境栅格地图的未知区域、障碍物区域及无障碍物区域分别进行赋值;
[0022]
根据预设似然场构建公式及赋值后的环境栅格地图,构建地图似然场;
[0023]
根据所述当前位置及所述地图似然场,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0024]
可选地,所述获取第一机器人周围的环境信息,并获取第二机器人的障碍信息的步骤包括:
[0025]
通过传感器获取第一机器人周围的环境信息;
[0026]
通过预设交互方式获取第二机器人的障碍信息。
[0027]
可选地,所述获取第一机器人周围的环境信息,并获取第二机器人的障碍信息的步骤之前,还包括:
[0028]
构建第一机器人与第二机器人的无向拓扑图;
[0029]
根据所述无向拓扑图,构建分布式的信息交互模型;
[0030]
其中,所述通过预设交互方式获取第二机器人的障碍信息的步骤包括:
[0031]
通过所述信息交互模型直接获取所述第二机器人发送的障碍信息。
[0032]
可选地,所述根据所述环境信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物的步骤包括:
[0033]
根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0034]
若所述第一机器人周围存在通行障碍物,则获取所述第一机器人的障碍信息;
[0035]
根据所述第一机器人的障碍信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0036]
若所述第一机器人周围不存在通行障碍物,则根据所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物。
[0037]
可选地,所述路径规划方法还包括:
[0038]
根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0039]
若所述第一机器人周围存在通行障碍物,则生成所述第一机器人的障碍信息以供传输至所述第二机器人。
[0040]
此外,为实现上述目的,本发明还提供一种路径规划装置,所述路径规划装置包括:
[0041]
信息获取模块,用于获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;
[0042]
障碍判断模块,用于根据所述环境信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0043]
路径规划模块,用于若所述初始路径存在通行障碍物,则控制所述第一机器人重新规划路径。
[0044]
此外,为实现上述目的,本发明还提供一种计算机可读存储介质,所述计算机可读
存储介质上存储有路径规划程序,所述路径规划程序被处理器执行时实现如上所述的路径规划方法的步骤。
[0045]
本发明提供一种路径规划方法、装置及计算机可读存储介质,获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;根据环境信息及第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物;若初始路径存在通行障碍物,则控制第一机器人重新规划路径。通过上述方式,本发明获取第一机器人周围的环境信息,即获取待规划路径机器人当前所检测出来的环境信息,并获取第二机器人的障碍信息,即获取其他机器人所处的其他环境信息中的障碍信息,然后,综合考虑第一机器人周围的环境信息及第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物,以使机器人及时得知障碍信息,然后根据障碍信息,及时规划新路径。相比机器人被障碍物阻挡后才重新规划路径,本发明提前重新规划路径,以提高机器人路径规划效率。
附图说明
[0046]
图1为本发明实施例方案涉及的硬件运行环境的终端结构示意图;
[0047]
图2为本发明路径规划方法第一实施例的流程示意图;
[0048]
图3为本发明路径规划方法第二实施例的流程示意图;
[0049]
图4为本发明路径规划方法第三实施例的流程示意图;
[0050]
图5为本发明路径规划方法第四实施例的流程示意图;
[0051]
图6为本发明路径规划方法第五实施例的流程示意图;
[0052]
图7为本发明机器人避让装置第一实施例的功能模块示意图。
[0053]
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
[0054]
应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
[0055]
参照图1,图1为本发明实施例方案涉及的硬件运行环境的终端结构示意图。
[0056]
本发明实施例终端为路径规划设备,该路径规划设备可以为机器人、pc(personal computer,个人计算机)、笔记本电脑、服务器等具有处理功能的终端设备。
[0057]
如图1所示,该终端可以包括:处理器1001,例如cpu(central processing unit,中央处理器),通信总线1002,用户接口1003,网络接口1004,存储器1005。其中,通信总线1002用于实现这些组件之间的连接通信。用户接口1003可以包括显示屏(display)、输入单元比如键盘(keyboard),可选用户接口1003还可以包括标准的有线接口、无线接口。网络接口1004可选的可以包括标准的有线接口、无线接口(如wi-fi接口)。存储器1005可以是高速ram存储器,也可以是稳定的存储器(non-volatile memory),例如磁盘存储器。存储器1005可选的还可以是独立于前述处理器1001的存储装置。
[0058]
本领域技术人员可以理解,图1中示出的终端结构并不构成对终端的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。
[0059]
如图1所示,作为一种计算机存储介质的存储器1005中可以包括操作系统、网络通信模块、用户接口模块以及路径规划程序。
[0060]
在图1所示的终端中,处理器1001可以用于调用存储器1005中存储的路径规划程
序,并执行以下操作:
[0061]
获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;
[0062]
根据所述环境信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0063]
若所述初始路径存在通行障碍物,则控制所述第一机器人重新规划路径。
[0064]
进一步地,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0065]
若所述初始路径存在通行障碍物,则获取所述第一机器人所在区域的数字地图;
[0066]
根据所述数字地图及所述环境信息,确定所述第一机器人的当前位置;
[0067]
将所述环境信息及所述第二机器人的障碍信息进行结合,得到信息集合;
[0068]
根据所述数字地图、所述当前位置及所述信息集合,控制所述第一机器人重新规划路径。
[0069]
进一步地,所述数字地图为栅格地图,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0070]
将所述信息集合转换为以所述数字地图为参考系的地图坐标;
[0071]
根据所述地图坐标,建立障碍栅格地图;
[0072]
将所述数字地图与所述障碍栅格地图进行合并,得到环境栅格地图;
[0073]
根据所述当前位置及所述环境栅格地图,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0074]
进一步地,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0075]
将所述环境栅格地图的未知区域、障碍物区域及无障碍物区域分别进行赋值;
[0076]
根据预设似然场构建公式及赋值后的环境栅格地图,构建地图似然场;
[0077]
根据所述当前位置及所述地图似然场,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0078]
进一步地,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0079]
通过传感器获取第一机器人周围的环境信息;
[0080]
通过预设交互方式获取第二机器人的障碍信息。
[0081]
进一步地,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0082]
构建第一机器人与第二机器人的无向拓扑图;
[0083]
根据所述无向拓扑图,构建分布式的信息交互模型;
[0084]
其中,所述通过预设交互方式获取第二机器人的障碍信息的步骤包括:
[0085]
通过所述信息交互模型直接获取所述第二机器人发送的障碍信息。
[0086]
进一步地,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0087]
根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0088]
若所述第一机器人周围存在通行障碍物,则获取所述第一机器人的障碍信息;
[0089]
根据所述第一机器人的障碍信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0090]
若所述第一机器人周围不存在通行障碍物,则根据所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物。
[0091]
进一步地,处理器1001可以用于调用存储器1005中存储的路径规划程序,还执行以下操作:
[0092]
根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0093]
若所述第一机器人周围存在通行障碍物,则生成所述第一机器人的障碍信息以供传输至所述第二机器人。
[0094]
基于上述硬件结构,提出本发明路径规划方法各个实施例。
[0095]
本发明提供一种路径规划方法。
[0096]
参照图2,图2为本发明路径规划方法第一实施例的流程示意图。
[0097]
在本实施例中,该路径规划方法包括以下步骤s10-s30:
[0098]
步骤s10,获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;
[0099]
在本实施例中,该路径规划方法由路径规划设备实现,该路径规划设备可以为机器人、pc、笔记本电脑、服务器等具有处理功能的终端设备。该路径规划设备以机器人为例进行说明。
[0100]
在本实施例中,获取第一机器人周围的环境信息,并获取第二机器人的障碍信息。其中,第一机器人为待规划路径的机器人,第二机器人可以包括1个或多个,第二机器人为第一机器人所处区域内的其他机器人。
[0101]
需要说明的是,第一机器人周围的环境信息包括通行障碍物的障碍信息、通行道路信息,固定障碍物信息等信息。其中,通行障碍物为通行道路上的障碍物,该通行障碍物为动态障碍物,该动态障碍物为人、动物、机器人及被移动的物体;障碍信息包括通行障碍物的坐标等;通行道路信息包括通行道路的坐标等;固定障碍物信息包括墙壁的坐标、柱子的坐标、桌子的坐标等。上述坐标为以传感器为参考系的坐标,当然,该坐标还可以为以数字地图参考系的坐标,其中,数字地图是在一定坐标系统内具有确定的坐标和属性的地面要素和现象的离散数据,在计算机上为可识别的可存储介质上概括的、有序的集合,该数字地图包括但不仅仅限于栅格地图、矢量地图等。
[0102]
此外,还需要说明的是,可通过激光雷达传感器、距离传感器等传感器获取第一机器人周围的环境信息,当然,还可以通过摄像头获取第一机器人周围的环境信息;可通过网络通信(wi-fi、4g、5g等)或短距离通信(蓝牙、zigbee(紫蜂)等)获取第二机器人的障碍信息。其中,获取第二机器人的障碍信息,可通过构建信息交互模型,以使第一机器人可与第二机器人相互交互,当然,第二机器人还可以将障碍信息上传至服务器,再由服务器进行转发。
[0103]
具体的,步骤s10包括以下步骤a11-a12:
[0104]
步骤a11,通过传感器获取第一机器人周围的环境信息
[0105]
在本实施例中,通过传感器获取第一机器人周围的环境信息。其中,传感器根据实际需要进行设定,例如激光雷达传感器、距离传感器等,此处不作具体限定。
[0106]
步骤a12,通过预设交互方式获取第二机器人的障碍信息。
[0107]
在本实施例中,通过预设交互方式获取第二机器人的障碍信息。其中,预设交互方式根据实际需要进行设定,例如wi-fi、4g、5g、蓝牙、zigbee等通信方式,此处不作具体限定,在建立上述通信方式基础上,可以构建信息交互模型进行交互,以实现各个机器人之间的快速交互。
[0108]
步骤s20,根据所述环境信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0109]
在本实施例中,根据环境信息及第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物。具体的,先提取环境信息中第一机器人的障碍信息,然后将第一机器人的障碍信息与第二机器人的障碍信息进行合并,最后,根据合并后的障碍信息,判断第一机器人的初始路径是否存在通行障碍物。
[0110]
需要说明的是,初始路径为第一机器人在无通行障碍物时,通过最短路径搜索算法规划的路径;通行障碍物为第一机器人通行道路上的物体,并且,该物体可阻挡第一机器人前进。
[0111]
具体的,步骤s20包括以下步骤a21-a24:
[0112]
步骤a21,根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0113]
在本实施例中,根据环境信息,判断第一机器人周围是否存在通行障碍物。具体的,查看环境信息中是否存在通行障碍物的障碍信息,若环境信息中存在通行障碍物的障碍信息,则判定第一机器人周围存在通行障碍物;若环境信息中不存在通行障碍物的障碍信息,则判定第一机器人周围不存在通行障碍物。
[0114]
步骤a22,若所述第一机器人周围存在通行障碍物,则获取所述第一机器人的障碍信息;
[0115]
在本实施例中,若第一机器人周围存在通行障碍物,则获取第一机器人的障碍信息。其中,第一机器人的障碍信息包括第一机器人周围通行障碍物的坐标等,该坐标为以传感器为参考系的坐标,当然,还可以选择其他参考系,此处不作赘述。
[0116]
步骤a23,根据所述第一机器人的障碍信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0117]
在本实施例中,根据第一机器人的障碍信息及第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物。具体的,若第一机器人的障碍信息或第二机器人的障碍信息中的一通行障碍物的坐标与第一机器人的初始路径坐标有重叠,则判定第一机器人的初始路径存在通行障碍物;若第一机器人的障碍信息或第二机器人的障碍信息中的任一通行障碍物的坐标与第一机器人的初始路径坐标均没有重叠,则判定第一机器人的初始路径不存在通行障碍物。
[0118]
步骤a24,若所述第一机器人周围不存在通行障碍物,则根据所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物。
[0119]
在本实施例中,若第一机器人周围不存在通行障碍物,则根据第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物。具体的,若第二机器人的障碍信息中的一通行障碍物的坐标与第一机器人的初始路径坐标有重叠,则判定第一机器人的初始路径存在通行障碍物;第二机器人的障碍信息中的任一通行障碍物的坐标与第一机器人的初始路径坐标均没有重叠,则判定第一机器人的初始路径不存在通行障碍物。
[0120]
可以理解,若第一机器人的环境信息中无障碍信息,则只需根据第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物,从而进一步提高路径规划效率。
[0121]
步骤s30,若所述初始路径存在通行障碍物,则控制所述第一机器人重新规划路径。
[0122]
在本实施例中,若初始路径存在通行障碍物,则控制第一机器人重新规划路径。具体的,首先,根据第一机器人所在区域的数字地图及环境信息,确定第一机器人的当前位置,然后,根据当前位置、数字地图、环境信息、第二机器人的障碍信息及第一机器人的目标位置,控制第一机器人利用最短路径搜索算法重新规划路径。具体的执行过程如下第二实施例所述,此处不作赘述。
[0123]
本发明实施例提供一种路径规划方法,获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;根据环境信息及第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物;若初始路径存在通行障碍物,则控制第一机器人重新规划路径。通过上述方式,本发明实施例获取第一机器人周围的环境信息,即获取待规划路径机器人当前所检测出来的环境信息,并获取第二机器人的障碍信息,即获取其他机器人所处的其他环境信息中的障碍信息,然后,综合考虑第一机器人周围的环境信息及第二机器人的障碍信息,判断第一机器人的初始路径是否存在通行障碍物,以使机器人及时得知障碍信息,然后根据障碍信息,及时规划新路径。相比机器人被障碍物阻挡后才重新规划路径,本发明实施例提前重新规划路径,以提高机器人路径规划效率。
[0124]
进一步地,基于上述第一实施例,提出本发明路径规划方法的第二实施例。
[0125]
参照图3,图3为本发明路径规划方法第二实施例的流程示意图。
[0126]
在本实施例中,上述步骤s30包括以下步骤s31-s34:
[0127]
步骤s31,若所述初始路径存在通行障碍物,则获取所述第一机器人所在区域的数字地图;
[0128]
在本实施例中,若初始路径存在通行障碍物,则获取第一机器人所在区域的数字地图。其中,数字地图为机器人当前工作区域的地图,该数字地图上显示有通行道路及固定障碍物等。该数字地图可以为栅格地图或矢量图等。
[0129]
需要说明的是,根据机器人当前工作区域的环境信息,将环境信息转换为以数字地图为参考系的坐标及属性,然后,根据坐标及属性,生成数字地图,最后,将该数字地图提前写入机器人,以供机器人进行定位。
[0130]
步骤s32,根据所述数字地图及所述环境信息,确定所述第一机器人的当前位置;
[0131]
在获取到数字地图之后,根据数字地图及环境信息,确定第一机器人的当前位置。具体的,将环境信息中的坐标与数字地图中的坐标进行匹配,然后,根据匹配结果,确定第一机器人的当前位置。其中,当前位置为第一机器人在数字地图上的位置。
[0132]
需要说明的是,环境信息包括通行障碍物的障碍信息、通行道路信息,固定障碍物信息等信息。其中,通行障碍物为通行道路上的障碍物,该通行障碍物为动态障碍物,该动态障碍物为人、动物、机器人及被移动的物体;障碍信息包括通行障碍物的坐标等;通行道路信息包括通行道路的坐标等;固定障碍物信息包括墙壁的坐标、柱子的坐标、桌子的坐标等。上述坐标为以传感器为参考系的坐标,当然,该坐标还可以为以数字地图为参考系的坐标。
[0133]
步骤s33,将所述环境信息及所述第二机器人的障碍信息进行结合,得到信息集合;
[0134]
在本实施例中,将环境信息及第二机器人的障碍信息进行结合,得到信息集合。具体的,将环境信息中通行障碍物的障碍信息与第二机器人的障碍信息进行结合,得到的信息集合为第一机器人所在区域的所有障碍信息。
[0135]
步骤s34,根据所述数字地图、所述当前位置及所述信息集合,控制所述第一机器人重新规划路径。
[0136]
在本实施例中,根据数字地图、当前位置及信息集合,控制所述第一机器人重新规划路径。具体的,根据数字地图与信息集合,得到有通行障碍物的数字地图,然后,根据有通行障碍物的数字地图、当前位置及第一机器人的目标位置,控制第一机器人利用最短路径搜索算法重新规划路径。
[0137]
具体的,步骤s34包括以下步骤a341-a344:
[0138]
步骤a341,将所述信息集合转换为以所述数字地图为参考系的地图坐标;
[0139]
在本实施例中,将信息集合转换为以数字地图为参考系的地图坐标。其中,本实施例的数字地图为栅格地图。
[0140]
具体的,将信息集合中的坐标转换为以数字地图为参考系的地图坐标,其转换公式为a'=ra+t,其中a'为转换后的坐标,r为旋转矩阵,a为信息集合中的坐标,t为平移矩阵。为避免多次变换,可引入齐次坐标t,并把r和t融合到一个矩阵中,具体的公式为为精简上述旋转矩阵,可根据下述线性方程为r=cosθi+(1-cosθ)nn
t
+sinθn∧进行转换,其中,n为转换向量。
[0141]
步骤a342,根据所述地图坐标,建立障碍栅格地图;
[0142]
在转换得到地图坐标之后,根据地图坐标,建立障碍栅格地图。其中,障碍栅格地图为显示通行障碍物的栅格地图。
[0143]
步骤a343,将所述数字地图与所述障碍栅格地图进行合并,得到环境栅格地图;
[0144]
在得到障碍栅格地图之后,将数字地图与障碍栅格地图进行合并,得到环境栅格地图。其中,环境栅格地图为机器人当前所处环境的完整栅格地图。可以理解,环境栅格地图包括第一机器人周围的环境信息、其他环境信息等,因此环境栅格地图上可实时展现动态障碍物。
[0145]
步骤a344,根据所述当前位置及所述环境栅格地图,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0146]
在本实施例中,根据当前位置及环境栅格地图,控制第一机器人利用最短路径搜索算法重新规划路径。具体的,根据当前位置、环境栅格地图及第一机器人的目标位置,控制第一机器人利用最短路径搜索算法重新规划路径。其中,最短路径搜索算法可根据实际需要进行设定,例如d*(d star)算法、a*(a star)算法等算法,此处不作具体限定。
[0147]
需要说明的是,还可以根据环境栅格地图,构建地图似然场,然后,根据地图似然场、当前位置及第一机器人的目标位置,控制第一机器人利用最短路径搜索算法重新规划路径。具体的执行过程如下第三实施例所述,此处不作赘述。
[0148]
本实施例中,通过将第一机器人的环境信息与第二机器人的障碍信息进行结合,
以使第一机器人所得知的信息为各机器人得知的信息之和,以使机器人可得知所在区域任意位置的障碍信息,从而根据该障碍信息及时规划新路径,以进一步提高机器人路径规划效率。
[0149]
进一步地,基于上述第二实施例,提出本发明路径规划方法的第三实施例。
[0150]
参照图4,图4为本发明路径规划方法第三实施例的流程示意图。
[0151]
在本实施例中,上述步骤a344包括以下步骤s3441-s3443:
[0152]
步骤s3441,将所述环境栅格地图的未知区域、障碍物区域及无障碍物区域分别进行赋值;
[0153]
在本实施例中,将环境栅格地图的未知区域、障碍物区域及无障碍物区域分别进行赋值。具体的,将环境栅格地图的未知区域的值设定为-1,将环境栅格地图的障碍物区域的值设定为1,将环境栅格地图的无障碍物区域的值设定为0。当然,也可以设定为其他值,只要达到区分目的即可。
[0154]
步骤s3442,根据预设似然场构建公式及赋值后的环境栅格地图,构建地图似然场;
[0155]
在本实施例中,根据预设似然场构建公式及赋值后的环境栅格地图,构建地图似然场。其中,预设似然场构建公式为cost=exp(-1.0*weight*value)。其中,weight为权重值,value为上述所设定的值。
[0156]
需要说明的是,weight影响似然场的变化趋势,weight越大时,栅格地图的精度越高。在本实施例中,weight可根据实际需要进行设定,例如5、5.5、4.5等,此处不作具体限定。
[0157]
步骤s3443,根据所述当前位置及所述地图似然场,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0158]
在本实施例中,根据当前位置及地图似然场,控制第一机器人利用最短路径搜索算法重新规划路径。具体的,根据当前位置、地图似然场及第一机器人目标位置,控制第一机器人利用最短路径搜索算法重新规划路径。
[0159]
需要说明的是,最短路径搜索算法可根据实际需要进行设定,例如d*(d star)算法、a*(a star)算法等算法,此处不作具体限定。
[0160]
本实施例中,通过对环境栅格地图的未知区域、障碍物区域及无障碍物区域分别进行赋值,然后,通过预设似然场构建公式,构建地图似然场,以提高环境栅格地图的精度,从而提高机器人路径规划的准确率。
[0161]
进一步地,基于上述第一实施例,提出本发明路径规划方法的第四实施例。
[0162]
参照图5,图5为本发明路径规划方法第四实施例的流程示意图。
[0163]
在本实施例中,在上述步骤s10之前,该路径规划方法还包括以下步骤s40-s50:
[0164]
步骤s40,构建第一机器人与第二机器人的无向拓扑图;
[0165]
在本实施例中,构建第一机器人与第二机器人的无向拓扑图。其中,无向拓扑图为机器人两两进行无方向连接的图形。
[0166]
步骤s50,根据所述无向拓扑图,构建分布式的信息交互模型;
[0167]
在构建完无向拓扑图之后,根据无向拓扑图,构建分布式的信息交互模型。需要说明的是,分布式的信息交互模型,机器人属于独立的自主体。
[0168]
其中,所述通过预设交互方式获取第二机器人的障碍信息的步骤包括:
[0169]
通过所述信息交互模型直接获取所述第二机器人发送的障碍信息。
[0170]
在本实施例中,构建完分布式的信息交互模型之后,第一机器人可根据信息交互模型,直接获取第二机器人发送的障碍信息。
[0171]
本实施例中,根据机器人之间的无向拓扑图,构建分布式的信息交互模型,以使机器人之间直接交互,无需中间服务器进行转发,可节约服务器成本,同时,使用该分布式的信息交互模型,在其中一台机器人宕机时,该宕机机器人的信息可通过其他机器人重新获取得到,从而防止机器人的信息丢失。
[0172]
进一步地,基于上述第一实施例,提出本发明路径规划方法的第五实施例。
[0173]
参照图6,图6为本发明路径规划方法第五实施例的流程示意图。
[0174]
在本实施例中,本发明路径规划方法还包括以下步骤s60-s70:
[0175]
步骤s60,根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0176]
在本实施例中,根据环境信息,判断第一机器人周围是否存在通行障碍物。具体的,查看环境信息中是否存在通行障碍物的障碍信息,若环境信息中存在通行障碍物的障碍信息,则判定第一机器人周围存在通行障碍物;若环境信息中不存在通行障碍物的障碍信息,则判定第一机器人周围不存在通行障碍物。
[0177]
步骤s70,若所述第一机器人周围存在通行障碍物,则生成所述第一机器人的障碍信息以供传输至所述第二机器人;
[0178]
在本实施例中,若第一机器人周围存在通行障碍物,则生成第一机器人的障碍信息。其中,第一机器人的障碍信息包括第一机器人周围通行障碍物的坐标等,该坐标为以传感器为参考系的坐标,当然,还可以选择其他参考系,此处不作赘述。
[0179]
需要说明的是,当第二机器人需要获取第一机器人的障碍信息时,可通过网络通信(wi-fi、4g、5g等)或短距离通信(蓝牙、zigbee(紫蜂)等)将第一机器人的障碍信息发送至第二机器人。其中,将第一机器人的障碍信息发送至第二机器人,可通过构建信息交互模型,以使第一机器人可与第二机器人相互交互,当然,还可以将障碍信息上传至服务器,再由服务器进行转发。
[0180]
本实施例中,判断第一机器人周围是否存在通行障碍物,若第一机器人周围是否存在通行障碍物,则将第一机器人的障碍信息发送至第二机器人,以使第二机器人可及时得知第一机器人的障碍信息,从而及时规划新路径,可进一步提高机器人路径规划效率。
[0181]
本发明还提供一种路径规划装置。
[0182]
参照图7,图7为本发明路径规划装置第一实施例的功能模块示意图。
[0183]
在本实施例中,所述路径规划装置包括:
[0184]
信息获取模块10,用于获取第一机器人周围的环境信息,并获取第二机器人的障碍信息;
[0185]
障碍判断模块20,用于根据所述环境信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0186]
路径规划模块30,用于若所述初始路径存在通行障碍物,则控制所述第一机器人重新规划路径。
[0187]
其中,上述路径规划装置的各虚拟功能模块存储于图1所示路径规划设备的存储
器1005中,用于实现路径规划程序的所有功能;各模块被处理器1001执行时,可实现路径规划功能。
[0188]
进一步地,所述路径规划模块30包括:
[0189]
地图获取单元,用于若所述初始路径存在通行障碍物,则获取所述第一机器人所在区域的数字地图;
[0190]
位置确定单元,用于根据所述数字地图及所述环境信息,确定所述第一机器人的当前位置;
[0191]
信息结合单元,用于将所述环境信息及所述第二机器人的障碍信息进行结合,得到信息集合;
[0192]
路径规划单元,用于根据所述数字地图、所述当前位置及所述信息集合,控制所述第一机器人重新规划路径。
[0193]
进一步地,所述数字地图为栅格地图,所述路径规划单元还用于:
[0194]
将所述信息集合转换为以所述数字地图为参考系的地图坐标;根据所述地图坐标,建立障碍栅格地图;将所述数字地图与所述障碍栅格地图进行合并,得到环境栅格地图;根据所述当前位置及所述环境栅格地图,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0195]
进一步地,所述路径规划单元还用于:
[0196]
将所述环境栅格地图的未知区域、障碍物区域及无障碍物区域分别进行赋值;根据预设似然场构建公式及赋值后的环境栅格地图,构建地图似然场;根据所述当前位置及所述地图似然场,控制所述第一机器人利用最短路径搜索算法重新规划路径。
[0197]
进一步地,所述信息获取模块10包括:
[0198]
环境获取单元,用于通过传感器获取第一机器人周围的环境信息;
[0199]
障碍获取单元,用于通过预设交互方式获取第二机器人的障碍信息。
[0200]
进一步地,所述路径规划装置还包括:
[0201]
拓扑构建模块,用于构建第一机器人与第二机器人的无向拓扑图;
[0202]
模型构建模块,用于根据所述无向拓扑图,构建分布式的信息交互模型;
[0203]
其中,所述通过预设交互方式获取第二机器人的障碍信息的步骤包括:
[0204]
通过所述信息交互模型直接获取所述第二机器人发送的障碍信息。
[0205]
进一步地,所述障碍判断模块20包括:
[0206]
障碍判断单元,用于根据所述环境信息,判断所述第一机器人周围是否存在通行障碍物;
[0207]
障碍获取单元,用于若所述第一机器人周围存在通行障碍物,则获取所述第一机器人的障碍信息;
[0208]
障碍判断单元,还用于根据所述第一机器人的障碍信息及所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物;
[0209]
障碍判断单元,还用于若所述第一机器人周围不存在通行障碍物,则根据所述第二机器人的障碍信息,判断所述第一机器人的初始路径是否存在通行障碍物。
[0210]
进一步地,所述路径规划装置还包括:
[0211]
障碍判断模块20,还用于根据所述环境信息,判断所述第一机器人周围是否存在
通行障碍物;
[0212]
障碍获取模块,用于若所述第一机器人周围存在通行障碍物,则获取所述第一机器人的障碍信息以供传输至所述第二机器人;
[0213]
其中,上述路径规划装置中各个模块的功能实现与上述路径规划方法实施例中各步骤相对应,其功能和实现过程在此处不再一一赘述。
[0214]
本发明还提供一种计算机可读存储介质,该计算机可读存储介质上存储有路径规划程序,所述路径规划程序被处理器执行时实现如以上任一项实施例所述的路径规划方法的步骤。
[0215]
本发明计算机可读存储介质的具体实施例与上述路径规划方法各实施例基本相同,在此不作赘述。
[0216]
需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下,由语句“包括一个
……”
限定的要素,并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
[0217]
上述本发明实施例序号仅仅为了描述,不代表实施例的优劣。
[0218]
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在如上所述的一个存储介质(如rom/ram、磁碟、光盘)中,包括若干指令用以使得一台终端设备(可以是手机,计算机,服务器,或者网络设备等)执行本发明各个实施例所述的方法。
[0219]
以上仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1