一种机器人无图定位导航方法、控制设备及存储介质与流程
本技术涉及机器人,具体而言,涉及一种机器人无图定位导航方法、控制设备及存储介质。
背景技术:
1、随着机器人技术的不断发展,室外移动机器人在园区配送、无人清扫、安防巡检等场景中得到了广泛应用。此类机器人通常需要按照指定路线自主行走,并具备绕过临时障碍物的能力,以完成运输、清扫或巡逻等作业任务。
2、现有室外机器人导航通常基于预先构建的地图进行定位导航方案,机器人先通过slam技术构建点云地图或栅格地图,运行时将实时感知数据与预建地图进行匹配以实现定位和导航。
3、上述导航方式需要提前建图,对于没有预先建图的场景,机器人无法执行导航任务。
技术实现思路
1、本技术的目的在于,针对上述现有技术中的不足,提供一种机器人无图定位导航方法、控制设备及存储介质,以使得机器人即使在无图场景下,也可以正常进行导航。
2、为实现上述目的,本技术实施例采用的技术方案如下:
3、第一方面,本技术一实施例提供了一种机器人无图定位导航方法,所述方法包括:
4、获取机器人的里程计帧和全球导航卫星系统gps定位数据;
5、将所述里程计帧存入滑动窗口中;
6、将所述gps定位数据与所述里程计帧进行时间匹配,并将匹配成功的gps定位数据绑定至对应的里程计帧,得到gps约束帧;
7、当所述滑动窗口中gps约束帧的数量达到预设阈值时,基于所述滑动窗口中的各里程计帧和各gps约束帧进行图优化,将各里程计帧的位姿对齐到gps坐标系下,得到各所述里程计帧在所述gps坐标系下的位姿;
8、基于各所述里程计帧在所述gps坐标系下的位姿,确定里程计坐标系与所述gps坐标系之间的转换关系;
9、接收第三方地图服务下发的目标全局路径,基于所述转换关系将所述目标全局路径转换到所述里程计坐标系下,得到局部导航路径。
10、在一些实施例中,所述将所述gps定位数据与所述里程计帧进行时间匹配,并将匹配成功的gps定位数据绑定至对应的里程计帧,得到gps约束帧,包括:
11、判断所述gps定位数据的时间戳是否位于所述滑动窗口的预设时间范围之内;
12、若是,则在所述滑动窗口中查找与所述gps定位数据的时间差最小的目标里程计帧;
13、当所述目标里程计帧与所述gps定位数据的时间差小于预设时间差阈值时,将所述gps定位数据绑定至所述目标里程计帧,得到所述gps约束帧。
14、在一些实施例中,所述将所述gps定位数据与所述里程计帧进行时间匹配,并将匹配成功的gps定位数据绑定至对应的里程计帧,得到gps约束帧,包括:
15、将所述gps定位数据转换到东北天enu坐标系下,得到第一位置坐标;
16、获取上一次绑定的gps定位数据在所述enu坐标系下的第二位置坐标;
17、计算所述第一位置坐标与所述第二位置坐标之间的距离;
18、在所述距离大于所述预设距离阈值时,将所述gps定位数据绑定至对应的里程计帧。
19、在一些实施例中,所述基于所述滑动窗口中的各里程计帧和各gps约束帧进行图优化,将各里程计帧的位姿对齐到所述全球导航卫星系统坐标系下的位姿,得到各所述里程计帧在所述gps坐标系下的位姿,包括:
20、将所述滑动窗口中的每个里程计帧作为一个位姿节点;
21、根据各里程计帧在里程计坐标系下的坐标,在相邻位姿节点之间加入里程计相对约束;
22、根据各gps约束帧在所述gps坐标系下的坐标,在各gps约束帧所对应的位姿节点处加入gps位置约束;
23、调整各位姿节点的位姿,使各里程计帧在所述gps坐标系下的位姿与各gps约束帧的gps坐标之间的差异最小化,且各里程计帧之间的相对运动与各里程计帧的里程计坐标之间的差异最小化,得到各所述里程计帧在所述gps坐标系下的位姿。
24、在一些实施例中,所述基于所述转换关系将所述全局路径转换到所述里程计坐标系下,得到局部导航路径,包括:
25、以所述滑动窗口中最新完成图优化的里程计帧为锚点,基于所述锚点在所述里程计坐标系下的位姿和在所述gps坐标系下的位姿,将所述全局路径中的各路径点转换到所述里程计坐标系下,得到所述局部导航路径。
26、在一些实施例中,所述将所述里程计帧存入滑动窗口中之前,所述方法包括:
27、确定所述滑动窗口中所包括的帧数据的数量是否超过预设阈值;
28、若超过,则对所述滑动窗口中的部分帧数据进行删除。
29、在一些实施例中,所述对所述滑动窗口中的部分帧数据进行删除,包括:
30、确定所述滑动窗口中不是关键帧,且不是gps约束帧的里程计帧为待删除帧数据;
31、在所述滑动窗口中删除所述待删除帧数据。
32、在一些实施例中,所述接收第三方地图服务下发的目标全局路径之前,所述方法还包括:
33、接收所述第三方地图服务下发的初始全局路径;
34、获取机器人当前gps位置;
35、基于所述当前gps位置和所述初始全局路径中的第一个点,计算偏移量;
36、基于所述偏移量对所述初始全局路径中的每个路径点进行偏移,得到偏移后的各路径点;
37、将所述偏移后的各路径点的坐标转换到enu坐标系中,得到所述目标全局路径。
38、第二方面,本技术另一实施例提供了一种机器人无图定位导航装置,所述装置包括:获取模块、匹配模块、优化模块、确定模块和转换模块,其中:
39、所述获取模块,用于获取机器人的里程计帧和全球导航卫星系统gps定位数据;将所述里程计帧存入滑动窗口中;
40、所述匹配模块,用于将所述gps定位数据与所述里程计帧进行时间匹配,并将匹配成功的gps定位数据绑定至对应的里程计帧,得到gps约束帧;
41、所述优化模块,用于当所述滑动窗口中gps约束帧的数量达到预设阈值时,基于所述滑动窗口中的各里程计帧和各gps约束帧进行图优化,将各里程计帧的位姿对齐到gps坐标系下,得到各所述里程计帧在所述gps坐标系下的位姿;
42、所述确定模块,用于基于各所述里程计帧在所述gps坐标系下的位姿,确定里程计坐标系与所述gps坐标系之间的转换关系;所述转换模块,用于接收第三方地图服务下发的目标全局路径,基于所述转换关系将所述目标全局路径转换到所述里程计坐标系下,得到局部导航路径。
43、在一些实施例中,所述匹配模块,具体用于判断所述gps定位数据的时间戳是否位于所述滑动窗口的预设时间范围之内;若是,则在所述滑动窗口中查找与所述gps定位数据的时间差最小的目标里程计帧;当所述目标里程计帧与所述gps定位数据的时间差小于预设时间差阈值时,将所述gps定位数据绑定至所述目标里程计帧,得到所述gps约束帧。
44、在一些实施例中,所述匹配模块,具体用于将所述gps定位数据转换到东北天enu坐标系下,得到第一位置坐标;获取上一次绑定的gps定位数据在所述enu坐标系下的第二位置坐标;计算所述第一位置坐标与所述第二位置坐标之间的距离;在所述距离大于所述预设距离阈值时,将所述gps定位数据绑定至对应的里程计帧。
45、在一些实施例中,所述优化模块,具体用于将所述滑动窗口中的每个里程计帧作为一个位姿节点;根据各里程计帧在里程计坐标系下的坐标,在相邻位姿节点之间加入里程计相对约束;根据各gps约束帧在所述gps坐标系下的坐标,在各gps约束帧所对应的位姿节点处加入gps位置约束;调整各位姿节点的位姿,使各里程计帧在所述gps坐标系下的位姿与各gps约束帧的gps坐标之间的差异最小化,且各里程计帧之间的相对运动与各里程计帧的里程计坐标之间的差异最小化,得到各所述里程计帧在所述gps坐标系下的位姿。
46、在一些实施例中,所述转换模块,具体用于以所述滑动窗口中最新完成图优化的里程计帧为锚点,基于所述锚点在所述里程计坐标系下的位姿和在所述gps坐标系下的位姿,将所述全局路径中的各路径点转换到所述里程计坐标系下,得到所述局部导航路径。
47、在一些实施例中,所述确定模块,具体用于确定所述滑动窗口中所包括的帧数据的数量是否超过预设阈值;若超过,则对所述滑动窗口中的部分帧数据进行删除。
48、在一些实施例中,所述确定模块,具体用于确定所述滑动窗口中不是关键帧,且不是gps约束帧的里程计帧为待删除帧数据;在所述滑动窗口中删除所述待删除帧数据。
49、在一些实施例中,所述确定模块,具体用于接收所述第三方地图服务下发的初始全局路径;获取机器人当前gps位置;基于所述当前gps位置和所述初始全局路径中的第一个点,计算偏移量;基于所述偏移量对所述初始全局路径中的每个路径点进行偏移,得到偏移后的各路径点;将所述偏移后的各路径点的坐标转换到enu坐标系中,得到所述目标全局路径。
50、第三方面,本技术另一实施例提供了一种控制设备,包括:处理器、存储器和总线,所述存储器存储有所述处理器可执行的机器可读指令,当控制设备运行时,所述处理器与所述存储器之间通过总线通信,所述处理器执行所述机器可读指令,以执行如上述第一方面任一所述方法的步骤。
51、第四方面,本技术另一实施例提供了一种计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器运行时执行如上述第一方面任一所述方法的步骤。
52、本技术的有益效果是:通过滑动窗口同步接收里程计帧和gps定位数据,将时间匹配成功的gps数据绑定至对应里程计帧形成gps约束帧,当滑动窗口中gps约束帧数量达到预设阈值时触发图优化。基于gps位置约束将滑动窗口内各里程计帧的位姿整体对齐到gps坐标系下,从而动态建立并持续更新里程计坐标系与gps坐标系之间的转换关系。基于该转换关系,将第三方地图服务下发的目标全局路径从gps坐标系实时转换到里程计坐标系下,得到局部导航路径,机器人可以直接使用局部导航路径进行导航和移动。采用本技术提供的方法,无需预先构建环境地图,解决了第三方路径坐标与机器人控制坐标系不一致的问题,实现了机器人开机即用、坐标自动对齐的无图导航能力,同时通过滑动窗口的设置对计算量进行控制,保证系统实时性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com