一种基于地图语义和动态碰撞包络的清扫车驱动方法及系统与流程
本发明涉及清扫车和智能检测,尤其涉及一种基于地图语义和动态碰撞包络的清扫车驱动方法及系统。
背景技术:
1、随着自动驾驶技术的快速发展,无人驾驶清扫车在城市环卫、园区保洁等场景中得到了日益广泛的应用。清扫车在执行清扫作业时,需要在包含行人、车辆、路沿、障碍物等多种要素的复杂环境中自主规划路径并安全行驶。
2、现有的清扫车路径规划与碰撞规避技术主要存在以下不足:
3、其一,现有方法大多将清扫车视为单一刚体进行碰撞包络建模,未考虑清扫车多箱体结构的特殊性。清扫车通常包含清水箱、污水箱、垃圾箱等多个独立箱体,各箱体在车辆运行过程中的姿态、负载状态不同,导致车辆的整体外形包络并非固定不变。现有技术中,如公开号为cn119160172b的中国专利申请公开的一种防止清扫车碰撞的安全控制方法,虽然考虑了车身宽度信息进行轨迹点扩展,但未针对多箱体结构的动态包络变化进行建模与调整。此外,现有针对清扫车结构的分层碰撞检测方法虽考虑了上宽下窄的车体结构特征,但主要聚焦于垂直方向上的分层处理,未涉及多箱体横向包络的动态调整。
4、其二,现有安全包络的生成多基于车辆当前位姿和速度等运动学参数,缺乏对作业状态和地图语义信息的深度利用。例如,露天矿山车辆的安全包络生成方法考虑了车辆位置、航向角、速度和作业状态等因素,但未将地图中的语义信息(如路面类型、清扫区域边界、障碍物属性等)纳入包络调整的决策依据中。清扫车的作业场景具有高度的语义结构性——路沿、人行道、绿化带、停车位等不同区域对车辆通行能力和包络要求各不相同,现有方法未能充分利用这些语义信息来指导包络的动态调整。
5、其三,清扫车作业过程中,箱体状态(如清水箱水量、污水箱液位、垃圾箱装载量)持续变化,这些变化直接影响车辆的质量分布和外形包络,但现有技术中缺乏基于箱体状态实时调整碰撞包络的机制。例如,公开号为cn115848263a的中国专利申请中涉及大容量箱体的自适应平衡承载结构,但其主要关注箱体姿态的物理平衡调整,而非碰撞包络的语义驱动动态调整。
6、以上背景技术内容的公开仅用于辅助理解本技术的构思及技术方案,其并不必然会给出技术教导。
技术实现思路
1、本发明的目的是提供一种基于地图语义和动态碰撞包络的清扫车驱动方法及系统,能够提高清扫车在复杂作业场景中的通行安全性、作业效率和环境适应性。
2、为达到上述目的,本发明采用的技术方案如下:
3、一种清扫车驱动方法,包括以下步骤:
4、确定清扫车的动态部件为动态箱体,确定清扫车的非动态部件整体为本体箱体,根据清扫车的结构参数确定清扫车中各个箱体的三维空间模型,所述箱体包括本体箱体和一个或多个所述动态箱体;
5、根据本体箱体的三维空间模型和清扫车运动状态确定本体箱体的基础碰撞包络,根据动态箱体的三维空间模型、状态信息和清扫车运动状态确定各个动态箱体对应的基础碰撞包络;
6、根据箱体的质量确定各个箱体对应的安全裕度系数,所述安全裕度系数与箱体质量正相关,所述箱体包括本体箱体和动态箱体;
7、获取清扫车目标行驶区域对应的地图语义信息,并且根据所述地图语义信息确定各个箱体对应的语义调整系数向量,所述语义调整系数向量和地图语义信息分别与基础碰撞包络在三维空间各个方向上的调整相关,即语义调整系数向量影响基础碰撞包络在三维空间各个方向上的调整,地图语义信息影响基础碰撞包络在三维空间各个方向上的调整,其中,调整包括调整方向和调整幅度;
8、针对各个箱体,基于所述安全裕度系数和语义调整系数向量调整箱体的基础碰撞包络以得到箱体的动态碰撞包络;
9、以动态碰撞包络不存在与清扫车之外的其他物体产生碰撞风险为目标驱动清扫车行驶。
10、进一步地,承前所述的任一技术方案或多个技术方案的组合,针对各个箱体,基于所述安全裕度系数和语义调整系数向量调整箱体的基础碰撞包络以得到箱体的动态碰撞包络,包括:
11、若所述安全裕度系数变大,则控制所述基础碰撞包络向外膨胀,若所述安全裕度系数变小,则控制所述基础碰撞包络向内收缩;
12、所述语义调整系数向量包括前向、后向、左向、右向、上向和下向六个方向的语义调整系数,针对各个方向,若所述语义调整系数变大,则控制所述基础碰撞包络在相应方向上向外膨胀,若所述语义调整系数变小,则控制所述基础碰撞包络在相应方向上向内收缩。
13、进一步地,承前所述的任一技术方案或多个技术方案的组合,根据以下公式基于所述安全裕度系数和语义调整系数向量调整箱体的基础碰撞包络以得到箱体的动态碰撞包络:
14、;
15、其中,表示第
i个箱体在当前运动学姿态下沿
w方向基础碰撞包络的边界位置,表示第
i个箱体的安全裕度系数,表示方向上的语义调整系数。
16、进一步地,承前所述的任一技术方案或多个技术方案的组合,根据以下公式基于所述安全裕度系数和语义调整系数向量调整箱体的基础碰撞包络以得到箱体的动态碰撞包络:
17、;
18、其中,表示第
i个箱体在当前运动学姿态下沿
w方向基础碰撞包络边界的位置,表示第
i个箱体的安全裕度系数,表示方向上的语义调整系数。
19、进一步地,承前所述的任一技术方案或多个技术方案的组合,通过以下公式计算第i个箱体的安全裕度系数:
20、;
21、其中,表示第
i个箱体的基础安全裕度系数,表示质量影响因子,表示第
i个箱体的当前质量,表示第
i个箱体的最大质量。
22、进一步地,承前所述的任一技术方案或多个技术方案的组合,根据所述地图语义信息确定各个箱体对应的语义调整系数向量,包括以下步骤:
23、确定所述地图语义信息所包括的语义信息类型,所述语义信息类型至少影响一个箱体的基础碰撞包络的调整;
24、根据预先构建的语义信息类型和语义调整系数的映射关系库,针对每个箱体,确定各个语义信息类型对应的语义调整系数,所述映射关系库包括多种语义信息类型,一个语义信息类型至少与一个箱体在三维空间各个方向上对应的语义调整系数具有对应关系,根据多个语义信息类型对应的语义调整系数确定箱体对应的语义调整系数向量。
25、进一步地,承前所述的任一技术方案或多个技术方案的组合,所述语义信息类型包括清扫作业区域、狭窄通道区域、人行道混合区域、路沿区域、减速带区域中的多种。
26、进一步地,承前所述的任一技术方案或多个技术方案的组合,所述语义调整系数向量表示如下:,其中,表示前向语义调整系数,表示后向语义调整系数,表示左向语义调整系数,表示右向语义调整系数,表示上向语义调整系数,表示下向语义调整系数。
27、进一步地,承前所述的任一技术方案或多个技术方案的组合,所述语义调整系数向量表示如下:,
28、,
29、;
30、其中,表示第
i个箱体对应的语义调整系数向量,表示第
i个箱体对应的基础语义调整系数向量,表示第
i个箱体、第种语义信息类型对应的语义调整系数变量向量,分别表示第
i个箱体对应的前向、后向、左向、右向、上向、下向的基础语义调整系数,分别表示第
i个箱体、第种语义信息类型对应的前向、后向、左向、右向、上向、下向语义调整系数变量,表示基于地图语义信息得到的语义信息类型总数;
31、若语义信息类型与箱体的基础碰撞包络在一个方向的调整正相关,则该方向对应的语义调整系数变量为正值;若语义信息类型与基础碰撞包络在一个方向的调整负相关,则该方向对应的语义调整系数变量为负值;若语义信息类型与基础碰撞包络负在一个方向的调整无关,则该方向对应的语义调整系数变量为0。
32、进一步地,承前所述的任一技术方案或多个技术方案的组合,所述语义调整系数向量表示如下:,
33、,
34、,
35、,
36、,
37、,
38、;
39、其中,表示第
i个箱体对应的语义调整系数向量,表示第
i个箱体对应的前向、后向、左向、右向、上向、下向的语义调整系数,分别表示针对第
i个箱体对应的前向、后向、左向、右向、上向、下向的基础语义调整系数,分别表示针对第
i个箱体、第种语义信息类型对应的前向、后向、左向、右向、上向、下向语义调整系数变量,表示基于地图语义信息得到的语义信息类型总数;
40、若语义信息类型与箱体的基础碰撞包络在一个方向的调整正相关,则该方向对应的语义调整系数变量大于1;若语义信息类型与基础碰撞包络在一个方向的调整负相关,则该方向对应的语义调整系数变量大于0且小于1;若语义信息类型与基础碰撞包络负在一个方向的调整无关,则该方向对应的语义调整系数变量为1。
41、进一步地,承前所述的任一技术方案或多个技术方案的组合,以各个箱体对应的动态碰撞包络不与清扫车之外的物体发生碰撞为目标驱动清扫车行驶,包括:
42、根据清扫车的行驶速度、预设的碰撞包络调整时间常数和预设的安全距离裕量确定预测调整距离;
43、在清扫车的行驶方向上的反方向上,确定距离目标行驶区域预测调整距离的位置为初始调整位置,以所述初始调整位置为起点、以目标行驶区域为终点,控制清扫车的当前碰撞包络渐变地调整至动态碰撞包络。
44、进一步地,承前所述的任一技术方案或多个技术方案的组合,所述预测调整距离δd的计算公式为:
45、;
46、其中,为当前清扫车的车速,为从当前碰撞包络调整至动态碰撞包络所需的时间常数,为预设的安全距离裕量。
47、进一步地,承前所述的任一技术方案或多个技术方案的组合,以各个箱体对应的动态碰撞包络不与清扫车之外的物体发生碰撞为目标驱动清扫车行驶;
48、或者,将各个箱体对应的动态碰撞包络合并以得到清扫车的整体动态碰撞包络,以整体动态碰撞包络不与清扫车之外的物体发生碰撞为目标驱动清扫车行驶。
49、根据本发明的另一方面,提供了一种清扫车驱动系统,其特征在于,基于如上任一技术方案或多个技术方案的组合的清扫车驱动方法驱动清扫车行驶。
50、本发明提供的技术方案带来的有益效果如下:
51、a. 实现了清扫车多箱体结构的精细化碰撞包络建模:本发明充分考虑清扫车包含动态部件和非动态部件,根据清扫车具备多个独立的活动箱体的结构特点,且垃圾箱体和清水箱、污水箱的质量可能改变的情况,基于各箱体的实时状态(质量、位姿等)分别计算各箱体的基础碰撞包络和安全裕度,为后续生成更加精确的清扫车的碰撞包络提供基础,克服了传统方法将清扫车视为单一刚体所导致的包络过于保守或过于激进的问题;
52、b. 实现了地图语义驱动的动态碰撞包络智能调整:本发明将地图语义信息引入动态碰撞包络的调整决策中,根据车辆当前所处区域的路面类型、功能标签、障碍物属性等语义信息,自适应地调整各个箱体在各方向包络的安全裕度,使最终的动态碰撞包络调整更加贴合实际作业场景的需求,在保证安全的前提下最大化通行效率;
53、c. 实现了基于语义预测的包络前瞻性调整:本发明通过识别规划路径上的语义区域变化,在车辆到达语义边界之前进行包络的预测性调整,避免了包络突变带来的路径震荡和控制不稳定问题,提升了车辆行驶的平顺性和安全性;
54、d. 具有良好的可扩展性和适用性:本发明的方法可广泛应用于各类多箱体结构的环卫车辆、物流车辆和工程车辆,对于推动自动驾驶技术在复杂作业场景中的落地应用具有重要意义。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com