首页 > 专利 > 深知智能科技(金华)有限公司 > 一种平地机工作装置作业姿态自动调整控制方法及系统专利详情

一种平地机工作装置作业姿态自动调整控制方法及系统   0    0

实质审查 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2019-12-03
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2020-04-17
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2039-12-03
基本信息
有效性 实质审查 专利类型 发明专利
申请号 CN201911223838.6 申请日 2019-12-03
公开/公告号 CN110905021A 公开/公告日 2020-03-24
授权日 预估到期日 2039-12-03
申请年 2019年 公开/公告年 2020年
缴费截止日
分类号 E02F3/84E02F9/20 主分类号 E02F3/84
是否联合申请 独立申请 文献类型号 A
独权数量 1 从权数量 6
权利要求数量 7 非专利引证数量 0
引用专利数量 6 被引证专利数量 1
非专利引证
引用专利 KR20150137138A、CN105706630A、US2016273196A1、CN206346251U、CN109631890A、CN110056026A 被引证专利
专利权维持 99 专利申请国编码 CN
专利事件 事务标签 公开、实质审查
申请人信息
申请人 第一申请人
专利权人 深知智能科技(金华)有限公司 当前专利权人 深知智能科技(金华)有限公司
发明人 韩慧芳、曹显利 第一发明人 韩慧芳
地址 浙江省金华市婺城区三江街道义乌街1191号南市小区28幢4单元301 邮编 321013
申请人数量 1 发明人数量 2
申请人所在省 浙江省 申请人所在市 浙江省金华市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
广州市红荔专利代理有限公司 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
胡昌国
摘要
本发明提供一种平地机工作装置作业姿态自动调整控制方法及系统,所述方法包括:在平地机开始工作后,获取平地机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述平地机工作装置的姿态测量值;实时计算出平地机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成平地机工作装置的控制信号;根据所述控制信号实时调整平地机工作装置的姿态,使得平地机工作装置的姿态变化保持在预设范围内。本发明可根据平地机行驶路面的变化,实时调整平地机工作装置的姿态,使得平地机在行驶过程中保持工作装置角度对路面颠簸的跟随控制,以抵消路面颠簸对工作装置姿态的影响。
  • 摘要附图
    一种平地机工作装置作业姿态自动调整控制方法及系统
  • 说明书附图:图1
    一种平地机工作装置作业姿态自动调整控制方法及系统
  • 说明书附图:图2
    一种平地机工作装置作业姿态自动调整控制方法及系统
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2020-04-17 实质审查的生效 IPC(主分类): E02F 3/84 专利申请号: 201911223838.6 申请日: 2019.12.03
2 2020-03-24 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.一种平地机工作装置作业姿态自动调整控制方法,其特征在于,包括:
在平地机开始工作后,获取平地机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述平地机工作装置的姿态测量值;
实时计算出所述平地机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述平地机工作装置的控制信号;
根据所述控制信号实时调整所述平地机工作装置的姿态,使得所述平地机工作装置的姿态变化保持在预设范围内;
根据所述差值生成所述平地机工作装置的控制信号,包括:
将所述差值的绝对值与预设阈值进行比较;
当所述差值的绝对值不大于预设阈值时,生成大小为零的控制信号;
当所述差值的绝对值大于预设阈值时,根据下式生成控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA;
其中,S表示控制信号,C为预设常数,ΔA表示所述平地机工作装置的姿态测量值与姿态初值的差值,P为预设控制参数。

2.如权利要求1所述的平地机工作装置作业姿态自动调整控制方法,其特征在于,所述获取平地机工作装置的姿态初值,具体为:
当所述平地机工作装置的直接或间接驱动油缸没有动作,所述平地机有行驶或转向动作,且保持预设时间时,获取所述平地机工作装置的姿态初值。

3.如权利要求1所述的平地机工作装置作业姿态自动调整控制方法,其特征在于,所述ΔA是一个离散量,记为ΔA(k);
所述U(ΔA)的算式经过离散化的计算式为:
U(ΔA(k))=P×ΔA(k);
其中,k为采样序号。

4.一种平地机工作装置作业姿态自动调整控制系统,其特征在于,包括:
检测模块,用于在平地机开始工作后,获取平地机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述平地机工作装置的姿态测量值;
控制模块,用于实时计算出所述平地机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述平地机工作装置的控制信号;
执行机构,用于根据所述控制信号实时调整所述平地机工作装置的姿态,使得所述平地机工作装置的姿态变化保持在预设范围内。
所述控制模块具体用于:
将所述差值的绝对值与预设阈值进行比较;
当所述差值的绝对值不大于预设阈值时,生成大小为零的控制信号;
当所述差值的绝对值大于预设阈值时,根据下式生成控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA;
其中,S表示控制信号,C为预设常数,ΔA表示所述平地机工作装置的姿态测量值与姿态初值的差值,P为预设控制参数。

