栅格地图的更新方法、共享方法及电子设备与流程
本公开涉及机器人导航,具体地,涉及一种栅格地图的更新方法、共享方法及电子设备。
背景技术:
1、四足机器狗具有地形适应能力强、运动姿态灵活、可进入轮式机器人难以通过区域等特点,广泛应用于巡检、安防、测绘、救援和复杂环境自主移动等场景。机器狗在上述场景中通行,需要依赖实时栅格地图表达环境中的障碍物进行路径规划。
2、现有的实时栅格地图通常需要激光雷达、深度相机等视觉感知设备采集点云数据,对点云数据进行坐标变换、射线投射、障碍判断、概率更新和滤波处理,确定环境中的障碍物,进而在实时栅格地图中更新障碍物。当环境中存在玻璃、反光、低矮障碍等情况,或者出现稀疏点云、语义误检或传感器视野受限等情况时,无法准确识别障碍,进而影响机器狗的路线规划。
技术实现思路
1、为解决上述技术问题,本公开提供一种栅格地图的更新方法、共享方法及电子设备。
2、第一方面,本公开提供一种栅格地图的更新方法,应用于机器人,所述更新方法包括:
3、根据所述机器人的位姿数据和预设外形参数,沿所述机器人的运动方向确定可通行区域;
4、根据所述可通行区域和预设地图参数更新本地栅格地图,所述本地栅格地图中所述可通行区域对应的栅格标记为空闲状态,除所述可通行区域对应的栅格以外的栅格标记为未知状态。
5、可选地,根据所述机器人的位姿数据和预设外形参数,沿所述机器人的运动方向确定可通行区域,包括:
6、响应于所述机器人的位姿发生变化,根据变化前后的两个位姿和所述预设外形参数,确定轨迹段对应的所述可通行区域,所述轨迹段由变化前后的两个位姿确定。
7、可选地,所述更新方法还包括:
8、周期性地采集所述机器人的实时位姿;
9、确定所述实时位姿与基准位姿之间的变化幅度;
10、响应于所述变化幅度大于预设幅度阈值,确定所述机器人的位姿发生变化。
11、可选地,在确定所述机器人的位姿发生变化之后,还包括:
12、将最新采集的所述实时位姿作为新的历史位姿加入所述机器人的轨迹队列;
13、确定所述实时位姿与基准位姿之间的变化幅度,包括:
14、将最晚加入所述轨迹队列的所述历史位姿作为所述基准位姿,与最新采集的所述实时位姿进行比较,确定所述变化幅度。
15、可选地,根据所述机器人的位姿数据和预设外形参数,沿所述机器人的运动方向确定可通行区域,包括:
16、响应于所述机器人的slam系统检测到回环,对所述机器人的轨迹队列进行优化,所述轨迹队列包括多个历史位姿;
17、响应于所述轨迹队列被优化,根据优化后的所述轨迹队列和所述预设外形参数,确定轨迹段对应的所述可通行区域,所述轨迹队列中每两个相邻的所述历史位姿确定一个对应的所述轨迹段;
18、根据所述可通行区域和预设地图参数更新本地栅格地图,包括:
19、根据所述可通行区域和预设地图参数生成新的本地栅格地图。
20、可选地,确定轨迹段对应的所述可通行区域,包括:
21、确定所述轨迹段的轨迹段长度和轨迹段方向;
22、若所述轨迹段长度小于预设长度阈值,根据所述轨迹段对应的两个位姿中采集时间在后的位姿和所述预设外形参数,确定所述可通行区域;
23、若所述轨迹段长度大于或等于所述预设长度阈值,根据所述轨迹段对应的两个位姿、所述预设外形参数、所述轨迹段长度和所述轨迹段方向,确定所述可通行区域。
24、可选地,所述轨迹段对应的两个位姿中采集时间在后的为第一位姿,采集时间在前的为第二位姿;
25、确定所述轨迹段的轨迹段长度和轨迹段方向,包括:
26、根据所述第一位姿确定所述轨迹段的终点位置,根据所述第二位姿确定所述轨迹段的起点位置;
27、根据所述终点位置与所述起点位置之间的距离,确定所述轨迹段长度,根据所述终点位置与所述起点位置之间的相对位置关系,确定所述轨迹段方向。
28、可选地,根据所述轨迹段对应的两个位姿中采集时间在后的位姿和所述预设外形参数,确定所述可通行区域,包括:
29、根据所述预设外形参数确定所述可通行区域的区域范围;
30、根据所述第一位姿确定所述机器人在所述终点位置的第一航向角;
31、以所述终点位置为原点,沿所述第一航向角的方向,根据所述区域范围确定所述可通行区域;
32、和/或,
33、根据所述轨迹段对应的两个位姿中采集时间在后的位姿和所述预设外形参数,确定所述可通行区域,包括:
34、根据所述预设外形参数和所述轨迹段长度,确定所述可通行区域的区域范围;
35、以所述起点位置为原点,沿所述轨迹段方向,根据所述区域范围确定所述可通行区域。
36、可选地,根据所述可通行区域和预设地图参数更新本地栅格地图,包括:
37、若所述可通行区域未超过所述本地栅格地图的边界,在所述本地栅格地图中将所述可通行区域对应的栅格标记为空闲状态;
38、若所述可通行区域超过所述本地栅格地图的边界,根据所述可通行区域对所述本地栅格地图进行扩展,并在扩展后的所述本地栅格地图中将所述可通行区域对应的栅格标记为空闲状态。
39、可选地,在根据所述可通行区域和预设地图参数更新本地栅格地图之后,还包括:
40、将更新后的本地栅格地图和对应的参考信息上传至云服务器,并将所述机器人的全局定位信息或启动基准信息上传至所述云服务器;
41、所述更新方法还包括:
42、接收所述云服务器发送的全局栅格地图,将所述全局栅格地图作为新的本地栅格地图,所述全局栅格地图由所述机器人与其他机器人上传的所述本地栅格地图融合得到。
43、第二方面,本公开提供一种栅格地图的共享方法,应用于云服务器,其特征在于,所述共享方法包括:
44、接收目标编队中一个或多个机器人上传的本地栅格地图和对应的参考信息,以及接收所述机器人的全局定位信息或启动基准信息,所述本地栅格地图中可通行区域对应的栅格标记为空闲状态,除所述可通行区域对应的栅格以外的栅格标记为未知状态;
45、若不存在全局栅格地图,根据所述全局定位信息或所述启动基准信息,结合预设地图参数将多个本地栅格地图进行拼接,以将多个所述可通行区域进行融合,得到所述全局栅格地图;
46、若已存在所述全局栅格地图,根据所述全局定位信息或所述启动基准信息,结合所述预设地图参数将所述本地栅格地图与所述全局栅格地图中的可通行区域进行融合,以对所述全局栅格地图进行更新;
47、将所述全局栅格地图发送至所述目标编队中的每个所述机器人。
48、第三方面,本公开提供一种电子设备,包括:存储器,其上存储有计算机程序;处理器,用于执行所述存储器中的所述计算机程序,以实现第一方面或第二方面所述方法的步骤。
49、通过上述技术方案,本公开无需依赖点云障碍检测结果,仅根据机器人的位姿数据和预设外形参数,即可确定机器人的可通行区域,直接在本地栅格地图中将可通行区域对应的栅格标记为空闲状态,能够提高弱感知场景下的地图稳定性,并保留更加符合机器人外形的运动安全余量,结合地图共享机制获取融合多个机器人的本地栅格地图的全局栅格地图,便于机器人直接基于本地栅格地图中的可通行区域进行路径规划,提高机器人的路径规划效率。
50、本公开的其他特征和优点将在随后的具体实施方式部分予以详细说明。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com