CN110731164B - 一种收割机工作装置作业姿态自动调整控制方法及系统 - Google Patents
一种收割机工作装置作业姿态自动调整控制方法及系统 Download PDFInfo
- Publication number
- CN110731164B CN110731164B CN201911224959.2A CN201911224959A CN110731164B CN 110731164 B CN110731164 B CN 110731164B CN 201911224959 A CN201911224959 A CN 201911224959A CN 110731164 B CN110731164 B CN 110731164B
- Authority
- CN
- China
- Prior art keywords
- harvester
- value
- working device
- attitude
- delta
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000005259 measurement Methods 0.000 claims abstract description 37
- 230000008859 change Effects 0.000 claims abstract description 16
- 238000003306 harvesting Methods 0.000 claims abstract description 14
- 230000009471 action Effects 0.000 claims description 10
- 230000007246 mechanism Effects 0.000 claims description 7
- 238000001514 detection method Methods 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000008569 process Effects 0.000 abstract description 21
- 238000010586 diagram Methods 0.000 description 10
- 238000004590 computer program Methods 0.000 description 7
- 238000005520 cutting process Methods 0.000 description 6
- 238000003860 storage Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 229920000742 Cotton Polymers 0.000 description 1
- 241000219146 Gossypium Species 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 241000209140 Triticum Species 0.000 description 1
- 235000021307 Triticum Nutrition 0.000 description 1
- 240000008042 Zea mays Species 0.000 description 1
- 235000005824 Zea mays ssp. parviglumis Nutrition 0.000 description 1
- 235000002017 Zea mays subsp mays Nutrition 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 235000005822 corn Nutrition 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Lifting Devices For Agricultural Implements (AREA)
- Harvester Elements (AREA)
Abstract
本发明提供一种收割机工作装置作业姿态自动调整控制方法及系统，所述方法包括：在收割机开始收割作业后，获取收割机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述收割机工作装置的姿态测量值；实时计算出收割机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成收割机工作装置的控制信号；根据所述控制信号实时调整收割机工作装置的姿态，使得收割机工作装置的姿态变化保持在预设范围内。本发明可根据收割机行驶路面的变化，实时调整收割机工作装置的姿态，使得收割机在行驶过程中保持工作装置角度对路面颠簸的跟随控制，以抵消路面颠簸对工作装置姿态的影响。
Description
技术领域
本发明涉及收割机控制技术领域，特别是指一种收割机工作装置作业姿态自动调整控制方法及系统。
背景技术
收割机是一种农作物收获机械，用于水稻、小麦、玉米、棉花、饲料等农作物收获场合，其工作装置包括割台、输送装置、提升油缸和附件等。
收割机在收割作业工况下，由于田间行驶路面的起伏不平，导致割台的角度随收割机一起波动，进而导致收割高度变大或变小，影响了收割机的工作效率，也可能导致农作物的浪费。
而目前现有技术中并没有一套切实可行的控制方案可以对收割机的工作装置的姿态进行主动实时控制，以抵消路面颠簸对收割机割台姿态的影响，尤其是抵消路面颠簸对收割机割台角度的影响，从而解决收割机工作过程中整机、尤其是割台随行驶路面一起颠簸的问题。
发明内容
本发明要解决的技术问题是提供一种收割机工作装置作业姿态自动调整控制方法及系统，解决收割机工作过程中整机、尤其是割台随行驶路面一起颠簸的问题，实现对收割机的工作装置的姿态进行主动实时控制，以抵消路面颠簸对收割机割台的影响，尤其是抵消路面颠簸对收割机割台角度的影响。
为解决上述技术问题，本发明提供如下技术方案：
一种收割机工作装置作业姿态自动调整控制方法，包括：
在收割机开始工作后，获取收割机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述收割机工作装置的姿态测量值；
实时计算出所述收割机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述收割机工作装置的控制信号；
根据所述控制信号实时调整所述收割机工作装置的姿态，使得所述收割机工作装置的姿态变化保持在预设范围内。
其中，所述获取收割机工作装置的姿态初值，具体为：
当所述收割机工作装置的直接或间接驱动油缸没有动作，所述收割机有行驶动作，且保持预设时间时，获取所述收割机工作装置的姿态初值。
其中，根据所述差值生成所述收割机工作装置的控制信号：
S=C×U(ΔA)；
U(ΔA)=P×ΔA+D×dΔA/dt；
其中，S表示控制信号，C为预设常数，ΔA表示所述收割机工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，t为获取收割机工作装置姿态测量值与获取收割机工作装置姿态初值的时间差。
其中，所述ΔA是一个离散量，记为ΔA(k)；
所述U(ΔA)的算式经过离散化的计算式为：
U(ΔA(k))=P×ΔA(k)+D×[ΔA(k)- ΔA(k-1)]；
其中，k为采样序号；
为了提高运算速度，进一步将上式进行优化；
令Δ(k)= ΔA(k)- ΔA(k-1)，ΔU=U(ΔA(k))- U(ΔA(k-1))，则ΔU表示为：
ΔU= P×Δ(k)+D×[Δ(k)-Δ(k-1)]；
所以，U(ΔA(k))按照以下方法进行输出：
U(ΔA(k))= U(ΔA(k-1))+ ΔU。
其中，所述ΔU的算式中，对短时高幅干扰的输出不足，主要体现为D×[Δ(k)-Δ(k-1)]部分的作用时间过短而且作用强度过大，导致控制效果不理想，因此对ΔU进一步优化为：
ΔU= P×Δ(k)+D×[Δ(k)-Δ(k-1)]+DT×[Δ(k-1)-Δ(k-2)]；
其中，DT为预设的常数。
其中，将所述差值的绝对值与第一预设阈值进行比较；
当所述差值的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述差值的绝对值大于第一预设阈值时，所述方法还包括：实时采集所述收割机的车速测量值；
计算出所述差值与所述收割机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；
当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。
相应地，为解决上述技术问题，本发明还提供如下技术方案：
一种收割机工作装置作业姿态自动调整控制系统，包括：
检测模块，用于在收割机开始收割作业后，获取收割机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述收割机工作装置的姿态测量值；
控制模块，用于实时计算出所述收割机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述收割机工作装置的控制信号；
执行机构，用于根据所述控制信号实时调整所述收割机工作装置的姿态，使得所述收割机工作装置的姿态变化保持在预设范围内。
其中，所述检测模块包括割台角度传感器或割台油缸长度传感器。
其中，所述控制模块包括集中式控制器、分布式控制器或远程控制器。
其中，所述执行机构包括割台油缸或动臂油缸。
其中，所述控制模块具体用于：
根据所述差值生成所述收割机工作装置的控制信号：
S=C×U(ΔA)；
U(ΔA)=P×ΔA+D×dΔA/dt；
其中，S表示控制信号，C为预设常数，ΔA表示所述收割机工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，t为获取收割机工作装置姿态测量值与获取收割机工作装置姿态初值的时间差。
其中，所述系统还包括车速传感器，所述车速传感器用于实时采集所述收割机的车速测量值；所述控制模块还用于：
将所述差值的绝对值与第一预设阈值进行比较；
当所述差值的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述差值的绝对值大于第一预设阈值时，计算出所述差值与所述收割机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；
当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。
本发明的上述技术方案的有益效果如下：
本发明的自动调整控制方法及系统可以根据收割机行驶路面的变化，实时调整收割机工作装置的姿态，使得收割机在行驶过程中保持割台角度对路面颠簸的跟随控制。解决了收割机工作过程中整机，尤其是割台随行驶路面一起波动的问题，实现了对收割机的工作装置的姿态进行主动实时控制，抵消了路面颠簸对收割机割台的影响，尤其是抵消了路面颠簸对收割机割台角度的影响。
附图说明
图1为本发明的收割机工作装置作业姿态自动调整控制方法的流程图；
图2为本发明的收割机工作装置作业姿态自动调整控制系统的框图；
图3为本发明的收割机工作装置作业姿态自动调整控制系统的另一框图。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述。
第一实施例
本实施例提供一种收割机工作装置作业姿态自动调整控制方法，如图1所示，所述收割机工作装置作业姿态自动调整控制方法包括：
S1，在收割机开始收割作业后，获取收割机工作装置的姿态初值A0；并在获取姿态初值A0后实时采集收割机工作装置的姿态测量值A；
需要说明的是，收割机工作装置的姿态初值A0的保存条件为：收割机工作装置的直接或间接驱动油缸没有动作（控制器无输出），收割机有行驶动作，且保持预设时间；具体地，在本实施例中，该预设时间为3秒。
收割机工作装置的姿态可以包括割台角度或割台油缸长度；通过采集割台角度或割台油缸长度，直接或间接计算得到割台的姿态。
收割机开始收割作业后开始运输，在作业过程中，割台的角度应该保持不变，以防割台的收割高度变化。但是收割机在实际行驶过程中，由于行驶路面不平、上下坡等原因，收割机整机随路面而颠簸难以避免，而颠簸导致割台收割高度的变化。实际工作中，收割机颠簸的主要成分来自于收割机整机绕垂直于行驶方向上的水平轴线的转动，该转动导致割台倾角的变化，进而导致收割高度变化。因此，在本实施例中主要是获取割台的倾角信息。
S2，实时计算出收割机工作装置的姿态测量值A与姿态初值A0的差值ΔA，并根据姿态测量值与姿态初值的差值ΔA生成收割机工作装置的控制信号S；
需要说明的是，收割机在行驶过程中，虽然控制割台倾角的所有执行机构都没有动作，但是路面不平导致整机颠簸而改变了割台的实际倾角，使得收割机在行驶过程中的实际倾角与初始倾角出现差值。本实施例方案的目标就是消除割台倾角的差值，使得收割机在行驶过程中，割台的实际倾角保持稳定。
具体地，本实施例中的S2包括：
S21，计算出收割机工作装置的姿态测量值A与姿态初值A0的差值ΔA；
S22，判断ΔA的绝对值是否大于第一预设阈值A1，当ΔA在一个小范围内波动时，对割台的影响很小，因此，需要预设一个第一预设阈值A1；具体地，本实施例中，A1=3°。
S23，当ΔA的绝对值不大于A1时，，采用第三套控制参数（P3，D3=0），具体地，本实施例中，P3=1；
此时，U(ΔA)=P3×ΔA；
S24，当ΔA的绝对值大于A1时，说明此时割台的角度偏差已经很明显，需要主动进行控制，而且考虑到在不同行驶速度下，相同的ΔA代表的含义并不相同：同等ΔA下，车速V越低，说明路面颠簸情况越大，对割台倾角的影响也越大，因此，需要考虑车速V的影响，进一步执行以下流程：
S25，计算ΔA与收割机相应时刻的车速测量值V的比值B；并判断B的绝对值是否大于第二预设阈值B1；具体地，本实施例中，B1=1°km/h。
S26，当B的绝对值大于B1时，采用第一套控制参数（P1，D1），具体地，本实施例中，P1=2，D1=5；
此时，U(ΔA)=P1×ΔA+D1×dΔA/dt；
S27,当B的绝对值不大于B1时，按照第二套控制参数（P2，D2=0），具体地，本实施例中，P2=3；
此时，U(ΔA)=P2×ΔA；
S28,根据U(ΔA)，计算出工作装置驱动油缸的电磁阀控制信号S：
S=C×U(ΔA)
其中， C为预设常数，具体地，在本实施例中，取C=1。
其中，需要说明的是，对于ΔA，在实际运算中，由于测量值A是经过控制器采样得到的数据，因而是一个离散量。由A计算得出的ΔA也是一个离散量，记为ΔA(k)。所以，上面U(ΔA)的算式在实际应用中经过离散化的计算式为：
U(ΔA(k))=P×ΔA(k)+D×[ΔA(k)- ΔA(k-1)]；
其中，k为采样序号；
为了提高运算速度，进一步将上式进行优化：
令Δ(k)= ΔA(k)- ΔA(k-1)，ΔU=U(ΔA(k))- U(ΔA(k-1))，则ΔU可表示为：
ΔU= P×Δ(k)+D×[Δ(k)-Δ(k-1)]
所以，U(ΔA(k))可以按照以下方法进行输出：
U(ΔA(k))= U(ΔA(k-1))+ ΔU。
在实际应用中，上述算法对短时高幅干扰的输出不足，主要体现为D×[Δ(k)-Δ(k-1)]部分的作用时间过短而且作用强度过大，导致控制效果不理想。为了克服上述缺点，对ΔU进行优化为：
ΔU= P×Δ(k)+D×[Δ(k)-Δ(k-1)]+DT×[Δ(k-1)-Δ(k-2)]
其中，DT为预设的常数。
S3，根据控制信号实时调整收割机工作装置的姿态，使得收割机工作装置的姿态变化保持在预设范围内。
需要说明的是，上述步骤是通过控制信号对割台的执行机构（包括割台油缸或动臂油缸等）进行输出控制，通过对割台倾角的主动控制，抵消路面颠簸对割台倾角的影响，以此实现割台实际倾角在行驶过程中的稳定。
本实施例的自动调整控制方法可以根据收割机行驶路面的变化，实时调整收割机工作装置的姿态，使得收割机在行驶过程中保持割台角度对路面颠簸的跟随控制。解决了收割机工作过程中整机、尤其是割台随行驶路面一起颠簸的问题，实现了对收割机的工作装置的姿态进行主动实时控制，抵消了路面颠簸对收割机割台的影响，尤其是抵消了路面颠簸对收割机割台角度的影响。
第二实施例
本实施例提供一种收割机工作装置作业姿态自动调整控制系统，如图2所示，所述收割机工作装置作业姿态自动调整控制系统包括：
检测模块，用于在收割机开始收割作业后，获取收割机工作装置的姿态初值A0；并在获取A0后实时采集收割机工作装置的姿态测量值A；
控制模块，用于实时计算出收割机工作装置的姿态测量值A与姿态初值A0的差值ΔA，并根据ΔA生成收割机工作装置的控制信号S；
执行机构，用于根据控制信号S实时调整收割机工作装置的姿态，使得收割机工作装置的姿态变化保持在预设范围内。
此外，如图3所示，本实施例的收割机工作装置作业姿态自动调整控制系统还包括车速传感器，所述车速传感器用于实时采集收割机的车速测量值。
具体地，在本实施例中，上述检测模块为工作装置位置传感器，可以包括割台角度传感器或割台油缸长度传感器。通过测量割台的倾角或所有割台驱动油缸的位置，直接或间接计算得到割台的姿态；
收割机工作装置的姿态初值A0的保存条件为：收割机工作装置的直接或间接驱动油缸没有动作（控制器没有信号输出），收割机有行驶或转向动作，且保持预设时间；具体地，在本实施例中，该预设时间为3秒。
考虑到实际工作中，收割机颠簸的主要成分来自于收割机整机绕垂直于行驶方向上的水平轴线的转动，该转动导致割台倾角的变化，进而导致割台高度变化。因此，本实施例采用割台角度传感器获得割台的倾角信息。
控制模块可以包括集中式控制器、分布式控制器或远程控制器，本实施例采用集中式控制器，其具体用于：
计算出收割机工作装置的姿态测量值A与姿态初值A0的差值ΔA；
判断ΔA的绝对值是否大于第一预设阈值A1，当ΔA在一个小范围内波动时，对割台的影响很小，因此，需要预设一个第一预设阈值A1；具体地，本实施例中，A1=3°。
当ΔA的绝对值不大于A1时，，采用第三套控制参数（P3，D3=0），具体地，本实施例中，P3=1；
此时，U(ΔA)=P3×ΔA；
当ΔA的绝对值大于A1时，说明此时割台的角度偏差已经很明显，需要主动进行控制，而且考虑到在不同行驶速度下，相同的ΔA代表的含义并不相同：同等ΔA下，车速V越低，说明路面颠簸情况越大，对割台倾角的影响也越大，因此，需要考虑车速V的影响，进一步执行以下流程：
计算ΔA与收割机相应时刻的车速测量值V的比值B；并判断B的绝对值是否大于第二预设阈值B1；具体地，本实施例中，B1=1°km/h。
当B的绝对值大于B1时，采用第一套控制参数（P1，D1），具体地，本实施例中，P1=2，D1=5；
U(ΔA)=P1×ΔA+D1×dΔA/dt；
当B的绝对值不大于B1时，按照第二套控制参数（P2，D2=0），具体地，本实施例中，P2=3；
此时，U(ΔA)=P2×ΔA；
根据U(ΔA)，计算出工作装置驱动油缸的电磁阀控制信号S：
S=C×U(ΔA)；
其中， C为预设常数，具体地，在本实施例中，取C=1。
上述执行机构为工作装置驱动油缸，用于直接或间接驱动收割机割台动作，可以包括割台油缸、动臂油缸等。
本实施例的自动调整控制系统可以根据收割机行驶路面的变化，实时调整收割机工作装置的姿态，使得收割机在行驶过程中保持割台角度对路面颠簸的跟随控制。解决了收割机工作过程中整机、尤其是割台随行驶路面一起颠簸的问题，实现了对收割机的工作装置的姿态进行主动实时控制，抵消了路面颠簸对收割机割台的影响，尤其是抵消了路面颠簸对收割机割台角度的影响。
此外，需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。
还需要说明的是，本领域内的技术人员应明白，本发明实施例的实施例可提供为方法、装置或计算机程序产品。而且，本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上，使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
以上所述是本发明的优选实施方式，应当指出，尽管已描述了本发明的优选实施例，但对于本技术领域的普通技术人员来说，一旦得知了本发明的基本创造性概念，在不脱离本发明所述原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。
Claims (10)
1.一种收割机工作装置作业姿态自动调整控制方法，其特征在于，包括：
在收割机开始收割作业后，获取收割机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述收割机工作装置的姿态测量值；
实时计算出所述收割机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述收割机工作装置的控制信号；
根据所述控制信号实时调整所述收割机工作装置的姿态，使得所述收割机工作装置的姿态变化保持在预设范围内；
根据所述差值生成所述收割机工作装置的控制信号：
S=C×U(ΔA)；
U(ΔA)=P×ΔA+D×dΔA/dt；
其中，S表示控制信号，C为预设常数，ΔA表示所述收割机工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，t为获取收割机工作装置姿态测量值与获取收割机工作装置姿态初值的时间差。
2.如权利要求1所述的收割机工作装置作业姿态自动调整控制方法，其特征在于，所述获取收割机工作装置的姿态初值，具体为：
当所述收割机工作装置的直接或间接驱动油缸没有动作，所述收割机有行驶或转向动作，且保持预设时间时，获取所述收割机工作装置的姿态初值。
3.如权利要求1所述的收割机工作装置作业姿态自动调整控制方法，其特征在于，
所述ΔA是一个离散量，记为ΔA(k)；
所述U(ΔA)的算式经过离散化的计算式为：
U(ΔA(k))=P×ΔA(k)+D×[ΔA(k)- ΔA(k-1)]；
其中，k为采样序号；
为了提高运算速度，进一步将上式进行优化；
令Δ(k)= ΔA(k)- ΔA(k-1)，ΔU=U(ΔA(k))- U(ΔA(k-1))，则ΔU表示为：
ΔU= P×Δ(k)+D×[Δ(k)-Δ(k-1)]；
所以，U(ΔA(k))按照以下方法进行输出：
U(ΔA(k))= U(ΔA(k-1))+ ΔU。
4.如权利要求3所述的收割机工作装置作业姿态自动调整控制方法，其特征在于，
所述ΔU的算式中，对短时高幅干扰的输出不足，导致控制效果不理想，因此对ΔU进一步优化为：
ΔU= P×Δ(k)+D×[Δ(k)-Δ(k-1)]+DT×[Δ(k-1)-Δ(k-2)]；
其中，DT为预设的常数。
5.如权利要求1所述的收割机工作装置作业姿态自动调整控制方法，其特征在于，
将所述差值的绝对值与第一预设阈值进行比较；
当所述差值的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述差值的绝对值大于第一预设阈值时，所述方法还包括：实时采集所述收割机的车速测量值；
计算出所述差值与所述收割机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；
当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。
6.一种收割机工作装置作业姿态自动调整控制系统，其特征在于，包括：
检测模块，用于在收割机开始收割作业后，获取收割机工作装置的姿态初值；并在获取所述姿态初值后实时采集所述收割机工作装置的姿态测量值；
控制模块，用于实时计算出所述收割机工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述收割机工作装置的控制信号；
执行机构，用于根据所述控制信号实时调整所述收割机工作装置的姿态，使得所述收割机工作装置的姿态变化保持在预设范围内；
所述控制模块具体用于：
根据所述差值生成所述收割机工作装置的控制信号：
S=C×U(ΔA)；
U(ΔA)=P×ΔA+D×dΔA/dt；
其中，S表示控制信号，C为预设常数，ΔA表示所述收割机工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，t为获取收割机工作装置姿态测量值与获取收割机工作装置姿态初值的时间差。
7.如权利要求6所述的收割机工作装置作业姿态自动调整控制系统，其特征在于，所述检测模块包括割台角度传感器或割台油缸长度传感器。
8.如权利要求6所述的收割机工作装置作业姿态自动调整控制系统，其特征在于，所述控制模块包括集中式控制器、分布式控制器或远程控制器。
9.如权利要求6所述的收割机工作装置作业姿态自动调整控制系统，其特征在于，所述执行机构包括割台油缸或动臂油缸。
10.如权利要求6所述的收割机工作装置作业姿态自动调整控制系统，其特征在于，所述系统还包括车速传感器，所述车速传感器用于实时采集所述收割机的车速测量值；所述控制模块还用于：
将所述差值的绝对值与第一预设阈值进行比较；
当所述差值的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述差值的绝对值大于第一预设阈值时，计算出所述差值与所述收割机相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；
当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；
当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P赋值，且D=0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911224959.2A CN110731164B (zh) | 2019-12-03 | 2019-12-03 | 一种收割机工作装置作业姿态自动调整控制方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911224959.2A CN110731164B (zh) | 2019-12-03 | 2019-12-03 | 一种收割机工作装置作业姿态自动调整控制方法及系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110731164A CN110731164A (zh) | 2020-01-31 |
| CN110731164B true CN110731164B (zh) | 2020-09-15 |
Family
ID=69274360
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911224959.2A Active CN110731164B (zh) | 2019-12-03 | 2019-12-03 | 一种收割机工作装置作业姿态自动调整控制方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110731164B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114531986B (zh) * | 2022-03-03 | 2023-08-11 | 星光农机股份有限公司 | 一种田间作业机具的耕深控制方法及装置 |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE3632416A1 (de) * | 1986-09-24 | 1988-04-07 | Schaeff Karl Gmbh & Co | Knickgelenktes arbeitsfahrzeug mit hoehenverstellbaren raedern |
| CN107258207A (zh) * | 2016-04-07 | 2017-10-20 | 苏州宝时得电动工具有限公司 | 割草机及传感器高度控制方法 |
| CN108668606A (zh) * | 2018-04-28 | 2018-10-19 | 温州中邦知识产权有限公司 | 一种市政智能绿化用切割机 |
| CN109089527A (zh) * | 2018-11-02 | 2018-12-28 | 江苏农牧科技职业学院 | 一种智能收割机割台水平升降控制系统及方法 |
| CN109397293A (zh) * | 2018-11-27 | 2019-03-01 | 上海机器人产业技术研究院有限公司 | 一种基于移动机器人的地面水平误差建模及补偿方法 |
| CN109917796A (zh) * | 2017-12-12 | 2019-06-21 | 财团法人工业技术研究院 | 移动载具、地面处理机具及其姿态调整方法 |
| CN110199663A (zh) * | 2019-04-09 | 2019-09-06 | 丰疆智能科技股份有限公司 | 自动收割机、割台自动调节系统及其方法 |
| CN110199664A (zh) * | 2019-04-09 | 2019-09-06 | 丰疆智能科技股份有限公司 | 可抬降割台的农割作业机器及其控制方法 |
| DE102019202950A1 (de) * | 2018-03-06 | 2019-09-12 | Deere & Company | Füllstanddetektion und steuerung |
| CN110450993A (zh) * | 2019-09-11 | 2019-11-15 | 北京邮电大学 | 零重力自调节气浮平台及零重力模拟系统 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9706709B2 (en) * | 2015-09-10 | 2017-07-18 | Deere & Company | Harvester fan speed control based on yield |
-
2019
- 2019-12-03 CN CN201911224959.2A patent/CN110731164B/zh active Active
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE3632416A1 (de) * | 1986-09-24 | 1988-04-07 | Schaeff Karl Gmbh & Co | Knickgelenktes arbeitsfahrzeug mit hoehenverstellbaren raedern |
| CN107258207A (zh) * | 2016-04-07 | 2017-10-20 | 苏州宝时得电动工具有限公司 | 割草机及传感器高度控制方法 |
| CN109917796A (zh) * | 2017-12-12 | 2019-06-21 | 财团法人工业技术研究院 | 移动载具、地面处理机具及其姿态调整方法 |
| DE102019202950A1 (de) * | 2018-03-06 | 2019-09-12 | Deere & Company | Füllstanddetektion und steuerung |
| CN108668606A (zh) * | 2018-04-28 | 2018-10-19 | 温州中邦知识产权有限公司 | 一种市政智能绿化用切割机 |
| CN109089527A (zh) * | 2018-11-02 | 2018-12-28 | 江苏农牧科技职业学院 | 一种智能收割机割台水平升降控制系统及方法 |
| CN109397293A (zh) * | 2018-11-27 | 2019-03-01 | 上海机器人产业技术研究院有限公司 | 一种基于移动机器人的地面水平误差建模及补偿方法 |
| CN110199663A (zh) * | 2019-04-09 | 2019-09-06 | 丰疆智能科技股份有限公司 | 自动收割机、割台自动调节系统及其方法 |
| CN110199664A (zh) * | 2019-04-09 | 2019-09-06 | 丰疆智能科技股份有限公司 | 可抬降割台的农割作业机器及其控制方法 |
| CN110450993A (zh) * | 2019-09-11 | 2019-11-15 | 北京邮电大学 | 零重力自调节气浮平台及零重力模拟系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110731164A (zh) | 2020-01-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10401856B2 (en) | Vehicle travel control apparatus | |
| US9510508B2 (en) | Monitoring system for controlling the position of an implement for an agricultural vehicle while taking the vehicle dynamics into account | |
| JP5890477B2 (ja) | ロボットプログラム修正システム | |
| US8560182B2 (en) | Implement height control adjustment on agricultural vehicles | |
| US20160309656A1 (en) | Harvesting system having a self-propelled harvesting machine | |
| CN110731164B (zh) | 一种收割机工作装置作业姿态自动调整控制方法及系统 | |
| US20100042292A1 (en) | Device and Method for Influencing the Spring Force Characteristic of an Active Chassis of a Motor Vehicle | |
| CN110905031B (zh) | 一种挖掘机工作装置作业姿态自动调整控制方法及系统 | |
| US9706708B2 (en) | Controlling a positioning system for an agricultural implement | |
| CN111295318B (zh) | 用于调节车辆纵向位置的方法和装置 | |
| EP2107441A1 (en) | Adaptive nonlinear steering control system and method for work vehicles | |
| CN103620191A (zh) | 车辆的驱动力控制装置 | |
| CN113336117B (zh) | 一种温盐深绞车自动纠偏方法和装置 | |
| CN110905021B (zh) | 一种平地机工作装置作业姿态自动调整控制方法及系统 | |
| CN110905032A (zh) | 一种装载机工作装置作业姿态自动调整控制方法及系统 | |
| CN110741749A (zh) | 一种旋耕机工作装置作业姿态自动调整控制方法及系统 | |
| CN1093179A (zh) | 过程控制方法及其装置 | |
| CN110905020B (zh) | 一种推土机工作装置作业姿态自动调整控制方法及系统 | |
| US20220369557A1 (en) | Agricultural system and method for automatically controlling a position of a harvesting implement of an agricultural harvester | |
| CN1920720A (zh) | 调整机台设定的方法、制造控制系统、及半导体制造系统 | |
| WO2011027238A1 (en) | Device and method for controlling a welding machine, in particular for manufacturing by means of material deposition | |
| US7096107B2 (en) | Device for the longitudinal guidance of a motor vehicle | |
| CN110803625B (zh) | 一种正面吊工作装置作业姿态自动调整控制方法及系统 | |
| CN110885006B (zh) | 一种起重机工作装置作业姿态自动调整控制方法及系统 | |
| CN113885469A (zh) | 车辆控制参数的标定方法、装置、电子设备及存储介质 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |