[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] 以上所述是本发明的优选实施方式,应当指出,尽管已描述了本发明的优选实施例,但对于本技术领域的普通技术人员来说,一旦得知了本发明的基本创造性概念,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。