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.可选的,在本发明第一方面的第七种实现方式中,所述根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径,包括:
46.根据所述最大总覆盖面积确定所述最后一条单向行走路径和倒数第二条单向行走路径之间的面积关系;
47.基于所述面积关系确定所述最后一条单向行走路径和倒数第二条单向行走路径的第一连接关系;
48.基于所述第一连接关系确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
49.通过该方案的实施,采用相邻两条路径的覆盖面积的约束关系计算出两相邻的路
径总覆盖面积的最优值,进一步保证了路径的最优,提高路径规划的准确定。
50.本发明第二方面提供了一种机器人施工方法,所述机器人施工方法包括:
51.获取待施工区域的地图信息,并在所述地图信息中标记出机器人可行走的移动区域;
52.基于所述机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对所述移动区域进行路径规划,得到所述机器人的单向行走路径集;
53.根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;
54.根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径;
55.基于所述施工路径控制所述机器人移动对所述待施工区域进行施工。
56.通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
57.本发明第三方面提供了一种路径规划装置,所述路径规划装置包括:
58.标记模块,用于获取待施工区域的地图信息,并在所述地图信息中标记出机器人可行走的移动区域;
59.第一路径规划模块,用于基于所述机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对所述移动区域进行路径规划,得到所述机器人的单向行走路径集;
60.计算模块,用于根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;
61.第二路径规划模块,用于根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
62.通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
63.可选的,在本发明第三方面的第一种实现方式中,所述标记模块包括:
64.扫描单元,用于通过机器人上的采集单元对待施工区域进行扫描,得到图像信息;
65.识别单元,用于基于所述图像信息识别其中的障碍物,并确定所述障碍物的位置和大小;
66.构建单元,用于根据所述障碍物的位置和大小,在所述图像信息中进行标记,并基于标记后的图像信息构建地图信息;
67.获取单元,用于获取机器人的尺寸信息,并基于所述尺寸信息确定机器人与障碍物之间的安全距离;
68.标记单元,用于根据所述安全距离和所述障碍物的位置确定机器人的可行走区域范围,并在所述地图信息中标记,得到移动区域。
69.通过该方案的实施,解决了现有的路径规划中,由于障碍物的限制机器人移动,而导致路径规划准确度的问题,保证了规划路径的区域的精准度,为后面路径规划奠定了基础。
70.可选的,在本发明第三方面的第二种实现方式中,所述第一路径规划模块包括:
71.确定单元,用于基于所述机器人上机械臂的伸展长度范围,确定最大伸展长度和最小伸展长度;
72.距离计算单元,用于基于所述安全距离,计算所述地图信息中相邻的两个障碍物之间的相隔距离;
73.第一规划单元,用于根据所述最大伸展长度和最小伸展长度,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,得到所述移动区域内所述机器人的单向行走路径集,其中,两个障碍物之间的所有单向行走路径之间的间隔总和不大于所述相隔距离。
74.通过该方案的实施,由于使用了路径不重叠规划算法,基于所述机器人上机械臂的最大伸展长度和最小伸展长度设置路径的间隔,保证路径的覆盖范围最大化,从而提高了机器人的施工范围和施工效率。
75.可选的,在本发明第三方面的第三种实现方式中,所述第一规划单元具体用于:
76.以所述最小伸展长度为路径间隔,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,其中所述至少一条单向行走路径所覆盖的区域总跨度等于所述相隔距离;
77.基于所述最大伸展长度,对所述至少一条单向行走路径中相邻两条路径的路径间隔以及路径数量进行调整,得到两个障碍区之间的最终的单向行走路径子集;
78.根据所有的单向行走路径子集确定所述移动区域内所述机器人的单向行走路径集。
79.通过该方案的实施,由于使用了路径不重叠规划算法,基于所述机器人上机械臂的最大伸展长度和最小伸展长度设置路径的间隔,进一步优化了覆盖范围最大化的路径规划方案,从而提高了机器人的施工范围和施工效率。
80.可选的,在本发明第三方面的第四种实现方式中,所述第一规划模块还包括哈希创建单元,其具体用于:
81.基于所有所述单向行走路径创建路径哈希表;
82.计算每条单向行走路径纵向的最大坐标和最小坐标;
83.将所述最大坐标和最小坐标与对应的单向行走路径绑定,并存储至所述哈希表中。
84.通过该方案的实施,增加了对可行走移动区域中路径坐标,基于路径坐标来设置每节路径的连接关系,进一步优化了路径的规划,保障路径覆盖范围最大化。
85.可选的,在本发明第三方面的第五种实现方式中,所述计算模块包括:
86.坐标计算单元,用于从所述单向行走路径集中确定最后一条单向行走路径和倒数第二条单向行走路径,并从所述路径哈希表中查询两条单向行走路径的最大坐标和最小坐标;
87.面积计算单元,用于基于两条单向行走路径的最大坐标和最小坐标,利用预设的路径覆盖面积评价函数计算出所述最后一条单向行走路径和倒数第二条单向行走路径的最大总覆盖面积。
88.通过该方案的实施,由于利用了路径覆盖面积评估函数辅助路径规划,以优化每
节路径之间的连接关系的确定,提高了在最大覆盖面积的前提下,计算最优的连接关系,优化路径设置。
89.可选的,在本发明第三方面的第六种实现方式中,所述面积计算单元具体用于:
90.基于两条单向行走路径的最大坐标和最小坐标,计算出两条单向行走路径在所述机器人上机械臂的最大伸展长度下的覆盖面积,并在路径的位置上构建覆盖区域;
91.基于构建的覆盖区域,确定两条路径的重叠覆盖面积和损失覆盖面积;
92.根据所述倒数第二条单向行走路径的覆盖面积,以及两条路径的重叠覆盖面积和损失覆盖面积,计算出所述最后一条单向行走路径在不同位置转弯的最大总覆盖面积;
93.从不同位置转弯的最大总覆盖面积中取最大值作为所述最后一条单向行走路径的最大总覆盖面积;
94.根据所述倒数第二条单向行走路径的覆盖面积,以及两条路径的重叠覆盖面积和损失覆盖面积,计算出所述倒数第二条单向行走路径的实际覆盖面积;
95.基于所述最后一条单向行走路径的最大总覆盖面积和所述倒数第二条单向行走路径的实际覆盖面积,计算所述最后一条单向行走路径和倒数第二条单向行走路径的最大总覆盖面积。
96.通过该方案的实施,采用取最大值的方式计算路径覆盖面积的最大值,从不同角度计算选择最优,进一步保证了路径的最优,提高路径规划的准确定。
97.可选的,在本发明第三方面的第七种实现方式中,所述第二路径规划模块包括:
98.第二关系确定单元,用于根据所述最大总覆盖面积确定所述最后一条单向行走路径和倒数第二条单向行走路径之间的面积关系;
99.第一关系确定单元,用于基于所述面积关系确定所述最后一条单向行走路径和倒数第二条单向行走路径的第一连接关系;
100.路径构建单元,用于基于所述第一连接关系确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
101.通过该方案的实施,采用相邻两条路径的覆盖面积的约束关系计算出两相邻的路径总覆盖面积的最优值,进一步保证了路径的最优,提高路径规划的准确定。
102.本发明第三方面提供了一种机器人,其特征在于,所述机器人包括:如上所述的路径规划装置和驱动装置,其中,
103.所述路径规划装置,用于获取待施工区域的地图信息,并在所述地图信息中标记出机器人可行走的移动区域;基于所述机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对所述移动区域进行路径规划,得到所述机器人的单向行走路径集;根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径;
104.所述驱动装置,用于基于所述施工路径控制所述机器人移动对所述待施工区域进行施工。
105.通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
106.本发明第四方面提供了一种机器人,包括:存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如上任一项所述的路径规划方法的各个步骤,或者执行如上所述的机器人施工方法的各个步骤。
107.通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
108.本发明的第四方面提供了一种计算机可读存储介质,所述计算机可读存储介质中存储有指令,当其在计算机上运行时,使得计算机执行如上任一项所述的路径规划方法的各个步骤,或者执行如上所述的机器人施工方法的各个步骤。
109.通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
110.本发明的技术方案中,基于机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对地图信息中机器人可行走的移动区域进行路径规划,得到机器人的单向行走路径集,根据预设的路径覆盖面积评价函数,计算单向行走路径集中最后两条相邻路径的最大总覆盖面积,根据最大总覆盖面积确定单向行走路径集中所有路径的连接关系,并基于连接关系构建施工路径。利用上述的方式规划路径解决了机器人有效施工区域小,路径覆盖范围小的问题。
附图说明
111.图1为本发明实施例提供的路径规划方法的第一个实施例示意图;
112.图2为本发明实施例提供的路径规划方法的第二个实施例示意图;
113.图3为本发明实施例提供的路径规划方法的第三个实施例示意图;
114.图4为本发明实施例提供的机器人施工方法的一种实施例示意图;
115.图5为本发明实施例提供的待施工区域示意图;
116.图6为本发明实施例提供的待施工区域中移动区域的示意图;
117.图7为本发明实施例提供的路径段之间的间隔设置示意图;
118.图8为本发明实施例提供的施工路径覆盖面积示意图;
119.图9为本发明实施例提供的固定相邻路径间隔的覆盖率示意图;
120.图10为本发明实施例提供的最优动态相邻路径间隔的覆盖率示意图;
121.图11为本发明实施例提供的两路径之间的面积关系示意图;
122.图12为本发明实施例提供的机器人碰撞到障碍物时机械臂的调整示意图;
123.图13为本发明实施例提供的路径规划装置的一个实施例示意图;
124.图14为本发明实施例提供的路径规划装置的另一个实施例示意图;
125.图15为本发明实施例提供的机器人的一个实施例示意图;
126.图16为本发明实施例提供的机器人的另一个实施例示意图。
具体实施方式
127.为了解决上述的问题,本技术提供了一种基于动态规划的全覆盖路径规划算法,
能够很好地满足机器人在建筑工地施工场景下全覆盖遍历路径规划的任务,具体是通过调整机器人上机械臂的伸展长度范围来调整机器人的作业宽度,实现作业宽度的可变设计,同时也基于伸展长度范围来调整路径之间的间隔使得路径能覆盖待施工区域的所有区域,通过这样的可变作业宽度的工艺参数下实现无重叠路径的全覆盖路径规划,解决了解决现有的路径规划难以实现施工覆盖范围最大化的问题。
128.本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外,术语“包括”或“具有”及其任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
129.为便于理解,下面对本发明实施例的具体流程进行描述,请参阅图1,本发明实施例中路径规划方法的第一个实施例包括:
130.101、获取待施工区域的地图信息,并在地图信息中标记出机器人可行走的移动区域;
131.该步骤中,机器人在施工之前,通过初始化设置,以获取到待施工区域的轮廓,即是待施工区域的环境数据,基于环境数据构建出对应的地图,在实际应用中,通过控制机器人上的摄像模块,例如摄像头、扫描仪等,通过摄像模块,并控制机器人移动或者旋转,以拍摄到待施工区域的图像数据或者视频数据,通过对每帧图像数据或者视频数据进行识别,并基于预设的坐标系,计算出识别到的轮廓点的坐标,与轮廓点的坐标绘制出对应的地图。
132.在本实施例中,通过机器人上的采集单元对待施工区域进行扫描,得到图像信息;
133.基于所述图像信息识别其中的障碍物,并确定所述障碍物的位置和大小;
134.根据所述障碍物的位置和大小,在所述图像信息中进行标记,并基于标记后的图像信息构建地图信息;
135.获取机器人的尺寸信息,并基于所述尺寸信息确定机器人与障碍物之间的安全距离;
136.根据所述安全距离和所述障碍物的位置确定机器人的可行走区域范围,并在所述地图信息中标记,得到移动区域。
137.通过该方案的实施,解决了现有的路径规划中,由于障碍物的限制机器人移动,而导致路径规划准确度的问题,保证了规划路径的区域的精准度,为后面路径规划奠定了基础。
138.在绘制出地图后,还包括识别图像或者视频中的障碍物,可选的,这里的障碍物指的是柱子、墙壁等,同时识别出障碍物后,还根据预设的坐标系计算出对应的坐标,基于坐标在绘制的地图中进行障碍物区域的设置,从而得到详细的地图信息。
139.进一步的,由于机器人本身占有一定的面积,为了保证机器人在施工区域的正常移动,需要对地图信息上的障碍物范围进行一定的膨胀,具体的,获取机器人的尺寸信息以及机器人的中心点,基于中心点和尺寸信息计算出机器人与障碍物的安全距离,以障碍物为中心绘制出不可通行区域,从而得到机器人的可行走区域,将该可行走区域标记的机器
人的移动区域。
140.102、基于机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对移动区域进行路径规划,得到机器人的单向行走路径集;
141.本实施例中,机器人在施工时是通过控制机器人上的机械臂进行施工操作,本技术提供的机器人的机械臂的施工宽度是可调整的,具体是通过调整机械臂的伸长与缩短来调整施工的宽度,通过获取机器人的配置参数以得到机械臂的伸展长度范围,即是计算出伸展长度的最大值和最小值,以最大值和最小值作为区间的边界构建出伸展长度范围。
142.基于伸展长度范围,利用路径不重叠规划算法在移动区域范围内规划出机器人的行走路线,这里规划出的行走路线主要是从单向行驶的方向来规划,在规划过程中,在伸展长度范围内选择一个伸展长度,以该伸展长度为路径间隔规划出单向行走路径,在此基础上,在路径覆盖面积不重叠的前提下,调整两相邻的路径间隔,其中调整后的路径间隔不能超过伸展长度范围,从而得到单向行走路径集。
143.103、根据预设的路径覆盖面积评价函数,计算单向行走路径集中最后两条相邻路径的最大总覆盖面积;
144.该步骤中,该路径覆盖面积评价函数为最优值求解函数,该函数的计算对象是两相邻的路径的最大总覆盖面积,即是两相邻的路径存在多种连接关系,通过该函数分别对每种连接关系下的覆盖面积进行计算,得到多个方程式组,对每个方程式组中的计算得到的面积取最大值。
145.在实际应用中,通过随机从单向行走路径集中选择两条相邻的路径进行覆盖面积评价函数,基于评价出来的多种连接关系的覆盖面积,从而得到最大总覆盖面积。
146.104、根据最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于连接关系构建施工路径。
147.该步骤中,基于该最大总覆盖面积确定对应的两条相邻的路径的连接关系,基于该连接关系依次推出其他路径的连接关系,从而基于所有连接关系将单行行走路径集中的路径进行连接,得到施工路径。
148.在实际应用中,以最后两条路径为例说明,该连接关系的确定,在计算最大总覆盖面积时,分别以向上和向下两种情况进行计算,若计算出最后一条路径向上时两条路径的总覆盖面积最大,则确定倒数第二条路径的方向向下,两条路径的连接关系的下端转弯连接,基于次,基于折返规则确定倒数第三、第四直到第一条的折返连接关系,基于该折返连接关系将单行行走路径集中的路径进行连接,得到施工路径。
149.在本实施例中,利用上述的方法,实现了基于机械臂的伸展长度范围作为约束条件,利用路径不重叠规划算法和路径覆盖面积评价函数来规划路径,得到路径段之间的连接关系,从而得到覆盖面积最大的施工路径。这样的方式能够很好地满足机器人在建筑工地施工场景下全覆盖遍历路径规划的任务,同时还利用折返的路径规划方法避免重叠路径,满足在工艺不允许出现重叠路径的场景。
150.请参阅图2,本发明实施例中路径规划方法的第二个实施例包括:
151.201、获取待施工区域的地图信息,并在地图信息中标记出机器人可行走的移动区域;
152.该步骤中,在基于待施工区域的地图信息确定移动区域时,具体是根据机器人与
障碍物之间的安全距离来标记确定,也即是说在地图信息上识别出障碍物后,以障碍物为中心,以安全距离为半径确定机器人能避开障碍物且贴近障碍物的路径,将该路径作为可行走的区域的边界绘制出待施工区域的移动区域。在实际应用中,该安全距离可以为机器人的宽度或者长度的一半。
153.202、基于机器人上机械臂的伸展长度范围,确定最大伸展长度和最小伸展长度;
154.本实施例中,通过读取机器人的工作参数来确定机械臂的伸展长度范围,提取伸展长度范围的边界点,将各边界点作为最大伸展长度和最小伸展长度。当然,也可以通过在初始化机器人是通过控制机械臂的审缩来测量出最大最小的伸展长度,从而得到伸展长度范围,然后用户输出至机器人显示屏中。
155.203、基于安全距离,计算地图信息中相邻的两个障碍物之间的相隔距离;
156.具体的,基于安全距离分别对两个相邻的障碍物所在的位置上构建机器人的靠近障碍物的两条路径,然后基于两个相邻的障碍物的坐标计算出两条路径之间的间隔,从而得到两障碍物之间机器人可行走的相隔距离。
157.当然,也可以是直接根据两个相邻的障碍物的坐标计算出两个障碍物之前的距离,然后基于该距离结合机器人的安全距离来计算出两障碍物之间机器人可行走的相隔距离,具体是基于距离减去两倍的安全距离。
158.204、根据最大伸展长度和最小伸展长度,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,得到移动区域内所述机器人的单向行走路径集;
159.该步骤中,两个障碍物之间的所有单向行走路径之间的间隔总和不大于所述相隔距离。
160.在本实施例中,随机选择一个路径间距值来设置单向行走路径,该路径间距值不大于最大伸展长度且不小于最小伸展长度。
161.然后,基于路径不重叠规划算法,调整设置的单向行走路径的覆盖范围不重叠,从而得到最终的单向行走路径集。
162.在本实施例中,还可以是以所述最小伸展长度为路径间隔,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,其中所述至少一条单向行走路径所覆盖的区域总跨度等于所述相隔距离;
163.基于所述最大伸展长度,对所述至少一条单向行走路径中相邻两条路径的路径间隔以及路径数量进行调整,得到两个障碍区之间的最终的单向行走路径子集;
164.根据所有的单向行走路径子集确定所述移动区域内所述机器人的单向行走路径集。
165.本实施例中,由于使用了路径不重叠规划算法,基于所述机器人上机械臂的最大伸展长度和最小伸展长度设置路径的间隔,进一步优化了覆盖范围最大化的路径规划方案,从而提高了机器人的施工范围和施工效率。
166.在实际应用中,在对相邻的两个障碍物之间规划单向行走路径过程中,具体是以最大伸展长度进行基础规划,然后对基础规划出的路径进行面积重叠的判断,当规划出的路径存在重叠面积时,则选择其中的两条路径通过调整伸展长度的方式调整路径间隔,得到最终的单向行走路径集。
167.进一步的,为了保证规划出的路径在最大总覆盖面积,在构建单向行走路径集后,
还包括:
168.基于所有所述单向行走路径创建路径哈希表;
169.计算每条单向行走路径纵向的最大坐标和最小坐标;
170.将所述最大坐标和最小坐标与对应的单向行走路径绑定,并存储至所述哈希表中。
171.205、从单向行走路径集中确定最后一条单向行走路径和倒数第二条单向行走路径,并从路径哈希表中查询两条单向行走路径的最大坐标和最小坐标;
172.该步骤中,从路径哈希表中查询得到的路径的最大坐标和最小坐标实际上是两个相邻的障碍物之间的整个区域的最大坐标和最小坐标,这两个坐标也可以是两个相邻的障碍物之间的整个区域两端的平均坐标。
173.206、基于两条单向行走路径的最大坐标和最小坐标,利用预设的路径覆盖面积评价函数计算出最后一条单向行走路径和倒数第二条单向行走路径的最大总覆盖面积;
174.本实施例中,该机器人上的机械臂存在两个转弯方向,分别是上转下和下转上,因此,该步骤在计算两路径的最大总覆盖面积时,分别基于两个转向方式计算出对应的路径覆盖面积,从中选择最大值,从而得到两个路径在最大总覆盖面积的基础上的完整路径。通过增加了对可行走移动区域中路径坐标,基于路径坐标来设置每节路径的连接关系,进一步优化了路径的规划,保障路径覆盖范围最大化。
175.具体的,基于两条单向行走路径的最大坐标和最小坐标,计算出两条单向行走路径在所述机器人上机械臂的最大伸展长度下的覆盖面积,并在路径的位置上构建覆盖区域;
176.基于构建的覆盖区域,确定两条路径的重叠覆盖面积和损失覆盖面积;
177.根据所述倒数第二条单向行走路径的覆盖面积,以及两条路径的重叠覆盖面积和损失覆盖面积,计算出所述最后一条单向行走路径在不同位置转弯的最大总覆盖面积;
178.从不同位置转弯的最大总覆盖面积中取最大值作为所述最后一条单向行走路径的最大总覆盖面积;
179.根据所述倒数第二条单向行走路径的覆盖面积,以及两条路径的重叠覆盖面积和损失覆盖面积,计算出所述倒数第二条单向行走路径的实际覆盖面积;
180.基于所述最后一条单向行走路径的最大总覆盖面积和所述倒数第二条单向行走路径的实际覆盖面积,计算所述最后一条单向行走路径和倒数第二条单向行走路径的最大总覆盖面积。由于利用了路径覆盖面积评估函数辅助路径规划,以优化每节路径之间的连接关系的确定,提高了在最大覆盖面积的前提下,计算最优的连接关系,优化路径设置。
181.207、根据最大总覆盖面积确定所述最后一条单向行走路径和倒数第二条单向行走路径之间的面积关系;
182.本实施例中,该面积关系具体可以通过以下公式表示:
183.g(x,方向)=g(x-x_gap,方向) area_new-area_overlap-area_loss,其中,g(x,方向)为路径x的最大总覆盖面积,g(x-x_gap,方向)为路径x-x_gap的最大总覆盖面积,area_new为最后一条路径覆盖面积,area_overlap为倒数第二条路径重叠覆盖面积。area_loss是为了连接倒数第二条路径而损失的覆盖面积。
184.208、基于面积关系确定所述最后一条单向行走路径和倒数第二条单向行走路径
的第一连接关系;
185.具体的,最后一条路径方向为从上到下,则倒数第二条路径方向为从下到上;若最后一条路径方向为从下到上,则倒数第二条路径方向为从上到下。
186.209、基于第一连接关系确定单向行走路径集中所有路径的连接关系,并基于连接关系构建施工路径。
187.本实施例中,基于第一连接关系将最后一条路径和倒数第二条路径进行连接在一起,然后基于这两条路径的走向设置其他路径的连接关系,使得最后的施工路径的走向与连接后的最后一条路径和倒数第二条路径的走向一致。采用取最大值的方式计算路径覆盖面积的最大值,从不同角度计算选择最优,进一步保证了路径的最优,提高路径规划的准确定。
188.本发明实施例中,通过在地图信息上标记出机器人可行走的移动区域,基于移动区域和机器人上机械臂的伸展长度范围,利用路径不重叠规划算法进行路径规划,并基于路径覆盖面积评价函数计算出规划出来的路径中两相邻路径的最大总覆盖面积,基于最大总覆盖面积来确定路径中各段路径的连接关系,从而得到机器人在待施工区域上的施工路径。
189.请参阅图3,本发明实施例中路径规划方法的第三个实施例,该实施例以涂漆机器人为例进行说明,其实现步骤包括:
190.301、获取机器人的工艺参数和当前待施工区域的地图;
191.该步骤中,该工艺参数包括机械臂的伸展长度(即是作业宽度)的最大值和最小值,以及机器人与障碍物之间的安全距离。
192.302、基于工艺参数和地图,计算路径可规划区域;
193.在本实施例中,通过机器人上的采集单元对待施工区域进行扫描,得到图像信息;
194.基于所述图像信息识别其中的障碍物,并确定所述障碍物的位置和大小;
195.根据所述障碍物的位置和大小,在所述图像信息中进行标记,并基于标记后的图像信息构建地图信息;
196.获取机器人的尺寸信息,并基于所述尺寸信息确定机器人与障碍物之间的安全距离;
197.根据所述安全距离和所述障碍物的位置确定机器人的可行走区域范围,并在所述地图信息中标记,得到移动区域。
198.在实际应用中,通过安装在机器人尾部的刮涂机械臂的伸展长度控制机器人的工艺参数,其中r
min
为作业宽度的最小值,r
max
为作业宽度的最大值,r
safe
为机器人和障碍物之间的安全距离。在一条路径中,如果机器人前进m米,机器人的刮涂机械臂的伸展范围固定为r(r
min
≤r≤r
max
),则机器人作业覆盖总面积为m*r米。为了保证在折返路径中机械臂的作业范围不会发生重叠的情况,相邻的两条路径间隔d必须满足r
min
≤d≤r
max
。
199.考虑机器人与障碍物的距离必须大于安全距离r
safe
,则首先需要标记出垂直方向路径可行走的区域,路径上的每个点周围r
safe
距离之内必须都是可行走的区域。设路径距离图像最左边为x,计算每个x对应的垂直方向路径的上顶点坐标y
顶
(x)和下底点坐标y
底
(x),并缓存在哈希表map(x)中,如图5-8所示,图中黑点表示障碍物,黑色区域表示机器人可行走的区域,带箭头和曲线表示路径,灰色区域表示路径覆盖面积。
200.303、通过动态规划算法计算完整路径中每条路径的位置;
201.在本实施例中,该动态规划算法实际上是上述的路径不重叠规划算法,为了保证前后2条路径的距离在rmax~rmin之间就是符合工艺要求的,但是间距选择的不同,最后覆盖率差别会很大,基于动态规划算法找到最好的路径间距,其间距在r
min
≤d≤r
max
,具体的整体路径为从左到右的上下折返路径,则有如下规则:
202.最后一条路径方向和倒数第2条路径方向相反。若最后一条路径方向为从上到下,则倒数第2条路径方向为从下到上;若最后一条路径方向为从下到上,则倒数第2条路径方向为从上到下。
203.为了符合机器人施工工艺标准,每两条相邻路径的作业范围之间即没有重叠也没有遗漏,每两条相邻路径的间隔d必须满足r
min
≤d≤r
max
。每两条相邻路径的间隔d可以不相等,因为d直接影响最终的总覆盖率,所以需要用动态规划算法找到每两条相邻路径的最优的间隔。如图9和10所示,图9为固定相邻路径间隔的覆盖率,图10为最优动态相邻路径间隔的覆盖率,前后的路径覆盖率明显采用本技术方法的更大。
204.具体的,基于所述机器人上机械臂的伸展长度范围,确定最大伸展长度和最小伸展长度;
205.基于所述安全距离,计算所述地图信息中相邻的两个障碍物之间的相隔距离;
206.根据所述最大伸展长度和最小伸展长度,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,得到所述移动区域内所述机器人的单向行走路径集,其中,两个障碍物之间的所有单向行走路径之间的间隔总和不大于所述相隔距离。
207.进一步的,根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;
208.根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
209.在实际应用中,采用根据所述最大总覆盖面积确定所述最后一条单向行走路径和倒数第二条单向行走路径之间的面积关系;
210.基于所述面积关系确定所述最后一条单向行走路径和倒数第二条单向行走路径的第一连接关系;
211.基于所述第一连接关系确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
212.构建路径覆盖面积评价函数g(x,方向),代表最后一条路径距离图像最左边为x,且方向为向上或从向下时的最大总覆盖面积。则最后一条路径和倒数第2条路径之间的间隔为x_gap时,g(x,向上)和g(x-x_gap,向下)之间存在以下关系,如图11所示:
213.g(x,向上)=g(x-x
gap
,向下) area
new-area
overlap-area
loss
214.g(x,向下)=g(x-x
gap
,向上) area
new-area
overlap-area
loss
215.其中area
new
为最后一条路径覆盖面积,area
overlap
为倒数2条路径重叠覆盖面积。area
loss
是为了连接倒数2条路径而损失的覆盖面积。因为倒数2条路径的y
底
必须保持一致,路径才能用两个90度的转弯连接起来。如果y
底
(-x
gap
)大于y
底
(x),则损失的覆盖面积为(y
底
(x-x
gap
)-y
底
(x))*r
max
,其中y
底
的值由上述的map得到。
216.考虑机器人的作业宽度范围,最后一条路径和倒数第2条路径之间的间隔在r
min
~rmax
之间,若最后一条路径距离图像最左边为x。则倒数第2条路径距离图像最左边为x-r
max
到x-r
min
之间,因此有如下递归迭代关系:
217.和
[0218][0219]
通过动态规划的迭代算法,计算所有可能的x和方向对应的评价函数g的值,最终选择的最后一条路径的(,方向)等于评价函数g最大时对应的参数值。
[0220]
设计最优解缓存机制,缓存g(x,向上)对应的最优上一条路径位置g(x
last
,向下),因此可以反向地从最后一条路径的位置推算出完整路径中路径位置列表,格式为:
[0221]
[(x1,方向1),(x2,方向2),
…
,(x
n-1
,方向
n-1
),(xn,方向n)]。
[0222]
304、对规划计算到的完整路径进行优化,得到施工路径。
[0223]
遍历路径位置列表,对每对相邻的路径进行优化。设相邻的两条路径为(xm,方向m)和(x
m 1
,方向
m 1
),通过查步骤一中的map,补充对应的y
top
和y
底
数据。补充完整的数据格式为(xm,y
顶,m
,y
底,m
,方向m)和(x
m 1
,y
顶,m 1
,y
底,m 1
,方向m)。
[0224]
为了用两个90度的转弯把每对相邻的路径连接起来,需要调整y
顶
和y
底
的值。调整规则如下:
[0225]
若方向m=
″
向上"且方向
m 1
="向下",则表明这对相邻的路径的连接点在地图顶部,需要调整两条路径的y
顶
,规则为:
[0226]y顶,m
=y
顶,m 1
=取最大(y
顶,m
,y
顶,m 1
)。
[0227]
同理,若方向m=
″
向下
″
且方向
m 1
=
″
向上
″
,则调整两条路径的y
底
的规则为:
[0228]y底,m
=y
底,m 1
=取最小(y
底,m
,y
底,m 1
)。
[0229]
调整完整路径的数据格式为:[(x1,y1),(x2,y2),
…
,(x
n-1
,y
n-1
),(xn,yn),结束路径规划算法并输出结果。
[0230]
本实施例提供的方法,基于机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对地图信息中机器人可行走的移动区域进行路径规划,得到机器人的单向行走路径集,根据预设的路径覆盖面积评价函数,计算单向行走路径集中最后两条相邻路径的最大总覆盖面积,根据最大总覆盖面积确定单向行走路径集中所有路径的连接关系,并基于连接关系构建施工路径。利用上述的方式规划路径解决了机器人有效施工区域小,路径覆盖范围小的问题。
[0231]
如图4所示,为本技术实施例提供的一种机器人施工方法,该方法具体实现包括以下步骤:
[0232]
401、获取待施工区域的地图信息,并在地图信息中标记出机器人可行走的移动区域;
[0233]
402、基于机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对移
动区域进行路径规划,得到机器人的单向行走路径集;
[0234]
403、根据预设的路径覆盖面积评价函数,计算单向行走路径集中最后两条相邻路径的最大总覆盖面积;
[0235]
404、根据最大总覆盖面积确定单向行走路径集中所有路径的连接关系,并基于连接关系构建施工路径;
[0236]
本实施例中,对于上述步骤401-404的具体实现原理与上述实施例提供的路径规划方法的具体实现原理相同,这里不再重复赘述。
[0237]
405、基于施工路径控制机器人移动对所述待施工区域进行施工。
[0238]
在机器人实际作业时,通过全局地图和实时定位技术,获得机器人左右近距离障碍物的位置。当机器人左右存在近距离障碍物时,需要临时缩小机械臂的作业宽度,避免机械臂和障碍物发生碰撞,如图12所示,三角框是机械臂的范围,小车沿着完整路径一次走完整各地图,黑色点是柱子,如果小车左边有柱子,就调临时整机械臂扫的作业宽度,避免机械臂和柱子碰撞。
[0239]
综上所述,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
[0240]
上面对本发明实施例中路径规划方法进行了描述,下面对本发明实施例中路径规划装置进行描述,请参阅图13,本发明实施例中路径规划装置一个实施例包括:
[0241]
标记模块501,用于获取待施工区域的地图信息,并在所述地图信息中标记出机器人可行走的移动区域;
[0242]
第一路径规划模块502,用于基于所述机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对所述移动区域进行路径规划,得到所述机器人的单向行走路径集;
[0243]
计算模块503,用于根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;
[0244]
第二路径规划模块504,用于根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
[0245]
通过对上述提供的装置的实施,基于机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对地图信息中机器人可行走的移动区域进行路径规划,得到机器人的单向行走路径集,根据预设的路径覆盖面积评价函数,计算单向行走路径集中最后两条相邻路径的最大总覆盖面积,根据最大总覆盖面积确定单向行走路径集中所有路径的连接关系,并基于连接关系构建施工路径。利用上述的方式规划路径解决了机器人有效施工区域小,路径覆盖范围小的问题。
[0246]
请参阅图14,本发明实施例中路径规划装置的另一个实施例包括:
[0247]
标记模块501,用于获取待施工区域的地图信息,并在所述地图信息中标记出机器人可行走的移动区域;
[0248]
第一路径规划模块502,用于基于所述机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对所述移动区域进行路径规划,得到所述机器人的单向行走路径集;
[0249]
计算模块503,用于根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;
[0250]
第二路径规划模块504,用于根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
[0251]
通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
[0252]
其中,所述标记模块501包括:
[0253]
扫描单元5011,用于通过机器人上的采集单元对待施工区域进行扫描,得到图像信息;
[0254]
识别单元5012,用于基于所述图像信息识别其中的障碍物,并确定所述障碍物的位置和大小;
[0255]
构建单元5013,用于根据所述障碍物的位置和大小,在所述图像信息中进行标记,并基于标记后的图像信息构建地图信息;
[0256]
获取单元5014,用于获取机器人的尺寸信息,并基于所述尺寸信息确定机器人与障碍物之间的安全距离;
[0257]
标记单元5015,用于根据所述安全距离和所述障碍物的位置确定机器人的可行走区域范围,并在所述地图信息中标记,得到移动区域。
[0258]
通过该方案的实施,解决了现有的路径规划中,由于障碍物的限制机器人移动,而导致路径规划准确度的问题,保证了规划路径的区域的精准度,为后面路径规划奠定了基础。
[0259]
其中,所述第一路径规划模块502包括:
[0260]
确定单元5021,用于基于所述机器人上机械臂的伸展长度范围,确定最大伸展长度和最小伸展长度;
[0261]
距离计算单元5022,用于基于所述安全距离,计算所述地图信息中相邻的两个障碍物之间的相隔距离;
[0262]
第一规划单元5023,用于根据所述最大伸展长度和最小伸展长度,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,得到所述移动区域内所述机器人的单向行走路径集,其中,两个障碍物之间的所有单向行走路径之间的间隔总和不大于所述相隔距离。
[0263]
通过该方案的实施,由于使用了路径不重叠规划算法,基于所述机器人上机械臂的最大伸展长度和最小伸展长度设置路径的间隔,保证路径的覆盖范围最大化,从而提高了机器人的施工范围和施工效率。
[0264]
其中,所述第一规划单元5023具体用于:
[0265]
以所述最小伸展长度为路径间隔,利用预设的路径不重叠规划算法在两个障碍物之间规划至少一条单向行走路径,其中所述至少一条单向行走路径所覆盖的区域总跨度等于所述相隔距离;
[0266]
基于所述最大伸展长度,对所述至少一条单向行走路径中相邻两条路径的路径间隔以及路径数量进行调整,得到两个障碍区之间的最终的单向行走路径子集;
[0267]
根据所有的单向行走路径子集确定所述移动区域内所述机器人的单向行走路径集。
[0268]
通过该方案的实施,由于使用了路径不重叠规划算法,基于所述机器人上机械臂的最大伸展长度和最小伸展长度设置路径的间隔,进一步优化了覆盖范围最大化的路径规划方案,从而提高了机器人的施工范围和施工效率。
[0269]
其中,所述第一规划模块502还包括哈希创建单元5024,其具体用于:
[0270]
基于所有所述单向行走路径创建路径哈希表;
[0271]
计算每条单向行走路径纵向的最大坐标和最小坐标;
[0272]
将所述最大坐标和最小坐标与对应的单向行走路径绑定,并存储至所述哈希表中。
[0273]
通过该方案的实施,增加了对可行走移动区域中路径坐标,基于路径坐标来设置每节路径的连接关系,进一步优化了路径的规划,保障路径覆盖范围最大化。
[0274]
其中,所述计算模块503包括:
[0275]
坐标计算单元5031,用于从所述单向行走路径集中确定最后一条单向行走路径和倒数第二条单向行走路径,并从所述路径哈希表中查询两条单向行走路径的最大坐标和最小坐标;
[0276]
面积计算单元5032,用于基于两条单向行走路径的最大坐标和最小坐标,利用预设的路径覆盖面积评价函数计算出所述最后一条单向行走路径和倒数第二条单向行走路径的最大总覆盖面积。
[0277]
通过该方案的实施,由于利用了路径覆盖面积评估函数辅助路径规划,以优化每节路径之间的连接关系的确定,提高了在最大覆盖面积的前提下,计算最优的连接关系,优化路径设置。
[0278]
其中,所述面积计算单元5032具体用于:
[0279]
基于两条单向行走路径的最大坐标和最小坐标,计算出两条单向行走路径在所述机器人上机械臂的最大伸展长度下的覆盖面积,并在路径的位置上构建覆盖区域;
[0280]
基于构建的覆盖区域,确定两条路径的重叠覆盖面积和损失覆盖面积;
[0281]
根据所述倒数第二条单向行走路径的覆盖面积,以及两条路径的重叠覆盖面积和损失覆盖面积,计算出所述最后一条单向行走路径在不同位置转弯的最大总覆盖面积;
[0282]
从不同位置转弯的最大总覆盖面积中取最大值作为所述最后一条单向行走路径的最大总覆盖面积;
[0283]
根据所述倒数第二条单向行走路径的覆盖面积,以及两条路径的重叠覆盖面积和损失覆盖面积,计算出所述倒数第二条单向行走路径的实际覆盖面积;
[0284]
基于所述最后一条单向行走路径的最大总覆盖面积和所述倒数第二条单向行走路径的实际覆盖面积,计算所述最后一条单向行走路径和倒数第二条单向行走路径的最大总覆盖面积。
[0285]
通过该方案的实施,采用取最大值的方式计算路径覆盖面积的最大值,从不同角度计算选择最优,进一步保证了路径的最优,提高路径规划的准确定。
[0286]
其中,所述第二路径规划模块504包括:
[0287]
第二关系确定单元5041,用于根据所述最大总覆盖面积确定所述最后一条单向行
走路径和倒数第二条单向行走路径之间的面积关系;
[0288]
第一关系确定单元5042,用于基于所述面积关系确定所述最后一条单向行走路径和倒数第二条单向行走路径的第一连接关系;
[0289]
路径构建单元5043,用于基于所述第一连接关系确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径。
[0290]
通过该方案的实施,采用相邻两条路径的覆盖面积的约束关系计算出两相邻的路径总覆盖面积的最优值,进一步保证了路径的最优,提高路径规划的准确定。
[0291]
本发明实施例中,通过在地图信息上标记出机器人可行走的移动区域,基于移动区域和机器人上机械臂的伸展长度范围,利用路径不重叠规划算法进行路径规划,并基于路径覆盖面积评价函数计算出规划出来的路径中两相邻路径的最大总覆盖面积,基于最大总覆盖面积来确定路径中各段路径的连接关系,从而得到机器人在待施工区域上的施工路径。
[0292]
参见图15,为本技术实施例提供一种机器人的结构示意图,所述机器人包括:如上述实施例提供的路径规划装置1501和驱动装置1502,其中,
[0293]
所述路径规划装置1501,用于获取待施工区域的地图信息,并在所述地图信息中标记出机器人可行走的移动区域;基于所述机器人上机械臂的伸展长度范围,利用预设的路径不重叠规划算法对所述移动区域进行路径规划,得到所述机器人的单向行走路径集;根据预设的路径覆盖面积评价函数,计算所述单向行走路径集中最后两条相邻路径的最大总覆盖面积;根据所述最大总覆盖面积确定所述单向行走路径集中所有路径的连接关系,并基于所述连接关系构建施工路径;
[0294]
所述驱动装置1502,用于基于所述施工路径控制所述机器人移动对所述待施工区域进行施工。
[0295]
通过该方案的实施,解决了现有的路径规划难以实现施工覆盖范围最大化的问题,充分利用可变机器人作业宽度的灵活性,在不显著增加机器人的转弯次数的前提下增大障碍物周围的作业覆盖面积,避免重叠路径,满足在工艺不允许出现重叠路径的场景。
[0296]
上面图13-15从模块化功能实体的角度对本发明实施例中的路径规划装置或机器人进行详细描述,下面从硬件处理的角度对本发明实施例中机器人进行详细描述。
[0297]
图16是本发明实施例提供的一种机器人的结构示意图,该机器人600可因配置或性能不同而产生比较大的差异,可以包括一个或一个以上处理器(central processing units,cpu)610(例如,一个或一个以上处理器)和存储器620,一个或一个以上存储应用程序633或数据632的存储介质630(例如一个或一个以上海量存储设备)。其中,存储器620和存储介质630可以是短暂存储或持久存储。存储在存储介质630的程序可以包括一个或一个以上模块(图示没标出),每个模块可以包括对电子设备600中的一系列指令操作。更进一步地,处理器610可以设置为与存储介质630通信,在机器人600上执行存储介质630中的一系列指令操作。
[0298]
机器人600还可以包括一个或一个以上电源640,一个或一个以上有线或无线网络接口650,一个或一个以上输入输出接口660,和/或,一个或一个以上操作系统631,例如windows serve,mac os x,unix,linux,freebsd等等。本领域技术人员可以理解,图16示出的机器人的结构并不构成对本技术中提供的电子设备的限定,可以包括比图示更多或更少
的部件,或者组合某些部件,或者不同的部件布置。
[0299]
本发明还提供一种计算机可读存储介质,该计算机可读存储介质可以为非易失性计算机可读存储介质,该计算机可读存储介质也可以为易失性计算机可读存储介质,所述计算机可读存储介质中存储有指令,当所述指令在计算机上运行时,使得计算机执行所述路径规划方法的各个步骤,或者执行所述机器人施工方法的各个步骤。
[0300]
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统或装置、单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
[0301]
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:u盘、移动硬盘、只读存储器(read-only memory,rom)、随机存取存储器(random access memory,ram)、磁碟或者光盘等各种可以存储程序代码的介质。
[0302]
以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
转载请注明原文地址:https://tc.8miu.com/read-654.html