5.如权利要求4所述的平地机工作装置作业姿态自动调整控制系统,其特征在于,所述检测模块包括铲刀角度传感器或铲刀油缸长度传感器。

6.如权利要求4所述的平地机工作装置作业姿态自动调整控制系统,其特征在于,所述控制模块包括集中式控制器、分布式控制器或远程控制器。

7.如权利要求4所述的平地机工作装置作业姿态自动调整控制系统,其特征在于,所述执行机构包括铲刀油缸或动臂油缸。
说明书

技术领域

[0001] 本发明涉及平地机控制技术领域,特别是指一种平地机工作装置作业姿态自动调整控制方法及系统。

背景技术

[0002] 平地机是一种土方机械,用于松散物料的平整、土地和道路的平整、修坡等场合,其工作装置包括铲刀、驱动油缸和附件等。
[0003] 平地机在作业工况下,由于行驶路面的颠簸不平,导致铲刀随整车一起颠簸,进而导致铲刀的作业表面起伏,影响了平地机的工作效率,也影响平地机工作质量。
[0004] 而目前现有技术中并没有一套切实可行的控制方案可以对平地机的工作装置的姿态进行主动实时控制,以抵消路面颠簸对平地机铲刀的影响,尤其是抵消路面颠簸对平地机铲刀角度的影响,从而解决平地机工作过程中整机、尤其是铲刀随行驶路面一起颠簸的问题。

发明内容

[0005] 本发明要解决的技术问题是提供一种平地机工作装置作业姿态自动调整控制方法及系统,解决平地机工作过程中整机、尤其是铲刀随行驶路面一起颠簸的问题,实现对平地机的工作装置的姿态进行主动实时控制,以抵消路面颠簸对平地机铲刀的影响,尤其是抵消路面颠簸对平地机铲刀角度的影响。
[0006] 为解决上述技术问题,本发明提供如下技术方案:
[0007] 一种平地机工作装置作业姿态自动调整控制方法,包括:
[0008] 在平地机开始工作后,获取平地机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述平地机工作装置的姿态测量值;
[0009] 实时计算出所述平地机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述平地机工作装置的控制信号;
[0010] 根据所述控制信号实时调整所述平地机工作装置的姿态,使得所述平地机工作装置的姿态变化保持在预设范围内。
[0011] 其中,所述获取平地机工作装置的姿态初值,具体为:
[0012] 当所述平地机工作装置的直接或间接驱动油缸没有动作,所述平地机有行驶或转向动作,且保持预设时间时,获取所述平地机工作装置的姿态初值。
[0013] 其中,根据所述差值生成所述平地机工作装置的控制信号,包括:
[0014] 将所述差值的绝对值与预设阈值进行比较;
[0015] 当所述差值的绝对值不大于预设阈值时,生成大小为零的控制信号;
[0016] 当所述差值的绝对值大于预设阈值时,根据下式生成控制信号:
[0017] S=C×U(ΔA);
[0018] U(ΔA)=P×ΔA;
[0019] 其中,S表示控制信号,C为预设常数,ΔA表示所述平地机工作装置的姿态测量值与姿态初值的差值,P为预设控制参数。
[0020] 其中,所述ΔA是一个离散量,记为ΔA(k);
[0021] 所述U(ΔA)的算式经过离散化的计算式为:
[0022] U(ΔA(k))=P×ΔA(k);
[0023] 其中,k为采样序号。
[0024] 相应地,为解决上述技术问题,本发明还提供如下技术方案:
[0025] 一种平地机工作装置作业姿态自动调整控制系统,包括:
[0026] 检测模块,用于在平地机开始工作后,获取平地机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述平地机工作装置的姿态测量值;
[0027] 控制模块,用于实时计算出所述平地机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述平地机工作装置的控制信号;
[0028] 执行机构,用于根据所述控制信号实时调整所述平地机工作装置的姿态,使得所述平地机工作装置的姿态变化保持在预设范围内。
[0029] 其中,所述检测模块包括铲刀角度传感器或铲刀油缸长度传感器。
[0030] 其中,所述控制模块包括集中式控制器、分布式控制器或远程控制器。
[0031] 其中,所述执行机构包括铲刀油缸或动臂油缸。
[0032] 其中,所述控制模块具体用于:
[0033] 将所述差值的绝对值与预设阈值进行比较;
[0034] 当所述差值的绝对值不大于预设阈值时,生成大小为零的控制信号;
[0035] 当所述差值的绝对值大于预设阈值时,根据下式生成控制信号:
[0036] S=C×U(ΔA);
[0037] U(ΔA)=P×ΔA;
[0038] 其中,S表示控制信号,C为预设常数,ΔA表示所述平地机工作装置的姿态测量值与姿态初值的差值,P为预设控制参数。
[0039] 本发明的上述技术方案的有益效果如下:
[0040] 本发明的自动调整控制方法及系统可以根据平地机行驶路面的变化,实时调整平地机工作装置的姿态,使得平地机在行驶过程中保持铲刀角度对路面颠簸的跟随控制。解决了平地机工作过程中整机、尤其是铲刀随行驶路面一起颠簸的问题,实现了对平地机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对平地机铲刀的影响,尤其是抵消了路面颠簸对平地机铲刀角度的影响。

