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