一种纯电动车厢可卸式垃圾车箱体自动对接控制方法与流程
本申请涉及垃圾车箱体对接,具体涉及一种纯电动车厢可卸式垃圾车箱体自动对接控制方法。
背景技术:
1、随着新能源环卫车辆的发展,纯电动车厢可卸式垃圾车因其噪音低、零排放、驾驶舒适等优点,在城市垃圾收运体系中得到日益广泛的应用。为提升作业自动化水平和效率,纯电动车厢可卸式垃圾车逐渐配备自动对接功能。
2、纯电动车厢可卸式垃圾车主要包括车辆底盘、拉臂执行机构、箱体及控制系统。其中,拉臂执行机构是关键,通常由伸缩臂、主臂、抓钩及翻转架等组成,用于实现箱体的装卸。箱体为独立承载垃圾的容器,其前端顶部设有钩环。在自动对接过程中,车辆倒车接近箱体,拉臂执行机构动作,使抓钩与箱体上的钩环对接,随后通过伸缩、提升、翻转等一系列动作,将箱体拉起并锁止在车辆底盘上。
3、现有的自动对接系统通常采用视觉传感器、激光雷达等环境感知单元,首先识别垃圾箱体及钩环的位置,引导车辆进行粗定位。随后,在精对准阶段,控制系统根据摄像头获取的抓钩与钩环之间的空间位置偏差,实时计算运动轨迹并控制拉臂执行机构动作,使抓钩逐渐靠近并对准钩环,直至完成初步接触。
4、然而,现有的自动对接控制策略的核心控制逻辑是持续最小化抓钩与钩环之间的空间位置误差。在抓钩接近钩环的阶段表现良好,但一旦抓钩与钩环发生物理接触,由于钩环具有一定的空间尺寸,且接触面的几何关系复杂,基于视觉反馈的相同的相对位置关系可能对应着截然不同的机械接触状态。
5、抓钩与钩环接触后的机械状态至少包括:抓钩开口与钩环轴线对齐、抓钩与钩环外表面发生干涉阻挡以及抓钩部分嵌入但未完全到位。现有技术难以区分不同的机械状态,进而无法选择与之匹配的控制策略。例如,当发生外壁碰撞时,可能因未识别出阻挡约束而继续执行进入指令,导致抓钩持续施加载荷,引发机械冲击和安全隐患;反之,当抓钩开口与钩环轴线对齐时,系统又可能因视觉误差或保守策略而误判为卡滞并提前停止运动,降低了自动对接的成功率与效率。
6、因此,现有自动对接技术将接触过程视为一个单一的、连续的位置趋近过程,缺乏对接触后复杂机械状态的感知与辨识,进而导致纯电动车厢可卸式垃圾车箱体自动对接控制的准确性降低。
技术实现思路
1、本申请提供了一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,以解决由于无法识别接触机械状态而导致的对接准确性低、可靠性差的问题。
2、本申请提供了一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,包括:s1,获取垃圾箱挂环在当前车辆状态下相对于车辆执行坐标系的实时位置,根据垃圾箱挂环的实时位置与抓钩空间位置之间的位置偏差,生成初始运动控制指令,协同控制车辆及拉臂动作使抓钩进入预设接触区域;s2,在抓钩进入预设接触区域后,同步获取包括液压响应数据、执行响应数据和空间运动数据的多源响应数据,并根据多源响应数据判断抓钩与挂环是否发生首次机械接触;s3,在检测到首次机械接触后,根据多源响应数据识别当前机械接触状态,并基于划分出的接触状态及位置偏差生成动态控制指令,以控制车辆及拉臂执行机构执行相应的对接动作,机械接触状态包括阻挡接触状态、边缘接触状态或导入接触状态;s4,在检测到抓钩进入对接确认阶段后,基于承载响应判定抓钩与挂环是否形成有效承载连接,若未形成有效承载连接,则返回接触状态识别阶段,根据多源响应数据重新确定当前机械接触状态,并重新生成控制指令。
3、本发明实施例提供的技术方案所实现的有益效果至少包括:
4、(1)通过同步获取液压响应数据、执行响应数据以及空间运动数据,并根据多源响应数据判断抓钩与挂环之间是否发生首次机械接触,使控制系统能够在空间位置判断基础上进一步结合机械响应信息确定实际接触时刻,避免仅依据视觉检测结果进行控制时因遮挡、误差或延迟导致接触判断不准确的问题,然后根据液压压力变化特征、位移响应特征以及抓钩与挂环之间的相对运动趋势,将机械接触状态划分为阻挡接触状态、边缘接触状态以及导入接触状态,使系统能够区分抓钩与挂环接触后的不同受力和运动状态,避免现有控制方式无法判断接触类型而采用相同动作策略的问题,最后针对不同接触状态分别执行退出调整、低速试探以及保持导入控制,使抓钩能够根据实际机械状态选择对应运动方式,减少外壁碰撞导致的卡滞以及有效导入状态下的误停止,提高自动对接过程的适应能力和成功率。
5、(2)通过检测控制指令输出状态、执行机构位移响应以及液压压力变化率,判断抓钩与挂环之间是否发生首次机械接触,避免仅根据空间距离变化判断接触过程时,由于视觉误差或遮挡导致接触状态判断错误,然后通过控制拉臂执行机构执行微加载校验动作,并同步检测液压压力响应、抓钩位移响应以及箱体随动响应,对抓钩与挂环之间是否形成承载连接进行进一步确认,能够识别抓钩未完全进入、搭接异常等未可靠挂接状态,最后通过在未形成有效承载连接时返回接触状态识别阶段重新确定机械接触状态,使自动对接过程形成基于状态反馈的闭环调整,减少一次动作完成后无法纠正异常挂接的问题,提高自动挂接可靠性。
6、(3)通过建立环境感知坐标系与车辆执行坐标系之间的固定刚体变换关系,该变换参数通过标定获得且在对接作业过程中保持不变,使垃圾箱挂环位置的检测解算均在车体执行坐标系下完成,不受车辆整体姿态变化的影响,然后通过获取拉臂执行机构伸缩油缸行程和举升油缸行程,并根据拉臂运动关系计算抓钩末端空间位置,使控制系统能够直接获得实际执行端的位置状态,避免仅依据车辆整体位置判断挂接位置造成抓钩位置偏差的问题,最后根据挂环与抓钩末端之间的位置偏差生成车辆底盘和拉臂执行机构的初始运动控制指令,使车辆运动与拉臂运动能够共同完成空间调整,提高抓钩末端与挂环之间的位置匹配精度,减少重复调整过程。
7、应当理解,本部分所描述的内容并非旨在标识本发明的实施例的关键或重要特征,也不用于限制本发明的范围。
1.一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述方法包括:
2.根据权利要求1所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述获取垃圾箱挂环在当前车辆状态下相对于车辆执行坐标系的实时位置,包括:
3.根据权利要求1所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述生成初始运动控制指令,包括:
4.根据权利要求1所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述同步获取液压响应数据、执行响应数据和空间运动数据,包括:
5.根据权利要求4所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述根据多源响应数据判断抓钩与挂环是否发生首次机械接触,包括:
6.根据权利要求5所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述阻挡接触状态的具体判定流程为:
7.根据权利要求5所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述边缘接触状态的具体判定流程为:
8.根据权利要求5所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述导入接触状态的具体判定流程为:
9.根据权利要求1所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述基于承载响应判定抓钩与挂环是否形成有效承载连接,包括:
10.根据权利要求1所述的一种纯电动车厢可卸式垃圾车箱体自动对接控制方法,其特征在于,所述协同控制车辆及拉臂动作使抓钩进入预设接触区域,之前还包括基于箱体规格的连接轨迹自适应控制步骤:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com