实施方案

[0043] 为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述。
[0044] 第一实施例
[0045] 本实施例提供一种平地机工作装置作业姿态自动调整控制方法,如图1所示,所述平地机工作装置作业姿态自动调整控制方法包括:
[0046] S1,在平地机开始工作后,获取平地机工作装置的姿态初值A0;并在获取姿态初值A0后实时采集平地机工作装置的姿态测量值A;
[0047] 需要说明的是,平地机工作装置的姿态初值A0的保存条件为:平地机工作装置的直接或间接驱动油缸没有动作(控制器无输出),平地机有行驶或转向动作,且保持预设时间;具体地,在本实施例中,该预设时间为3秒。
[0048] 平地机工作装置的姿态可以包括铲刀角度或铲刀油缸长度;通过采集铲刀角度或铲刀油缸长度,直接或间接计算得到铲刀的姿态。
[0049] 平地机开始工作后开始运输,在运输过程中,铲刀的角度应该保持不变,以防铲刀作业表面波动。但是平地机在实际行驶过程中,由于行驶路面不平、上下坡等原因,平地机整机随路面而颠簸难以避免,而颠簸导致铲刀作业表面波动。实际工作中,平地机颠簸的主要成分来自于平地机整机绕垂直于行驶方向上的水平轴线的转动,该转动导致铲刀倾角的变化,进而导致物料洒落。因此,在本实施例中主要是获取铲刀的倾角信息。
[0050] S2,实时计算出平地机工作装置的姿态测量值A与姿态初值A0的差值ΔA,并根据姿态测量值与姿态初值的差值ΔA生成平地机工作装置的控制信号S;
[0051] 需要说明的是,平地机在行驶过程中,虽然控制铲刀倾角的所有执行机构都没有动作,但是路面不平导致整机颠簸而改变了铲刀的实际倾角,使得平地机在行驶过程中的实际倾角与初始倾角出现差值。本实施例方案的目标就是消除铲刀倾角的差值,使得平地机在行驶过程中,铲刀的实际倾角保持稳定;
[0052] 具体地,本实施例中的S2包括:
[0053] S21,计算出平地机工作装置的姿态测量值A与姿态初值A0的差值ΔA;当ΔA在一个小范围内波动时,对铲刀的影响很小,此时可以不必对此进行控制,因此,需要预设一个预设阈值A1;具体地,本实施例中,A1=3°。
[0054] S22,判断ΔA的绝对值是否大于预设阈值A1;
[0055] S23,当ΔA的绝对值不大于A1时,令U(ΔA)=0;
[0056] S24,当ΔA的绝对值大于A1时,说明此时铲刀的角度偏差已经很明显,需要主动进行控制;
[0057] 此时,U(ΔA)=P×ΔA;具体地,P=P1=2;
[0058] S25,根据U(ΔA),计算出工作装置驱动油缸的电磁阀控制信号S:
[0059] S=C×U(ΔA);
[0060] 其中,C为预设常数,具体地,在本实施例中,取C=1。
[0061] 其中,需要说明的是,对于ΔA,在实际运算中,由于测量值A是经过控制器采样得到的数据,因而是一个离散量。由A计算得出的ΔA也是一个离散量,记为ΔA(k)。所以,上面U(ΔA)的算式在实际应用中经过离散化的计算式为:
[0062] U(ΔA(k))=P×ΔA(k);
[0063] 其中,k为采样序号。
[0064] S3,根据控制信号实时调整平地机工作装置的姿态,使得平地机工作装置的姿态变化保持在预设范围内。
[0065] 需要说明的是,上述步骤是通过控制信号对铲刀的执行机构(包括铲刀油缸)进行输出控制,通过对铲刀倾角的主动控制,抵消路面颠簸对铲刀倾角的影响,以此实现铲刀实际倾角在行驶过程中的稳定。
[0066] 本实施例的自动调整控制方法可以根据平地机行驶路面的变化,实时调整平地机工作装置的姿态,使得平地机在行驶过程中保持铲刀角度对路面颠簸的跟随控制。解决了平地机工作过程中整机、尤其是铲刀随行驶路面一起颠簸的问题,实现了对平地机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对平地机铲刀的影响,尤其是抵消了路面颠簸对平地机铲刀角度的影响。
[0067] 第二实施例
[0068] 本实施例提供一种平地机工作装置作业姿态自动调整控制系统,如图2所示,所述平地机工作装置作业姿态自动调整控制系统包括:
[0069] 检测模块,用于在平地机开始工作后,获取平地机工作装置的姿态初值A0;并在获取A0后实时采集平地机工作装置的姿态测量值A;
[0070] 控制模块,用于实时计算出平地机工作装置的姿态测量值A与姿态初值A0的差值ΔA,并根据ΔA生成平地机工作装置的控制信号S;
[0071] 执行机构,用于根据控制信号S实时调整平地机工作装置的姿态,使得平地机工作装置的姿态变化保持在预设范围内。
[0072] 具体地,在本实施例中,上述检测模块为工作装置位置传感器,可以包括铲刀角度传感器或铲刀油缸长度传感器。通过测量铲刀的倾角或所有铲刀驱动油缸的位置,直接或间接计算得到铲刀的姿态;
[0073] 平地机工作装置的姿态初值A0的保存条件为:平地机工作装置的直接或间接驱动油缸没有动作(控制器没有信号输出),平地机有行驶或转向动作,且保持预设时间;具体地,在本实施例中,该预设时间为3秒。
[0074] 考虑到实际工作中,平地机颠簸的主要成分来自于平地机整机绕垂直于行驶方向上的水平轴线的转动,该转动导致铲刀倾角的变化,进而导致物料洒落。因此,本实施例采用铲刀角度传感器获得铲刀的倾角信息。
[0075] 控制模块可以包括集中式控制器、分布式控制器或远程控制器,本实施例采用集中式控制器,其具体用于:
[0076] 计算出平地机工作装置的姿态测量值A与姿态初值A0的差值ΔA;当ΔA在一个小范围内波动时,对铲刀的影响很小,此时可以不必对此进行控制,因此,需要预设一个预设阈值A1;具体地,本实施例中,A1=3°。
[0077] 判断ΔA的绝对值是否大于预设阈值A1;
[0078] 当ΔA的绝对值不大于A1时,令U(ΔA)=0;
[0079] 当ΔA的绝对值大于A1时,说明此时铲刀的角度偏差已经很明显,需要主动进行控制;
[0080] 此时,U(ΔA)=P×ΔA;具体地,P=P1=2;
[0081] 根据U(ΔA),计算出工作装置驱动油缸的电磁阀控制信号S:
[0082] S=C×U(ΔA);
[0083] 其中,C为预设常数,具体地,在本实施例中,取C=1。
[0084] 上述执行机构为工作装置驱动油缸,用于直接或间接驱动平地机铲刀动作,可以包括铲刀油缸等。
[0085] 本实施例的自动调整控制系统可以根据平地机行驶路面的变化,实时调整平地机工作装置的姿态,使得平地机在行驶过程中保持铲刀角度对路面颠簸的跟随控制。解决了平地机工作过程中整机、尤其是铲刀随行驶路面一起颠簸的问题,实现了对平地机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对平地机铲刀的影响,尤其是抵消了路面颠簸对平地机铲刀角度的影响。
[0086] 此外,需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
[0087] 而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。
[0088] 还需要说明的是,本领域内的技术人员应明白,本发明实施例的实施例可提供为方法、装置或计算机程序产品。而且,本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
[0089] 本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
[0090] 这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上,使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
[0091] 以上所述是本发明的优选实施方式,应当指出,尽管已描述了本发明的优选实施例,但对于本技术领域的普通技术人员来说,一旦得知了本发明的基本创造性概念,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。

附图说明

[0041] 图1为本发明的平地机工作装置作业姿态自动调整控制方法的流程图;
[0042] 图2为本发明的平地机工作装置作业姿态自动调整控制系统的框图。
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号