基于前置作业基准点动态映射的环卫车贴边清扫规划方法与流程
本发明涉及自动驾驶控制,尤其是涉及一种基于前置作业基准点动态映射的环卫车贴边清扫规划方法。
背景技术:
1、随着无人驾驶清扫车逐渐应用于城市道路、园区道路等场景的清扫作业,其中贴边清扫是影响道路边缘清扫覆盖率和设备运行安全的重要作业工况。贴边清扫过程中,通常需要使前置扫刷的外缘与路缘石保持较小的工作间隙;当扫刷与路缘之间的距离过大时,容易造成路缘附近垃圾漏扫,而当扫刷与路缘之间的距离过小时,则容易发生扫刷与路缘石的啃碰、干涉,从而造成扫刷磨损甚至机械结构损伤。尤其对于前端设置长悬臂扫刷的无人驾驶清扫车,扫刷实际作业点相对于车辆后轴中心或车身基准点存在较大的纵向和横向偏置,在车辆低速转弯、姿态变化以及扫刷作业受力的情况下,车辆基准点的运动状态与扫刷实际作业点的运动状态之间容易产生动态偏差。根据现有方案的作业参数,前置作业机构的悬臂跨度可达到约1.5~2.5m,在3~15km/h的作业速度及较大转角工况下,该偏置对扫刷作业点横向位置的影响更加明显。同时,扫刷与地面接触产生的摩擦作用还可能引起悬臂结构发生弹性微变形,使基于刚体几何关系获得的扫刷作业点位置与实际作业位置之间产生进一步偏差。
2、现有技术中,cn114779775a公开了一种扫盘轨迹规划方法、清扫车及介质,该方案通过检测目标路缘上的多个路缘点生成路缘线,并根据车辆位置、车辆速度以及预测得到的车辆运行轨迹,进一步确定与目标路缘对应的扫盘伸缩轨迹,从而实现扫盘伸缩动作的自动规划。该技术能够结合路缘形状和车辆未来运动状态对扫盘轨迹进行规划,但其控制对象主要为扫盘的伸缩轨迹,车辆运行轨迹主要依据车辆位置、车速以及车辆角速度、角加速度等状态进行预测,对于前置长悬臂扫刷在受力状态下产生的弹性变形,以及由此造成的扫刷实际作业点相对于车辆几何基准点的动态偏移,未建立相应的力学状态表征与动态映射关系。因此,在需要对扫刷外缘作业点进行高精度贴边控制的情况下,仅依据车辆运动轨迹及几何关系进行扫盘轨迹规划,仍可能存在实际作业点与规划作业点不一致的问题。
3、为进一步提高扫刷沿路缘作业的控制精度,cn113863195a公开了一种沿边清扫方法以及清扫车,该方案通过测距模块获取清扫车与路沿之间的距离,并结合车辆定位信息、车辆航向角、扫盘位置信息以及路沿方向角,计算车辆与路沿之间的相对姿态,并根据车辆与路沿之间的距离及姿态差控制车辆和扫盘动作。同时,该方案还考虑扫盘控制的响应时间,根据车辆速度、车辆姿态以及轴距对车辆后续状态进行预测,以提前调整扫盘位置。该方案通过车辆与扫盘协同控制提高了弯道路沿处的贴边清扫能力,但其对车辆和扫盘之间关系的处理仍主要建立在车辆尺寸、扫盘安装位置、车辆姿态及路沿几何关系基础上,响应时间主要作为控制过程中的预测时间进行处理,并未进一步针对前置悬臂受载变形以及转向执行机构机械间隙、摩擦滞环等因素引起的时变动态滞后建立与实际物理状态相关联的补偿模型。
4、综上所述,现有方案大多以车辆几何基准点或扫盘静态几何位置作为控制基础,对前置长悬臂扫刷在实际作业过程中由于受力产生的动态弹性变形,以及由车辆载荷和转向执行机构工作状态变化所引起的时变响应滞后,缺少统一的状态表征、动态映射和补偿机制。当以前置扫刷实际作业点作为高精度贴边控制对象时,上述因素可能导致规划作业点、预测作业点与实际作业点之间产生动态偏差,并在转弯、进弯和出弯等瞬态工况下进一步放大贴边误差。因此,如何在考虑前置扫刷悬臂动态变形及转向执行机构时变响应特性的基础上,建立前置实际作业点与车辆运动状态之间的动态映射,并对由物理滞后引起的作业点位置偏差进行预测补偿,从而提高无人驾驶清扫车复杂道路工况下的贴边清扫精度并降低啃边、碰撞及漏扫风险,成为本领域仍需解决的技术问题。
技术实现思路
1、本发明的主要目的在于提供一种基于前置作业基准点动态映射的环卫车贴边清扫规划方法,解决无人驾驶清扫车前置长悬臂扫刷在贴边作业过程中因悬臂弹性变形、车辆运动状态及转向时变滞后导致扫刷实际作业点与路沿之间产生动态偏差和振荡的问题,建立以前置作业基准点为位置基准、以实际有效清扫边界为作业边界、以动态安全贴边距离为控制边界的闭环规划与控制方法,并通过系统等效延迟预测补偿前置扫刷作业点位置变化。
2、为解决上述技术问题,本发明所采用的技术方案是:基于前置作业基准点动态映射的环卫车贴边清扫规划方法,包括:
3、s1、建立车辆坐标系和扫刷作业坐标系,根据车辆后轴中心位置、车身航向角及前置扫刷作业基准点纵向距离和横向作业偏置,计算前置扫刷作业基准点位置并生成基础贴边轨迹;
4、s2、获取扫刷机械状态,计算扫刷法向接触载荷并确定实际有效清扫边界;
5、s3、建立路沿三维空间曲线,计算实际有效清扫边界与路沿之间的有效距离并生成动态安全贴边距离;
6、s4、根据系统等效延迟预测前置扫刷作业基准点横向位置变化;
7、s5、根据动态安全贴边距离与实际有效清扫边界之间的关系,对车辆横向运动和扫刷作业状态进行协同控制;
8、s6、将清扫结果按时间戳和车辆历史位姿映射至道路局部空间坐标,并根据清扫结果更新实际有效清扫边界。
9、优选的,通过液压压力、液压缸位移、扫刷支承机构角度、扫刷转速或扫刷驱动电机负载以及扫刷安装座姿态获得扫刷机械状态,并根据液压执行机构两腔压力及活塞有效面积计算液压缸输出轴向力,根据扫刷支承机构力矩平衡关系获得扫刷法向接触载荷。
10、优选的,将扫刷有效清扫范围划分为多个方向单元,并根据初始理论边界、刷毛磨损状态、扫刷法向接触载荷、扫刷转速、车辆速度、扫刷安装姿态角以及扫刷作用区域路面局部坡度确定各方向单元的实际有效清扫边界:
11、;
12、其中,为第个方向上的实际有效清扫边界半径,为初始理论边界半径,为刷毛磨损造成的等效边界缩短量,为扫刷作业状态引起的等效边界变化量。
13、优选的,通过出厂标定形成有效清扫边界查找表,根据扫刷法向接触载荷、扫刷转速、车辆速度、扫刷安装姿态角及扫刷作用区域路面局部坡度进行查表或分段线性插值,获得各方向单元的等效边界变化量,并在车辆速度变化率、车辆纵向加速度以及扫刷接触载荷满足稳定条件的时间窗口内更新刷毛磨损状态。
14、优选的,建立路沿三维空间曲线,将实际有效清扫边界转换至与路沿三维空间曲线相同的坐标系,根据有效清扫边界点与路沿三维空间曲线之间的最小空间距离获得实际有效清扫边界与路沿之间的有效距离。
15、优选的,根据基础作业距离、有效清扫边界距离估计不确定度、车辆纵向速度、系统等效延迟及机械结构安全项计算动态安全贴边距离:
16、;
17、其中,为当前控制状态下允许的最小路沿安全距离,为满足清扫任务要求的基础作业距离,为置信度系数,为有效清扫边界距离估计的不确定度标准差,为横向预瞄位移分量,为由机械结构装配误差、机械间隙以及路沿识别结构误差形成的等效安全项。
18、优选的,系统等效延迟由传感器数据更新时间及融合处理延迟、控制器计算延迟、底盘转向执行延迟以及扫刷机构执行延迟组成,并根据前置扫刷作业基准点横向运动状态预测延迟期间的位置变化:
19、;
20、其中,为系统等效延迟期间前置扫刷作业点的横向预测位移,为当前前置扫刷作业点横向速度,为当前前置扫刷作业点横向加速度,为从感知输入形成有效控制作用之间的系统等效延迟。
21、优选的,建立车辆外环与扫刷内环组成的双闭环控制结构,车辆外环根据实际有效清扫边界与动态安全贴边距离之间的误差生成车辆目标横向轨迹,扫刷内环根据扫刷接触载荷及扫刷机构位置误差调整扫刷支承机构的位置、角度或接触状态,并采用模型预测控制器对车辆转向输入和扫刷执行输入进行滚动优化。
22、优选的,在扫刷经过区域后方获取清扫结果检测数据,根据清扫结果检测数据的时间戳从车辆历史位姿中获得对应车辆位置和航向,将清扫结果检测范围映射至道路局部空间坐标,并根据清扫前污染度指标与清扫后污染度指标获得边缘清扫有效率;当实际有效清扫边界已经接近动态安全贴边距离且边缘清扫有效率未达到预设作业目标时,优先调整扫刷接触载荷、扫刷转速或车辆速度。
23、优选的,当路沿空间模型连续稳定、感知置信度处于可靠范围、车辆定位状态正常、扫刷机械状态稳定且未检测到异常冲击时,利用清扫结果修正有效清扫边界查找表中的局部参数;
24、当感知置信度降低、传感器受到污染、路沿空间模型发生跳变或者扫刷受到异常冲击时,保持上一可靠状态的模型参数;
25、当路沿空间状态或扫刷关键机械状态无法可靠获得时,退出贴边清扫工况。
26、有益效果:
27、1、本发明通过建立前置作业基准点动态映射关系,将车辆后轴中心的运动状态实时转换为前置扫刷实际作业位置,使贴边规划基准直接对应扫刷实际作业区域。
28、2、本发明通过采集液压压力、液压缸位移、扫刷支承机构角度、扫刷转速或扫刷驱动电机负载以及扫刷安装座姿态,结合刷毛磨损状态和扫刷作业状态建立实际有效清扫边界,使作业边界随扫刷机械状态变化进行更新。
29、3、本发明通过融合路沿三维空间位置、有效清扫边界距离估计不确定度、车辆纵向速度、系统等效延迟及机械结构安全项建立动态安全贴边距离,并将前置扫刷作业基准点作为动态边界判断对象。
30、4、本发明通过预测系统等效延迟期间前置扫刷作业点的横向位置变化,并结合车辆外环与扫刷内环协同控制,将车辆横向运动与扫刷作业状态纳入同一控制过程。
31、5、本发明通过将清扫结果按照采样时间戳和车辆历史位姿映射至道路局部空间坐标,并根据满足更新条件的清扫结果修正有效清扫边界查找表参数,同时在感知异常、传感器污染、路沿空间模型跳变或异常冲击状态下保持上一可靠参数,形成清扫结果反馈与边界模型更新闭环。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com