机器人导航路径的确定方法及电子设备与流程
本技术涉及机器人导航路径规划,具体而言,涉及一种机器人导航路径的确定方法及电子设备。
背景技术:
1、移动机器人,例如巡检机器人、配送机器人,经常会接收外部下发的导航路径开展作业,这类外部导航路径可以是gps航迹、云端下发规划路线或者人工录制的示教轨迹,定义了机器人需要遵循的任务行驶路线。
2、现有路径跟踪方式一类是直接跟踪该外部导航路径,依靠控制器减小位置与航向偏差,虽能保留任务语义,但无法校验参考路径自身的通行安全性,受gps漂移、地图配准误差、临时障碍物影响,机器人存在贴边、碰撞风险;另一类在检测到障碍后直接触发路径重规划,虽可实现避障,但容易大幅偏离原始路径,破坏任务路线意图。
3、因此,现有技术难以同时兼顾原始路径语义和行驶安全性,无法很好适配复杂的实际作业环境。
技术实现思路
1、本技术针对上述现有技术中的不足,提供一种机器人导航路径的确定方法及电子设备,以便解决现有技术中存在的问题。
2、本技术实施例采用的技术方案如下:
3、第一方面,本技术实施例提供了一种机器人导航路径的确定方法,包括:
4、获取外部导航路径、目标机器人的当前位姿和代价地图;
5、根据所述外部导航路径和所述目标机器人的当前位姿,确定所述目标机器人在预设前视距离的局部外部路径;
6、以所述局部外部路径为中心,生成多个候选路径;多个所述候选路径分别对应相对所述局部外部路径的多个横向偏移量;
7、根据所述代价地图以及多个所述候选路径,对所述局部外部路径进行纠偏,生成所述局部外部路径对应的纠偏后路径;
8、控制所述目标机器人从当前位置接入所述纠偏后路径。
9、在一实施例中,所述根据所述外部导航路径和所述目标机器人的当前位姿,确定所述目标机器人在预设前视距离的局部外部路径,包括:
10、对所述外部导航路径进行距离阈值去噪和折返路径过滤,得到清洗后的导航路径;
11、根据所述目标机器人的当前位姿和所述清洗后的导航路径,确定所述局部外部路径的起点位置;
12、根据所述局部外部路径的起点位置,在所述清洗后的导航路径中截取所述预设前视距离的路径,作为所述局部外部路径。
13、在一实施例中,所述以所述局部外部路径为中心,生成多个候选路径之前,所述方法还包括:
14、根据所述代价地图,获取障碍物密度;
15、根据路径预设通行宽度、所述目标机器人的外轮廓宽度、所述障碍物密度、所述局部外部路径的路径曲率、所述目标机器人的预设行驶速度,确定最大横向偏移量。
16、在一实施例中,所述根据所述代价地图以及多个所述候选路径,对所述局部外部路径进行纠偏,生成所述局部外部路径对应的纠偏后路径,包括:
17、根据所述代价地图,对各所述候选路径进行代价评估,得到各所述候选路径的代价评估参数;
18、根据各所述候选路径的代价评估参数,从多个所述候选路径中确定有效候选路径;
19、根据所述有效候选路径的横向偏移量,确定目标偏移量;
20、根据所述目标偏移量,对所述局部外部路径进行纠偏,生成所述纠偏后路径。
21、在一实施例中,所述代价地图包括:静态地图层、障碍物层、禁行区域层;
22、所述根据所述代价地图,对各所述候选路径进行代价评估,得到各所述候选路径的代价评估参数,包括:
23、根据所述静态地图层,对各所述候选路径进行静态地图代价评估,得到各所述候选路径的静态地图代价评估参数;
24、根据所述障碍物层,对各所述候选路径进行障碍物代价评估,得到各所述候选路径的障碍物代价评估参数;
25、根据所述禁行区域层,对各所述候选路径进行禁行区域代价评估,得到各所述候选路径的禁行区域代价评估参数;
26、根据所述静态地图代价评估参数、所述障碍物代价评估参数和所述禁行区域代价评估参数,得到各所述候选路径的代价评估参数。
27、在一实施例中,所述根据所述有效候选路径的横向偏移量,确定目标偏移量,包括:
28、若所述有效候选路径的数量为1,则确定所述有效候选路径的横向偏移量为所述目标偏移量;
29、若所述有效候选路径的数量为多个,则根据多个所述有效候选路径的横向偏移量,计算所述目标偏移量。
30、在一实施例中,所述方法还包括:
31、获取所述局部外部路径的路径曲率趋势;
32、根据所述路径曲率趋势,对多个所述候选路径进行路径剔除,得到剔除后候选路径;
33、所述根据所述代价地图,对各所述候选路径进行代价评估,得到各所述候选路径的代价评估参数,包括:
34、根据所述代价地图,对所述剔除后候选路径进行代价评估,得到所述剔除后候选路径的代价评估参数。
35、在一实施例中,所述根据所述目标偏移量,对所述局部外部路径进行纠偏,生成所述纠偏后路径,包括:
36、根据所述目标偏移量、当前时间步的上一时间步的历史偏移状态以及所述上一时间步的路径连续性,对所述局部外部路径进行纠偏,生成所述纠偏后路径。
37、在一实施例中,所述控制所述目标机器人从当前位置接入所述纠偏后路径之前,所述方法还包括:
38、在所述纠偏后路径上确定融合锚点;
39、根据所述目标机器人的当前位置、所述融合锚点的目标位置、所述目标机器人的当前航向对应的第一切向量、所述融合锚点在所述纠偏后路径上的第二切向量,生成所述当前位置至所述目标位置的连续过渡曲线;
40、将所述连续过渡曲线的末端与所述纠偏后路径上的融合锚点拼接,得到目标控制路径;
41、所述控制所述目标机器人从当前位置接入所述纠偏后路径,包括:
42、根据所述目标控制路径,控制所述目标机器人从当前位置接入所述纠偏后路径。
43、第二方面,本技术实施例提供了一种电子设备,包括:处理器、存储介质和总线,所述存储介质存储有所述处理器可执行的程序指令,当电子设备运行时,所述处理器与所述存储介质之间通过总线通信,所述处理器执行所述程序指令,以实现上述任一实施例所述的机器人导航路径的确定方法。
44、本技术的有益效果是:提供了一种机器人导航路径的确定方法,通过获取外部导航路径、机器人当前位姿以及代价地图,截取机器人前视距离范围内的局部外部路径并以此为中心生成多条横向偏移量对应的候选路径,结合代价地图对候选路径开展代价评估筛选得到有效候选路径,完成对局部外部路径的纠偏生成纠偏后路径,再控制机器人从当前位置接入纠偏后路径。
45、该方法不在出现障碍时直接放弃原始外部导航路径进行完全重规划,而是在原始外部导航路径附近做局部安全偏移调整,尽可能保留外部导航路径承载的任务语义,同时依托代价地图评估,保障路径通行安全性,解决了现有技术难以同时兼顾原始路径语义和行驶安全性、难以适配复杂实际作业环境的问题。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com