基于高精地图的园区道路无人环卫车清扫路径的规划方法与流程
本发明涉及无人驾驶,尤其是涉及基于高精地图的园区道路无人环卫车清扫路径的规划方法。
背景技术:
1、在公开道路场景中,受车流和环境影响,垃圾和灰尘往往在道路两侧边缘堆积,并且受限于交通安全要求和复杂多变的道路环境,无人清扫车在执行公开道路清扫任务时,通常选择贴边行驶的作业模式。但是在封闭园区内,园区的封闭道路结构相对规整、交通参与者较为单一、作业场景稳定可控,路面灰尘和垃圾相对分散,是实现无人化全域清扫的理想落地场景。其中路径规划作为无人环卫车自主作业的核心环节,直接影响到园区内清扫的覆盖完整性、行驶效率以及车辆在园区内的通行安全。
2、对于封闭园区内无人车全域覆盖的路径规划领域,现有的技术存在以下问题:
3、1、封闭园区内道路结构虽然相对简单,但是也存在交通道路标线、行人、和园区内部的其他车辆(如物流园区内有较多运转车辆),无人车同样需要遵守交通规则,保证行驶安全。现有的方案对于封闭园区的道路场景抽象较为简单,大多基于二维栅格地图或基础的图论拓扑。这些方法仅仅提取了道路浅层的几何连通性,缺乏车道数量、车道中心线、车道走向、路口挂接,交通标线等车道级别的道路信息。
4、2、现有方案通常默认道路通过一次就清扫完成,没有考虑道路宽度和无人车有效清扫宽度,当实际道路宽度大于清扫车的实际有效清扫宽度一定距离时,就会产生覆盖盲区,从而降低全域清扫覆盖率。
5、3、现有的多数方案仅优化总路径长度这一单一目标,未同时权衡转弯次数、掉头次数、重复覆盖率和空驶率等重要指标。该场景下如果单纯的追求路径最短,可能会产生频繁的变道和掉头,这样不仅会增加道路安全风险,还会加剧车辆轮胎和清扫装置的磨损。同时,缺乏对空驶率与重复覆盖率的约束,会导致无人车在清扫路面上重复行驶,造成车载水资源和动力电池的浪费,从而影响清扫效率。
6、4、无人清扫车在实际执行全域清扫任务时,自身携带的水箱容量存在物理上限。现有的基于无人清扫车的路径规划方案,未能将车辆携带的水余量纳入到规划空间中,规划的路径中不包含自动前往补水区补水的路径方案,这就导致实际在执行面积较大的清扫任务时,车辆中途缺水还需要人工干预,无法做到完整的全域无人化作业。
技术实现思路
1、鉴于以上问题,本发明提供了基于高精地图的园区道路无人环卫车清扫路径的规划方法,不仅满足园区全域场景覆盖,提升无人环卫系统在不同园区场景的适配性与部署效率,而且消除单一作业模式带来的道路边缘清扫死角,提升园区全域清扫覆盖率与作业质量。
2、为了实现上述目的及其他相关目的,本发明提供的技术方案如下:
3、基于高精地图的园区道路无人环卫车清扫路径的规划方法,所述方法包括:
4、m1.基于高精地图的封闭园区车道模型搭建;
5、m2.构建状态节点与算法容器;
6、m3.多维度代价评估模型的构建;
7、m4.基于多维条件约束的状态扩展;
8、m5.全局路径序列解析回溯与断点插入;
9、m6.路径语义的差异化提取。
10、进一步地,在步骤m1中,所述基于高精地图的封闭园区车道模型搭建包括:
11、m11.根据实际路延、花坛、墙面标注道路硬边界,接着根据边界构建车道,根据车道宽度和边界设置道路中心线,并为每条道路中心线设置道路属性;
12、m12.对于作业道路,依据不同的车道宽度与无人环卫车的实际有效清扫展宽,设置多种清扫模式,包括左贴边模式、右贴边模式和居中模式,每趟清扫选择按照不同的模式清扫;
13、m13.设置每条道路挂接的下一条道路是掉头还是转弯,并且在地图上标注补水区域。
14、进一步地,在步骤m1中,所述基于高精地图的封闭园区车道模型搭建包括:
15、m11.根据实际路延、花坛、墙面标注道路硬边界,接着根据边界构建车道,根据车道宽度和边界设置道路中心线,并为每条道路中心线设置道路属性;
16、m12.对于作业道路,依据不同的车道宽度与无人环卫车的实际有效清扫展宽,设置多种清扫模式,包括左贴边模式、右贴边模式和居中模式,每趟清扫选择按照不同的模式清扫;
17、m13.设置每条道路挂接的下一条道路是掉头还是转弯,并且在地图上标注补水区域。
18、进一步地,在步骤m2中,所述构建状态节点与算法容器包括:
19、m21.将无人车的位置状态、全域清扫覆盖完成度和综合代价进行耦合,构建状态节点s;
20、m22.在规划任务下发时,算法会构建a*搜索树的初始状态节点s0,并对其各个状态分量进行初始化设置。
21、进一步地,所述状态节点s为,
22、,
23、其中,位置状态lcur提取步骤m1中生成的当前所在道路中心线的索引id,全域清扫覆盖完成度mcov采用位映射机制构建二进制位图,将步骤m1中的n条道路中心线,映射到位图中的第0到n-1位,当比特位的值为0时表示对应的作业线未清扫,比特位的值为1时表示已完成清扫,f(n)为代价。
24、进一步地,在步骤m22中,所述算法会构建a*搜索树的初始状态节点s0,并对其各个状态分量进行初始化设置包括:
25、m221.位置状态lcur初始化为车辆起始出发的车道的索引id;
26、m222.全域清扫覆盖完成度mcov初始化为全零位图,表示全域道路均处于未清扫状态;
27、m223.初始代价f(n)初始化为0;
28、m224.通过最小堆数据结构构建优先队列,用于存储待扩展的候选状态节点;
29、m225.利用哈希表构建闭集容器,用于记录已经被完全拓展的状态节点;
30、m226.将初始状态节点s0的实际累计代价设置为0,调用启发式评价函数计算其初始预估代价,并将s0作为搜索树的根节点压入步骤m224中的优先队列中;
31、m227.预先遍历所有的道路网络,将所有被标记为清扫任务的作业道路比特位置设置为1,预先设置一个表达全域满覆盖状态的静态常量。
32、进一步地,所述通过最小堆数据结构构建优先队列为队列依据代价评估函数所算处出的综合代价值,对内部节点动态排序;所述利用哈希表构建闭集容器为通过集合进行查重,用来规避路径搜索过程中冗余的拓展与状态死循环,收敛搜索空间。
33、进一步地,在步骤m3中,所述多维度代价评估模型的构建包括:
34、m31.当拓展出的候选目标道路同时满足,具有清扫任务属性且在当前覆盖位图掩码中对应比特位为0,这两个条件时,判定该动作有效产出作业δgs,
35、,
36、其中,ledge为目标道路的实际长度,wsweep为设置的清扫作业权重系数;
37、m32.设置的清扫作业权重系数当候选目标道路属于非任务道路,或道路的清扫任务已完成时,算法判定车辆在该道路进入纯耗能的空驶状态,
38、δge=ledge×wempty,
39、其中,wempty为可设置的空驶权重系数;
40、m33.当发生道路状态转移时计算转移代价δgt,如果两段路是通过平行直行线挂接,则不增加转向代价;如果两段路需要转弯或者掉头线挂接,则在实际的累计代价中增加相应的转弯代价或者掉头代价,清扫车从初始起点行驶至当前状态节点所累积的真实路径代价g(n)为,
41、g(n)=δgs+δge+δgt;
42、m34.提取当前节点的覆盖位图掩码,与高精地图全域道路网络进行对比检索,筛选出所有在当前时刻掩码状态为0的任务目标道路,启发式代价定义为当前系统中所有未清扫道路的物理长度总和与清扫作业权重系数的乘积,
43、,
44、其中,u为基于当前掩码判定下所有未清扫道路的集合,li为为集合中第i条道路的物理长度。
45、进一步地,在步骤m4中,所述基于多维条件约束的状态扩展为从优先队列中获取当前代价最小的状态节点作为父节点,并向高精地图道路网络发起查询,生成动作空间。
46、进一步地,在步骤m5中,所述全局路径序列解析回溯与断点插入为以步骤m4输出的终点节点为起点,顺着状态空间节点中的父节点指针,逐个级别逆向回溯,直至回溯到步骤二中生成的初始状态节点;将这一链条上的所有状态节点依次存入一个有序列表,并执行一次反转操作,从而得出车辆从起步到任务完成的正向行驶规划路径。
47、进一步地,在步骤m6中,所述路径语义的差异化提取包括:
48、m61.对于步骤m4中输出的全局规划路径中任意相邻节点,提取两个任意相邻先后道路节点的mconvbefore和mconv进行比对,并根据掩码变化的形式赋予相应的路径语义;
49、m62.如果mconvbefore=mconv,也就是状态掩码没有发生有效位阶跃迁,判定对应的道路为已清扫或者非工作道路,将该道路序列赋予空驶标签;
50、m63.如果mconvbefore>mconv,也就是状态掩码发生有效置位跃迁,判定对应道路产生新的有效清扫覆盖,将该道路序列赋予清扫作业标签;
51、m64.如果触发断点补水机制,分别将驶往和驶离的道路序列,赋予驶往补水区和驶离补水区标签。
52、本发明具有以下积极效果:
53、1.本发明通过基于高精地图的标注,可适配封闭园区内道路密集、路口形态多样、补水点位固定的路网结构。满足园区全域场景覆盖,提升无人环卫系统在不同园区场景的适配性与部署效率。
54、2.本发明通过为宽幅车道适配右贴边模式、居中模式和左贴边模式,可满足封闭园区内不同宽度的道路清扫需求,消除单一作业模式带来的道路边缘清扫死角,提升园区全域清扫覆盖率与作业质量。
55、3.本发明通过采用二进制覆盖掩码对全域清扫状态进行编码,状态表达紧凑、位运算效率高;结合哈希闭集合的状态查重剪枝机制,可快速剔除重复探索的状态节点,有效缩减启发式搜索的状态空间,降低封闭园区全域清扫路径规划的计算量与算力消耗,提升最优清扫路径的求解速度。
56、4.本发明通过针对转弯、掉头类道路挂接设置转移代价;可引导搜索树向转向次数更少、行驶工况更平顺的方向拓展,规避单纯以路径长度为唯一评价标准导致的频繁转向问题,使规划路径更贴合无人环卫车实车行驶的能耗与时间损耗特性,提升全域清扫路径的工程可行性与综合最优性。
57、5.本发明通过断点补水机制与补水路径规划,全程无需人工干预补水调度,可保障全域清扫任务的连续执行;同时通过最短路径规划压缩补水往返的空驶里程与耗时,降低补水过程对整体作业效率的影响,提升无人环卫系统的全自主运行能力与任务执行连贯性。
58、6.本发明通过路径语义差异化提取机制,为全局路径各道路赋予清扫作业、空驶、补水等语义标签,可以与下游联动控制上装作业机构与底盘行驶速度。避免作业机构无效空磨与水资源、电能的空载消耗;在保障清扫效果的前提下,延长扫盘、水泵等易损件的使用寿命,降低单位作业里程的水耗与电耗,同时缩短全域作业总时长。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com