System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技术实现步骤摘要】
本公开涉及自行走设备,特别涉及一种自行走设备的控制方法、装置、设备及可读存储介质。
技术介绍
1、随着科学技术的不断发展,自行走设备(例如扫地机器人、拖地机器人、机械狗、人形机器人等)的智能度也越来越高,有些自行走设备能够实现对当前环境的自动建图,并在移动过程中基于构建的地图实现路径规划和障碍物的规避。由于自行走设备所在的环境的复杂性,自行走设备有可能在进入某些空间后难以离开,导致自行走设备的当前任务无法继续,或者大大延长了任务的完成时间。
技术实现思路
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、在一些实施方式中,所述对所述障碍物高度地图进行区域搜索,包括:
29、按照预设的区域搜索优先级对所述障碍物高度地图进行区域搜索,其中,在所述预设的区域搜索优先级中,非低矮区域、可行低矮区域、不可行低矮区域、未知区域的搜索优先级依次降低。
30、在一些实施方式中,所述区域类型为未被目标悬空障碍物包围的区域类型,所述目标悬空障碍物的悬空高度大于所述自行走设备的机身高度且小于或等于第一高度;
31、所述获取所述自行走设备移动的目标位置,包括:
32、从所述障碍物高度地图中搜索出未知区域,其中,所述未知区域内的障碍物处于未知状态;
33、从所述未知区域中确定出所述目标位置。
34、在一些实施方式中,所述基于所述目标悬空障碍物的位置以及所述自行走设备的当前位置,确定所述区域类型,包括:
35、基于所述目标悬空障碍物的位置以及所述自行走设备的当前位置,确定所述自行走设备是否位于所述目标悬空障碍物构成的目标环形区域内,其中,位于所述目标环形区域上的目标悬空障碍物之间的间隙小于所述自行走设备的通行宽度;
36、若所述自行走设备位于所述目标环形区域内,确定所述区域类型为被所述目标悬空障碍物包围的区域类型。
37、在一些实施方式中,所述确定所述区域类型,还包括:
38、若所述自行走设备周围不存在所述目标悬空障碍物,或者所述自行走设备未位于所述目标环形区域内,确定所述区域类型为未被所述目标悬空障碍物包围的区域类型。
39、在一些实施方式中,所述确定所述自行走设备的行走策略,包括:
40、若所述区域类型为被所述目标悬空障碍物包围的区域类型,确定所述自行走设备的前行区域内是否包含不可行区域,所述不可行区域中的低矮障碍物的高度小于或等于所述自行走设备的机身高度;
41、基于所述不可行区域中所述低矮障碍物的位置以及所述目标位置,确定所述行走策略,其中,所述行走策略为避开所述低矮障碍物的路线。
42、在一些实施方式中,所述确定所述自行走设备的行走策略,包括:
43、若所述区域类型为未被所述目标悬空障碍物包围的区域类型,确定所述自行走设备的前行区域内是否包含不可行区域和/或不可行低矮区域,所述不可行区域中的低矮障碍物的高度小于或等于所述自行走设备的机身高度,所述不可行低矮区域中的障碍物为所述目标悬空障碍物;
44、基于所述不可行区域中所述低矮障碍物的位置、所述不可行低矮区域中所述目标悬空障碍物的位置以及所述目标位置,确定所述行走策略,其中,所述行走策略为避开所述低矮障碍物以及所述目标悬空障碍物的路线。
45、在一些实施方式中,所述确定所述自行走设备的行走策略之后,所述方法还包括:
...
【技术保护点】
1.一种自行走设备的控制方法,其特征在于,所述方法包括:
2.如权利要求1所述的方法,其特征在于,所述获取自行走设备当前探测区域内障碍物的区域类型,包括:
3.如权利要求2所述的方法,其特征在于,所述确定障碍物高度地图,包括:
4.如权利要求2所述的方法,其特征在于,所述基于所述障碍物高度地图,确定所述区域类型,包括:
5.如权利要求4所述的方法,其特征在于,所述区域类型为被目标悬空障碍物包围的区域类型,所述目标悬空障碍物的悬空高度大于所述自行走设备的机身高度且小于或等于第一高度;所述获取所述自行走设备移动的目标位置,包括:
6.如权利要求5所述的方法,其特征在于,所述对所述障碍物高度地图进行区域搜索,并从搜索到的目标区域中确定出所述目标位置,包括:
7.如权利要求5所述的方法,其特征在于,所述对所述障碍物高度地图进行区域搜索,并从搜索到的目标区域中确定出所述目标位置,包括:
8.一种自行走设备的控制装置,其特征在于,所述装置包括:
9.一种自行走设备,其特征在于,包括:存储器、处理器
10.一种计算机可读存储介质,其特征在于,其上存储有计算机程序,该程序被处理器执行时实现权利要求1-7任一项所述方法的步骤。
...【技术特征摘要】
1.一种自行走设备的控制方法,其特征在于,所述方法包括:
2.如权利要求1所述的方法,其特征在于,所述获取自行走设备当前探测区域内障碍物的区域类型,包括:
3.如权利要求2所述的方法,其特征在于,所述确定障碍物高度地图,包括:
4.如权利要求2所述的方法,其特征在于,所述基于所述障碍物高度地图,确定所述区域类型,包括:
5.如权利要求4所述的方法,其特征在于,所述区域类型为被目标悬空障碍物包围的区域类型,所述目标悬空障碍物的悬空高度大于所述自行走设备的机身高度且小于或等于第一高度;所述获取所述自行走设备移动的目标位置,包括:
6.如权利要求5所述的方法,其特...
【专利技术属性】
技术研发人员:屠克非,朱海,张磊,
申请(专利权)人:北京石头创新科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。