【具体实施方式】
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步地详细描述。
请参阅图1,其是本发明一种激光制导地图构建的搬运机器人导航方法一个实施例的流程图。
一种激光制导地图构建的搬运机器人导航方法,包括步骤:
S101:获取作业区域的拓扑地图、几何地图以及搬运机器人的目标终点;
所述拓扑地图包括作业区域障碍物、可运行道路等环境的拓扑关系。当获取了搬运机器人的起点和目标终点时,即可生成一个用拓扑连接形式展现的全局规划路径。
所述几何地图包括通过几何图形表示作业区域障碍物、可运行道路等环境的地图。
S102:获取由激光测距仪和里程计测量的搬运机器人的定位信息;
接收获取由激光测距仪和里程计测量的搬运机器人的定位信息。当激光测距仪能够准确测量搬运机器人的定位信息时,则取激光测距仪所测量的信息作为搬运机器人的定位信息。否则,取里程计的估算值作为搬运机器人的定位信息。其中所述定位信息包括搬运机器人的位置坐标和自定位位姿;所述自定位位姿包括搬运机器人当前所指向的方向。
S103:依据所述定位信息、目标终点和所述拓扑地图生成全局规划路径;
根据步骤S102获得的定位信息、步骤S101获得的搬运机器人的目标终点,结合所述拓扑地图,通过预设算法,生成全局规划路径。其中,所述预设算法可以是启发式搜索算法、最短路径规划法或者其他算法。
S104:根据所述定位信息获取与所述搬运机器人的位置坐标关联的栅格地图,并依据所述全局规划路径生成用于指示搬运机器人运动的指令。
根据所述定位信息获取与所述定位信息相匹配的几何地图,将所述几何地图栅格化,生成栅格地图,结合全局规划路径,生成搬运机器人在改点的用于指示搬运机器人运动的指令。在搬运机器人运动的过程当中,重复执行步骤S102 和步骤S104,直到搬运机器人到达目标终点为止。
本发明首先利用拓扑地图或几何地图生成全局规划路径,并在搬运机器人运动的过程中,通过激光测距仪和里程计获取搬运机器人的定位信息,然后根据所述定位信息搜寻对应的栅格地图。最后结合栅格地图和全局规划路径,生成用于指示搬运机器人运动的指令。本发明只需通过激光测距仪和里程计获取搬运机器人的定位信息即可实现对搬运机器人的实时导航,无需再搬运机器人的作业区域加装其他任何的导航引导材料或结构,在保证搬运机器人导航精度的情况下节约了搬运机器人的导航成本。一方面,避免了对搬运机器人作业区域的环境破坏,另一方面大大加强了搬运机器人的应用范围。
在一个实施例中,上述步骤S102可以包括以下步骤:
S201:接收激光传感器扫描的周围环境信息;
所述周围环境信息包括搬运机器人至各个障碍物的距离。
S202:利用预设窗函数将所述周围环境信息进行滤波,并将滤波后的周围环境信息进行直线拟合,生成拟合数据;
在实际的作业环境中,激光传感器发送的数据存在比较多的干扰数据或者无用数据,利用预设的窗函数将所述周边环境信息进行滤波,获得纯净的周围环境信息。
然后将滤波后的环境信息通过预设的拟合算法进行直线拟合,生成拟合数据。
S203:将所述拟合数据与预选的几何地图进行特征匹配,判断所述拟合数据与预先的几何地图是否匹配。
利用预设的特征匹配算法,计算拟合数据和所述几何地图的特征值。将所述拟合数据与预选的几何地图进行特征匹配,判断所述拟合数据与预先的几何地图是否匹配。
S204:若匹配,则对所述拟合数据与预选的几何地图的匹配度进行门限过滤,若过滤成功,则通过预设位姿公式计算自定位位姿。
若匹配,则需要对所述拟合数据与预选的几何地图的匹配度进行门限过滤,即检验所述拟合数据和几何地图的匹配程度,若过滤成功,则说明所述拟合数据和几何地图高度匹配,此时通过预设位姿公式计算自定位位姿。
S205:若不匹配或过滤失败,则通过里程计估算自定位位姿。
在不匹配或者过滤失败时,则说明激光传感器返回的周围环境信息不理想,此时通过里程计估算自定位位姿。
本实施例通过激光传感器和里程计结合,能够准确地获取搬运机器人的自定位位姿,避免了加装其他任何的导航引导材料或结构,一方面能够节约导航成本,另一方面能够准确地获得搬运机器人的自定位位姿。
在一个实施例中,上述步骤S103可以包括:
S301:将所述拓扑地图划分成复数个网格;
将拓扑地图划分成复数个网格,可依据搬运机器人的运动精度划分。
S302:将搬运机器人的位置坐标所在的方格作为父方格,寻找该父方格可到达的子方格;
确定搬运机器人的位置坐标所在的方格,将该方格作为父方格,寻找搬运机器人在该父方格以一个步长能够到达的子方格。
S303:计算每一子方格的估价函数值,其中所述估价函数值等于搬运机器人的初始坐标至该子方格的实际代价加上该子方格至目标方格的估计代价;
针对步骤S302寻找获得的子方格,计算每一子方格的估价函数值。该估价函数值等于搬运机器人的初始坐标(即搬运机器人的起点)至该子方格的实际代价加上该子方格至目标方格的估计代价。搬运机器人跨越一个方格,即可视为一个代价。
S304:若某一子方格的估价函数值最低,则将该子方格作为所述父方格的下一到达位置;
计算所有子方格的估价函数值之后,确定估价函数值最低的子方格,将该子方格作为所述父方格的下一到达位置。
S305:判断所述子方格是否为目标终点所在的方格,若否,则将该子方格作为父方格,并重复执行步骤S302至S305。
判断下一到达位置是否为目标终点,即确定该子方格是否为目标终点的方格,如果是,则生成全局规划路径。如果否,则将该子方格作为父方格,并重复执行步骤S302至S305,直到下一到达位置为目标终点为止。
本实施例通过启发式搜索算法来确定全局规划路径,能够获得至目标终点最短的全局规划路径。
在一个实施例中,上述步骤S104中,根据所述定位信息获取与所述搬运机器人的位置坐标关联的栅格地图的步骤,可以包括:
S401:获取激光传感器扫描的周围环境信息;
获取由激光传感器扫描的搬运机器人所在位置的周边环境信息。
S402:利用预设窗函数将所述周围环境信息进行滤波,并利用预设特征提取公式提取滤波后的周围环境信息的特征值;
利用预设的窗函数将所述周边环境信息进行滤波,获得纯净的周围环境信息。并对滤波后的周围环境信息利用预设特征提取公式提取滤波后的周边环境信息的特征值。
S403:将所述特征值进行直线拟合,生成拟合曲线;
通过系统预设的拟合算法,将所述特征值进行直线拟合生成拟合曲线。
S404:依据所述拟合曲线扫描获得与所述拟合曲线匹配几何地图,并将所述几何地图栅格化,获得该栅格地图。
然后依据所述拟合曲线,从几何地图中扫描获得与该拟合曲线相匹配的几何地图。最后将所述几何地图栅格化,以获得栅格地图。
一种激光制导地图构建的搬运机器人导航装置,包括:
第一获取模块201,用于获取作业区域的拓扑地图、几何地图以及搬运机器人的目标终点;
第二获取模块202,用于获取由激光测距仪和里程计测量的搬运机器人的定位信息,其中所述定位信息包括搬运机器人的位置坐标和自定位位姿;
路径规划模块203,用于依据所述定位信息和所述拓扑地图生成全局规划路径;
控制模块204,用于根据所述定位信息获取与所述搬运机器人的位置坐标关联的栅格地图,并依据所述全局规划路径生成用于指示搬运机器人运动的指令。
本实施例各模块的运行方式与方法中的相同,此处不再赘述。
本发明首先通过路径规划模块203利用拓扑地图或几何地图生成全局规划路径,并在搬运机器人运动的过程中,第二获取模块202通过激光测距仪和里程计获取搬运机器人的定位信息,然后控制模块204根据所述定位信息搜寻对应的栅格地图。最后控制模块204结合栅格地图和全局规划路径,生成用于指示搬运机器人运动的指令。本发明只需通过激光测距仪和里程计获取搬运机器人的定位信息即可实现对搬运机器人的实时导航,无需再搬运机器人的作业区域加装其他任何的导航引导材料或结构,在保证搬运机器人导航精度的情况下节约了搬运机器人的导航成本。一方面,避免了对搬运机器人作业区域的环境破坏,另一方面大大加强了搬运机器人的应用范围。
在一个实施例中,所述第二获取模块202,可以包括:
接收模块,用于接收激光传感器扫描的周围环境信息;
第一拟合模块,用于利用预设窗函数将所述周围环境信息进行滤波,并将滤波后的周围环境信息进行直线拟合,生成拟合数据;
特征匹配模块,用于将所述拟合数据与预选的几何地图进行特征匹配,判断所述拟合数据与预先的几何地图是否匹配。
位姿计算模块,用于在匹配且对所述拟合数据与预选的几何地图的匹配度进行门限过滤成功时,通过预设位姿公式计算自定位位姿。
位姿估算模块,用于在不匹配或过滤失败时,通过里程计估算自定位位姿。
本实施例各模块的运行方式与方法中的相同,此处不再赘述。
在一个实施例中,所述路径规划模块203,可以包括:
网格化模块,用于将所述拓扑地图划分成复数个网格;
搜寻模块,用于将搬运机器人的位置坐标所在的方格作为父方格,搜寻该父方格可到达的子方格;
估价函数值计算模块,用于计算每一子方格的估价函数值,其中所述估价函数值等于搬运机器人的初始坐标至该子方格的实际代价加上该子方格至目标方格的估计代价;
判定模块,用于在某一子方格的估价函数值最低时,将该子方格判定为所述父方格的下一到达位置;
调用模块,用于判断所述子方格是否为目标终点所在的方格,若否时,将该子方格作为父方格,并调用搜寻模块、估价函数值计算模块和判定模块。
本实施例各模块的运行方式与方法中的相同,此处不再赘述。
在一个实施例中,所述控制模块204,包括:
第三获取模块,用于获取激光传感器扫描的周围环境信息;
特征提取模块,用于利用预设窗函数将所述周围环境信息进行滤波,并利用预设特征提取公式提取滤波后的周围环境信息的特征值;
拟合模块,用于将所述特征值进行直线拟合,生成拟合曲线;
扫描模块,用于扫描栅格地图中是否包括所述拟合曲线,若包括则获取该栅格地图。
本实施例各模块的运行方式与方法中的相同,此处不再赘述。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。