CN111427347B - 履带式农业机械的综合自动控制装置 - Google Patents

履带式农业机械的综合自动控制装置 Download PDF

Info

Publication number
CN111427347B
CN111427347B CN202010207778.5A CN202010207778A CN111427347B CN 111427347 B CN111427347 B CN 111427347B CN 202010207778 A CN202010207778 A CN 202010207778A CN 111427347 B CN111427347 B CN 111427347B
Authority
CN
China
Prior art keywords
path
crawler
type
oil cylinder
control
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
Application number
CN202010207778.5A
Other languages
English (en)
Other versions
CN111427347A (zh
Inventor
张方明
李佳明
杨林淼
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ningbo Institute of Technology of ZJU
Original Assignee
Ningbo Institute of Technology of ZJU
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ningbo Institute of Technology of ZJU filed Critical Ningbo Institute of Technology of ZJU
Priority to CN202010207778.5A priority Critical patent/CN111427347B/zh
Publication of CN111427347A publication Critical patent/CN111427347A/zh
Application granted granted Critical
Publication of CN111427347B publication Critical patent/CN111427347B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00—Automatic controllers
    • G05B11/01—Automatic controllers electric
    • G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Lifting Devices For Agricultural Implements (AREA)

Abstract

一种履带式农业机械的综合自动控制装置及其测控方法，由测向型卫星定位系统、导航控制器、ECU机箱、电磁液压集成阀、位移传感器、电动推杆调速装置和CAN网络组成。导航控制器收到定位、航向、车身的姿态角、车身的角速度的数据之后，运行kalman滤波器，估计出当前的车辆的坐标位置、车身的姿态角，再获取升降油缸和水平油缸的位移传感器的读数，按照几何关系推算出悬挂机具中心点当前的作业深度和左右两端的高程差，依据横向偏差和航向角，运用非线性PID算法产生纠正路径偏差的控制量、中心点高程偏差的控制量和保持机具水平状态的控制量，依据选用的机具是旋耕机或开沟机，按照1：2：2或1：4：0的节拍进行输出控制。通过综合自动控制极大地减轻了司机的劳动强度。

Description

履带式农业机械的综合自动控制装置
技术领域
本发明属于农业机械领域，具体涉及履带式农业机械的自动化操控。
背景技术
机械化农田作业需要符合农艺要求，例如水田的耕地作业要求机器在一块农田内反复作业2-3遍，耕作之后要求表面平坦，不得有坑坑洼洼的现象，这是一种重复性、单调性的劳动，司机的劳动强度很大。再比如，开沟作业要求水沟的直线性好、行距均匀、水沟的深浅保持恒定，以利于排水，人工驾驶仅能勉强达到这样的农艺要求。履带式农业机械相比于轮式农业机械，具有接地比压小、抗陷能力强、不破坏犁底层的优点，可以挂接旋耕机、开沟机等作业机具，特别适合在南方水田种植地区使用。采用履带底盘之后，车辆更容易产生俯仰式的颠簸，导致司机需要时刻扭头关注旋耕机或开沟机的作业深度；此外，由于水田的犁底层往往是不平坦的，旋耕机易于随车身产生横滚方向的倾斜，影响耕作后土地的平整程度。因此，如何大幅降低司机的劳动强度，同时提高耕作的质量，是市场所迫切的技术。
发明专利“履带式联合收割机的自动驾驶系统及其控制方法”(中国专利201410413403.9)，是另外一种履带式农业机械，它采用RTK-GPS作为导航传感器，具有直线自动行跟踪、自动转弯和收割台的抬升和下降自动控制的功能，但缺乏对机具的精准化位置控制。在另外一份申请的发明专利“悬挂机具水平自动控制装置”(申请号201810801271.9)，提出了使用两只GPS天线测量车辆的横滚角，使悬挂的机具能持续保持水平状态，但缺乏对悬挂机具的入土深度控制。发明专利“前置式拖拉机水平自动控制装置”(中国专利，201510843200.8)提出了一种间接测量农具姿态的方法，然后控制机具保持水平姿态，同样，该方法也缺乏对机具的入土深度控制。
为了克服现有履带式农业机械自动控制装置的缺陷，本发明提供了一种履带式农业机械的综合自动控制装置。该装置不仅可以可以独立控制左、右履带的速度以满足自动导航的需求，而且同时控制悬挂机具的水平状态和入土深度，实现综合自动化功能。
本发明解决其技术问题所采用的技术方案是：履带式农业机械的综合自动控制装置由测向型卫星定位系统、导航控制器、ECU机箱、电磁液压集成阀、升降油缸的位移传感器、水平油缸的位移传感器、电动推杆调速装置和CAN网络组成。测向型卫星定位系统的GPS天线一前一后被放置在履带式农业机械的遮阳棚架上的中轴线处；转向与机具手柄采用电子式摇杆手柄，代替机械式摇杆手柄；导航控制器固定在仪表面板的侧方，便于驾驶员操控；在车身箱体内，固定一台ECU机箱和一台测向型卫星定位系统的接收机，ECU机箱内包含一块位姿数据采集卡、调速控制卡、履带机具板卡；一台电磁液压集成阀固定于行走踏板之下的车架上，它控制履带的运动、机具的升降和水平姿态；在升降油缸处并联一只位移传感器，在水平油缸处并联一只位移传感器；使用电动推杆调速装置代替手动的HST无级变速装置，使得车速能被综合自动控制装置控制。
电磁液压集成阀包含溢流阀、三位四通电磁阀、二位三通电磁阀、单向节流阀和先导单向阀。电磁液压集成阀的进油口P与第一只三位四通电磁阀的P口联通，此电磁阀的A口B口、先导单向阀、单向节流阀、出油口A1顺次联通，出油口A1与悬挂机具的升降油缸的无杆腔联通；第一只三位四通电磁阀的T口与第二只三位四通电磁阀的P口联通，此电磁阀的A口B口、先导单向阀、单向节流阀、出油口A2出油口B2顺次联通，出油口A2出油口B2与悬挂机具的水平油缸的无杆腔和有杆腔联通；第二只三位四通电磁阀的T口与第三只三位四通电磁阀的P口联通，此电磁阀的A口B口、出油口A3出油口B3顺次联通，出油口A3出油口B3与双推杆油缸的各自的无杆腔联通，双推杆油缸的的有杆腔与二位三通电磁阀的P口联通；此二位三通电磁阀的A口直接联通电磁液压集成阀的回油口T，此二位三通电磁阀的B口与节流阀、电磁液压集成阀的回油口T顺次联通。此外，第一只三位四通电磁阀的P口、第二只三位四通电磁阀的P口各自与一只溢流阀联通，当P口的油压超过设定的压力时，液压油直接溢流到电磁液压集成阀的回油口T。电磁液压集成阀的工作原理是：当第一只三位四通电磁阀的1A电磁阀得电时，升降油缸的大腔内压升高，提升悬挂机具；当1B电磁阀得电时，升降油缸的大腔失压，下降悬挂机具；当第二只三位四通电磁阀的2A电磁阀得电时，水平油缸的大腔内压升高，悬挂机具的一端被升高；当2B电磁阀得电时，水平油缸的小腔内压升高，悬挂机具的一端被降低；当3A电磁阀得电时，双推杆油缸的左油缸大腔内压升高，左履带被制动，履带式农业机械向左旋转，当3B电磁阀得电时，双推杆油缸的右油缸大腔内压升高，右履带被制动，履带式农业机械向右旋转，当这2个电磁阀同时得电时，双推杆油缸的左、右大腔的内压升高，两支推杆全部推出，履带式农业机械被制动。二位三通电磁阀的4A电磁阀没有得到信号时，双推杆油缸的回油口直接联通电磁液压集成阀的回油口T，双推杆油缸的左、右大腔的内压能迅速升高，其推杆能快速推出，控制变速箱与履带驱动轮之间的离合器被迅速推开，制动器马上发生作用，履带式农业机械被制动，履带式农业机械处于大转向模式，当二位三通电磁阀的4A电磁阀得电时，液压油通过节流阀之后，才回到油箱，双推杆油缸的左、右大腔的内压升高较慢，使得其推杆推出伸出的速度变慢，控制变速箱与履带驱动轮之间的离合器被缓慢地推开，被控履带仅仅减速，履带式农业机械处于小转向模式。
履带机具板卡由单片机、运算放大器滤波电路、转向与机具手柄的开关信号输入电路、场效应管功率输出电路和CAN通信电路组成。水平油缸的位移传感器的模拟量输出端与运算放大器滤波电路的信号输入AN0端电连接，运算放大器滤波电路的信号输出AD0端与单片机的RA0引脚电连接；升降油缸的位移传感器的模拟量输出端与运算放大器滤波电路的信号输入AN1端电连接，运算放大器滤波电路的信号输出AD1端与单片机的RA1引脚电连接。转向与机具手柄的向左、向右、抬升、下降微动开关和水平油缸抬升、水平油缸下降、大小转切换、手动/自动切换按钮开关与光耦、单片机的RB0、RB1、RB4、RB5、RB6、RB7引脚依次电连接。单片机的RC1～RC7依次与光耦、场效应管功率输出电路和电磁液压集成阀的向左、向右、抬升、下降、水平调节升、水平调节降、大小转切换的电磁头电连接。单片机的CANRX、CANTX引脚与CAN通信电路电连接，使得履带机具板卡既可接收导航控制器的指令去控制履带式农业机械转向、机具升降、机具水平控制，也可采集位移传感器的模拟量，发送给导航控制器。
履带机具板卡上电后，初始化单片机的RA、RB、RC端口，配置RA为模拟量输入端口，RB为开关量输入端口，RC为开关量输出端口，然后依次初始化定时器TIMER0、模数A/D变换和CAN通信寄存器，构建时间继电器T0-～T11，开启定时器和CAN通信中断功能。程序按照循环扫描的方式运行：首先逐个检查摇杆手柄的信号——是否有手动操控，如果检测到摇杆手柄向左拨动，则RC0输出被开通，启动时间继电器T0，双推杆油缸的左推杆伸出，使左履带失去动力并制动，手动操控时，时间继电器T0的定时时间固定为200ms，当T0的定时时间到则RC0输出被关断，双推杆油缸的左推杆缩回，使左履带重新获得动力。如果检测到摇杆手柄向右拨动，则RC1输出被开通，启动时间继电器T1，双推杆油缸的右推杆伸出，使右履带失去动力并制动，当T1的定时时间到则RC1输出被关断，双推杆油缸的右推杆缩回，使右履带重新获得动力。如果检测到摇杆手柄向后拨动，则RC2输出被开通，启动时间继电器T2，升降油缸的推杆伸出，抬升悬挂机具，当T2的定时时间到则RC2输出被关断，升降油缸的推杆立即停止运动，悬挂机具停在新的高度位置。如果检测到摇杆手柄向前拨动，则RC3输出被开通，启动时间继电器T3，升降油缸的推杆缩回，下降悬挂机具，当T3的定时时间到则RC3输出被关断，升降油缸的推杆立即停止运动，悬挂机具停在当前的高度位置。如果检测到摇杆手柄的水平控制抬升按钮被按下，则RC4输出被开通，启动时间继电器T4，水平油缸的推杆缩回，抬升悬挂机具的右端，当T4的定时时间到则RC4输出被关断，水平油缸的推杆立即停止运动，悬挂机具停在新的高度位置。如果检测到摇杆手柄的水平控制下降按钮被按下，则RC5输出被开通，启动时间继电器T5，水平油缸的推杆伸出，下降悬挂机具的右端，当T5的定时时间到则RC5输出被关断，水平油缸的推杆立即停止运动，悬挂机具停在当前的高度位置。如果转向与机具手柄的手柄或按钮被持续按住，则执行机构能持续动作。其次，如果产生CAN接收中断，则判别是哪类指令：如果是向左转指令，则RC0输出被开通，从指令中取出定时时长，启动时间继电器T6，产生与T0相同效果的对左履带的控制。如果是向右转指令，则RC1输出被开通，从指令中取出定时时长，启动时间继电器T7，产生与T1相同效果的对右履带的控制。如果是抬升机具指令，则RC2输出被开通，从指令中取出定时时长，启动时间继电器T8，产生与T2相同效果的对悬挂机具的控制。如果是下降机具指令，则RC3输出被开通，从指令中取出定时时长，启动时间继电器T9，产生与T3相同效果的对悬挂机具的控制。如果是水平控制抬升指令，则RC4输出被开通，从指令中取出定时时长，启动时间继电器T10，产生与T4相同效果的对悬挂机具的水平控制。如果是水平控制下降指令，则RC5输出被开通，从指令中取出定时时长，启动时间继电器T11，产生与T5相同效果的对悬挂机具的水平控制。如果是采集升降油缸的位移传感器指令，则启动A/D变换，把RA0引脚的模拟量转换为数字量，然后通过CAN网络发送给导航控制器。如果是采集水平油缸的位移传感器指令，则启动A/D变换，把RA1引脚的模拟量转换为数字量，然后通过CAN通信电路发送给导航控制器。
导航控制器对履带式农机进行综合自动控制。软件系统上电之后，读入导航控制、机具高程控制、机具水平控制的各自的KP、KI、和KD参数，启动CAN通信线程、控制线程，把悬挂机具降入作业深度，在人机界面设置此位置作为设定的作业深度，软件系统保存此时的升降油缸的位移传感器的读数值。CAN通信线程一旦接收到位姿数据采集卡的数据，控制线程立即解析出由测向型卫星定位系统产生的车身的位置、航向角和俯仰角，以及由陀螺仪产生的车身绕X轴的角速率和俯仰角、绕Y轴的角速率和横滚角；把测向型卫星定位系统产生的车身的X坐标、Y坐标、航向角、俯仰角和陀螺仪产生的绕车身X轴的角速率、绕Y轴的角速率、俯仰角、横滚角构成观测量，把车身的X坐标、Y坐标、航向角、绕X轴的角速率、Y轴的角速率、俯仰角和横滚角构成状态量，进行Kalman滤波器的递推计算，状态方程和观测方程如下：
Xk+1＝ΦkXk+wk (1)
Zk＝HkXk+vk (2)
其中，状态变量为
Xk＝[xk,yk,zk,vk,ωxk,ωyk,γxk,γyk,ψzk]T (3)
状态转移矩阵是
观察量和观测矩阵是
式中，Xk是状态变量矩阵
xk，yk，zk分别是履带式农业机械测向型卫星定位系统的前GPS天线在时刻k的x、y、z坐标的状态量,m
vk是履带式农业机械在时刻k的车速的状态量,m/s
ωxk，ωyk分别是履带式农业机械在时刻k的车身绕X轴、Y轴旋转角速度的状态量,rad/s
γxk，γyk分别是履带式农业机械在时刻k的车身绕X轴俯仰角、绕Y轴横滚角的状态量,rad
ψzk是履带式农业机械在时刻k的车身绕Z轴航向角的状态量,rad
Φk是状态转移矩阵
T是采样的时间间隔,s
Zk是观测量矩阵
Hk是观测矩阵
ωx，ωy分别是履带式农业机械车身绕X轴、Y轴旋转角速度的观测量,rad/s
γx，γy分别是履带式农业机械车身绕X轴俯仰角、绕Y轴横滚角的观测量,rad
γGPS是由测向型卫星定位系统获得的车身绕X轴俯仰角的观测量,rad
ψGPS是由测向型卫星定位系统获得的车身绕Z轴航向角的观测量,rad
通过先期的实验，计算出状态变量的协方差矩阵Qk和观测量的协方差矩阵Rk。导航控制器然后从履带机具板卡获取升降油缸和水平油缸的位移传感器的数据，计算此时升降油缸的推杆的伸出量、水平油缸的推杆的伸出量。则可计算出悬挂机具当前的作业深度与设置的作业深度之间的差值、当前的左右两端之间的高程差：
式中，ΔEh是悬挂机具当前的作业深度与设置的作业深度之间的差值,m
ΔDh是悬挂机具当前的左右两端之间的高程差,m
Δs1是当前升降油缸伸出量与设定工作深度时的伸出量之间的差值产生的油缸行程量,m
Δs2是当前水平油缸伸出量与悬挂机具水平状态时的伸出量之间的差值产生的油缸行程量,m
ΔEGPS是前卫星定位天线的高程的改变量,m
l1，l11分别是上提升臂的总长、从机身支座到油缸铰接点之间的距离,m
l2，l21分别是下提升臂的总长、从机身支座到拉杆铰接点之间的距离,m
l3，l4分别是履带中点距离前卫星定位天线的水平距离、履带中点距离悬挂机具刀尖的水平距离,m
l5，l6分别是悬挂机具的拉杆铰接点之间的距离和悬挂机具的宽度,m
α是升降油缸与垂线之间的角度,rad
最后，依据车身的横向偏差和航向角，按照导航的非线性PID控制算法产生改变履带运动状态的纠正路径偏差的控制量，按照机具控制非线性PID控制算法产生使升降油缸、水平油缸动作的控制量。鉴于控制履带、升降油缸、水平油缸的油路属于串联性质，因此尽管每一次数据周期均可产生式(3)、式(7)和式(8)的计算结果，但是输出控制需要按照一定的节拍，并考虑不同作业场景的差异。如果是挂接旋耕机进行耕地作业时，直行阶段，导航控制器需要兼顾导航、作业深度、水平控制，以5拍为一个周期，按照输出节拍1：2：2的方式进行控制；转弯阶段，导航控制器需要兼顾作业深度与水平控制，仍然以5拍为一个周期，按照输出节拍3：2的方式进行控制；如果是挂接开沟机进行开沟作业，直行阶段，导航控制器兼顾导航、作业深度，输出控制节拍为1：4；转弯阶段，开沟机被抬升后，导航控制器只控制航向。
履带式旋耕机逆时针方向围框型覆盖式作业的路径规划方法如下：设田块的宽度为W，长度为L，作业宽度为M,转弯半径为R，前进方向坐标为Y，横向方向坐标为X，从田块的右侧由南向北开始作业。履带式旋耕机首先按照从外向内的路径作业，第一条路径定义为X＝-0.5M，该路径的直行终点是Y＝L-0.5M-2.5R；履带式旋耕机往往是在水田中作业，让它直接进行一个90°的转弯比较困难，旧的路径切换到新的路径采用1条45°弧线路径加一小段直行，再加1条45°弧线路径的方式；第二条路径定义为Y＝L-0.5M，该路径的直行终点是X＝-W+0.5M+2.5R；第三条路径定义为X＝-W+0.5M，该路径的直行终点是Y＝0.5M+2.5R；第四条路径定义为Y＝0.5M，该路径的直行终点是X＝-1.5M-2.5R。如此这样，履带式旋耕机完成一个整圈的作业。此后，第n条路径是一条与紧邻的外侧路径(第n-1条)平行的、间距一个作业宽度M的路径，第n条路径的终点比紧邻的外侧路径(第n-1条)的终点缩短距离M。当这种覆盖式作业使履带式旋耕机运动到田块中央部位之后，以最接近中线的那条路径为起点，实行从内向外的路径：新的路径逐条外移，每次移动一个作业宽度M，新路径的终点比紧邻的内侧路径的终点延长距离M。如此这样，履带式旋耕机将自动靠近田块的最外围路径，如果没有人为的停车干预，新的路径将再次按照从外向内的方式逐行推进，等履带式旋耕机到达中线之后，新的路径再次按照从内向外的方式逐行推进。通过这样的路径设置方法，可使履带式旋耕机反复地自动耕地，达到预期的农艺要求。
履带式旋耕机逆时针方向围框型覆盖式作业的综合自动控制方法如下：导航控制器按照顺序执行的方式进行路径的控制。在直线路径上启动直行自动控制，兼顾导航、作业深度和水平控制,按规划的路径前进作业，在距离路径的终点1.0米处，导航控制器发出慢速指令给调速控制卡，使得履带式旋耕机以慢速精确地到达路径的终点。履带式旋耕机进入转弯阶段，此阶段导航控制器兼顾作业深度和水平控制；导航控制器发出左转指令给履带机具板卡，左履带被制动，右履带运动，当航向角改变45°时，导航控制器发出直行指令给履带机具板卡，两条履带同时运动，此直行动作持续1.6m距离之后，导航控制器发出左转指令给履带机具板卡，当航向角再次改变45°时，履带式旋耕机已经整体转动了90°，转弯阶段结束，履带式旋耕机进入新的一条路径，再次进入直行阶段，继续兼顾导航、作业深度和水平控制，在慢速中履带式旋耕机纠正路径偏差和航向姿态，持续2米之后，导航控制器发出中速指令给调速控制卡，按规划的路径前进作业。在距离路径的终点1.0米处，依次进入慢速、转弯模式，直到进入一条新的路径。
履带式开沟机从左向右逐排平行行开沟作业的路径规划方法如下：开沟作业的时，土壤一般是比较干燥的，履带式开沟机可以直接进行一个90°的转弯。履带式开沟机的第一条路径(去程)定义为X＝0.5M，路径的直行终点是Y＝L-R；第二条路径(过渡直行路径)定义为Y＝L，路径的直行终点是X＝1.5M-R；第三条路径(回程)定义为X＝1.5M，路径的直行终点是Y＝R；第四条路径(过渡直行路径)定义为Y＝0，路径的直行终点是X＝2.5M-R。如此这样，履带式开沟机完成一个周期的路径规划。此后的路径规划重复这个周期，去程与回程路径之间的间距保持为一个作业宽度M，奇数序号的路径终点相同，都是Y＝L-R；偶数序号的路径终点相同，都是Y＝R。这种逐排平行行路径使履带式开沟机能自动运动到农田边界。设置一条与去程路径垂直的远端横直行路径，定义为Y＝L-M,上一条路径的终点是Y＝L-R-M，远端横直行路径的终点是X＝R；再设置一条近端横直行路径，定义为Y＝M,上一条路径的终点是Y＝R+M，近端横直行路径的终点是X＝W；两条横直行路径构成去程和回程，但不再有第四条路径。这样就构成了纵向为主，纵横联通的开沟路径。
履带式开沟机的综合自动控制按照顺序执行的方式进行路径的控制。在直线路径上读取第一条路径设置，启动直行自动控制，兼顾导航、作业深度的控制，在距离路径的终点1.0米处，导航控制器发出慢速指令给调速控制卡，使得履带式开沟机以慢速精确地到达路径的终点，导航控制器发出抬升开沟机的指令给履带机具板卡。履带式开沟机进入转弯阶段，此阶段导航控制器只监视转弯过程；导航控制器发出右转指令给履带机具板卡，右履带被制动，左履带运动，当航向角改变90°时，转弯阶段结束，履带式开沟机进入第二条路径，导航控制器只进行导航控制，当到达第二条路径的终点时，履带式开沟机再次进入90°转弯阶段，此阶段导航控制器只监视转弯过程。当转弯阶段结束，履带式开沟机进入回程路径，导航控制器发出下降开沟机的指令给履带机具板卡，履带式开沟机兼顾导航、作业深度的控制，此动作持续2米之后，导航控制器发出中速指令给调速控制卡，按规划的路径前进作业。在距离路径的终点1.0米处，再次进入慢速、左转弯模式，直到进入第四条路径。在完成一个路径周期之后，履带式开沟机重新进入去程路径，履带式开沟机又进入慢速调整轨迹、中速作业的顺序动作过程。
本发明的有益效果是履带式农业机械的综合自动控制装置不仅可以可以独立控制左、右履带的运动状态以满足自动导航的需求，而且同时控制悬挂机具的水平状态和入土深度，实现综合自动化功能，提高作业的精准度，极大地减轻司机的劳动强度。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1是综合自动控制装置在履带式旋耕机中应用的一个实施例。
图2是电磁液压集成阀的液压原理图。
图3是履带机具板卡的一个电路原理实施例。
图4是履带机具板卡的测控过程的一个实施例。
图5是导航控制器综合自动控制履带式旋耕机直线行驶软件流程的一个实施例。
图6是履带式旋耕机逆时针方向围框型覆盖式作业的路径规划方法的一个实施例。
图7是履带式旋耕机逆时针方向围框型覆盖式作业的综合自动控制的一个实施例。
图8是履带式开沟机从左向右逐排平行行开沟作业的路径规划方法的一个实施例。
图9是履带式开沟机的综合自动控制的一个实施例。
图中，1.旋耕机具，2.车身箱体，3.测向型卫星定位系统，4.遮阳棚架，5.转向与机具手柄，6.导航控制器，7.ECU机箱，8.电磁液压集成阀，9.位移传感器，10.水平油缸，11.位移传感器，12.升降油缸，13.溢流阀，14.溢流阀，15.三位四通电磁阀，16.先导单向阀，17.单向节流阀，18.三位四通电磁阀，19.单向节流阀，20.双推杆油缸，21.先导单向阀，22.三位四通电磁阀，23.二位三通电磁阀，24.节流阀，25.MCP6274滤波电路，26.PIC18F25K80，27.MCP2551CAN通信电路，28.AOD4184功率输出电路，29.光耦EL357，30.开关信号输入电路，31.按钮开关
图1是综合自动控制装置在履带式旋耕机中应用的一个实施例，履带式旋耕机的综合自动控制装置由测向型卫星定位系统(3)、导航控制器(6)、ECU机箱(7)、电磁液压集成阀(8)、升降油缸(12)的位移传感器(11)、水平油缸(10)的位移传感器(9)、电动推杆调速装置和CAN网络组成。测向型卫星定位系统(3)的GPS天线一前一后被放置在履带式旋耕机的遮阳棚架(4)上的中轴线处；转向与机具手柄(5)采用电子式摇杆手柄，代替机械式摇杆手柄；导航控制器(6)固定在仪表面板的侧方，便于驾驶员操控；在车身箱体(2)内，固定一台ECU机箱(7)和一台测向型卫星定位系统(3)的接收机，ECU机箱(7)内包含一块位姿数据采集卡、调速控制卡、履带机具板卡；一台电磁液压集成阀(8)固定于行走踏板之下的车架上，它控制履带的运动、旋耕机具(1)的升降和水平姿态；在升降油缸(12)处并联一只位移传感器(11)，在水平油缸(10)处并联一只位移传感器(9)；使用电动推杆调速装置代替手动的HST无级变速装置，使得车速能被综合自动控制装置控制。
图2是电磁液压集成阀(8)的液压原理图，包含溢流阀(13，14)、三位四通电磁阀(15，18，21)、二位三通电磁阀(22)、单向节流阀(17，19)、节流阀(24)和先导单向阀(16，20)。电磁液压集成阀(8)的进油口P与第一只三位四通电磁阀(15)的P口联通，此电磁阀(15)的A口B口、先导单向阀(16)、单向节流阀(17)、出油口A1顺次联通，出油口A1与旋耕机具(1)的升降油缸(12)的无杆腔联通；第一只三位四通电磁阀(15)的T口与第二只三位四通电磁阀(18)的P口联通，此电磁阀(18)的A口B口、先导单向阀(21)、单向节流阀(19)、出油口A2出油口B2顺次联通，出油口A2出油口B2与旋耕机具(1)的水平油缸(10)的无杆腔和有杆腔联通；第二只三位四通电磁阀(18)的T口与第三只三位四通电磁阀(22)的P口联通，此电磁阀(22)的A口B口、出油口A3出油口B3顺次联通，出油口A3出油口B3与双推杆油缸(20)的各自的无杆腔联通，双推杆油缸(20)的有杆腔与二位三通电磁阀(23)的P口联通；此二位三通电磁阀(23)的A口直接联通电磁液压集成阀(8)的回油口T，此二位三通电磁阀(23)的B口与节流阀(24)、电磁液压集成阀(8)的回油口T顺次联通。此外，第一只三位四通电磁阀(15)的P口、第二只三位四通电磁阀(18)的P口各自与一只溢流阀(13，14)联通，当P口的油压超过设定的压力时，液压油直接溢流到电磁液压集成阀(8)的回油口T。电磁液压集成阀(8)的工作原理是：当第一只三位四通电磁阀(15)的1A电磁阀得电时，升降油缸(12)的大腔内压升高，提升旋耕机具(1)；当1B电磁阀得电时，升降油缸(12)的大腔失压，下降旋耕机具(1)；当第二只三位四通电磁阀(18)的2A电磁阀得电时，水平油缸(10)的大腔内压升高，旋耕机具(1)的一端被升高；当2B电磁阀得电时，水平油缸(10)的小腔内压升高，悬耕机具(1)的一端被降低；当3A电磁阀得电时，双推杆油缸(20)的左油缸大腔内压升高，左履带被制动，履带式农业机械向左旋转，当3B电磁阀得电时，双推杆油缸(20)的右油缸大腔内压升高，右履带被制动，履带式农业机械向右旋转，当这2个电磁阀同时得电时，双推杆油缸(20)的左、右大腔的内压升高，两支推杆全部推出，履带式农业机械被制动。二位三通电磁阀(23)的4A电磁阀没有得到信号时，双推杆油缸(20)的回油口直接联通电磁液压集成阀(8)的回油口T，双推杆油缸(20)的左、右大腔的内压能迅速升高，其推杆能快速推出，控制变速箱与履带驱动轮之间的离合器被迅速推开，制动器马上发生作用，履带式农业机械被制动，履带式农业机械处于大转向模式，当二位三通电磁阀(23)的4A电磁阀得电时，液压油通过节流阀之后，才回到油箱，双推杆油缸(20)的左、右大腔的内压升高较慢，使得其推杆推出伸出的速度变慢，控制变速箱与履带驱动轮之间的离合器被缓慢地推开，被控履带仅仅减速，履带式农业机械处于小转向模式。
图3是履带机具板卡的一个电路原理实施例，履带机具板卡由PIC18F25K80(26)、MCP6274滤波电路(25)、转向与机具手柄(5)的开关信号输入电路(30)、AOD4184功率输出电路(28)和MCP2551CAN通信电路(27)组成。水平油缸(10)的位移传感器(9)的模拟量输出端与MCP6274滤波电路(25)的信号输入AN0端电连接，MCP6274滤波电路(25)的信号输出AD0端与PIC18F25K80(26)的RA0引脚电连接；升降油缸(12)的位移传感器(11)的模拟量输出端与MCP6274滤波电路(25)的信号输入AN1端电连接，MCP6274滤波电路(25)的信号输出AD1端与PIC18F25K80(26)的RA1引脚电连接。转向与机具手柄(5)的向左、向右、抬升、下降微动开关和水平油缸(10)抬升、水平油缸(10)下降、大小转切换、手动/自动切换按钮开关(31)与开关信号输入电路(30)、PIC18F25K80(26)的RB0、RB1、RB4、RB5、RB6、RB7引脚依次电连接。PIC18F25K80(26)的RC1～RC7依次与光耦EL357(29)、AOD4184功率输出电路(28)和电磁液压集成阀(8)的向左、向右、抬升、下降、水平调节升、水平调节降、大小转切换的电磁头电连接。PIC18F25K80(26)的CANRX、CANTX引脚与MCP2551CAN通信电路(27)电连接，使得履带机具板卡既可接收导航控制器(6)的指令去控制履带式农业机械转向、机具升降、机具水平控制，也可采集位移传感器(9，11)的模拟量，发送给导航控制器(6)。
图4履带机具板卡的测控过程的一个实施例。履带机具板卡上电后，初始化PIC18F25K8(26)的RA、RB、RC端口，配置RA为模拟量输入端口，RB为开关量输入端口，RC为开关量输出端口，然后依次初始化定时器TIMER0、模数A/D变换和CAN通信寄存器，构建时间继电器T0-～T11，开启定时器和CAN通信中断功能。程序按照循环扫描的方式运行：首先逐个检查转向与机具手柄(5)的信号——是否有手动操控，如果检测到转向与机具手柄(5)向左拨动，则RC0输出被开通，启动时间继电器T0，双推杆油缸(20)的左推杆伸出，使左履带失去动力并制动，手动操控时，时间继电器T0的定时时间固定为200ms，当T0的定时时间到则RC0输出被关断，双推杆油缸(20)的左推杆缩回，使左履带重新获得动力。如果检测到转向与机具手柄(5)向右拨动，则RC1输出被开通，启动时间继电器T1，双推杆油缸(20)的右推杆伸出，使右履带失去动力并制动，当T1的定时时间到则RC1输出被关断，双推杆油缸(20)的右推杆缩回，使右履带重新获得动力。如果检测到转向与机具手柄(5)向后拨动，则RC2输出被开通，启动时间继电器T2，升降油缸(12)的推杆伸出，抬升旋耕机具(1)，当T2的定时时间到则RC2输出被关断，升降油缸(12)的推杆立即停止运动，旋耕机具(1)停在新的高度位置。如果检测到转向与机具手柄(5)向前拨动，则RC3输出被开通，启动时间继电器T3，升降油缸(12)的推杆缩回，下降悬耕机，当T3的定时时间到则RC3输出被关断，升降油缸(12)的推杆立即停止运动，旋耕机具(1)停在当前的高度位置。如果检测到转向与机具手柄(5)的水平控制抬升按钮被按下，则RC4输出被开通，启动时间继电器T4，水平油缸(10)的推杆缩回，抬升悬耕机的右端，当T4的定时时间到则RC4输出被关断，水平油缸(10)的推杆立即停止运动，旋耕机具(1)停在新的高度位置。如果检测到转向与机具手柄(5)的水平控制下降按钮被按下，则RC5输出被开通，启动时间继电器T5，水平油缸(10)的推杆伸出，下降悬耕机具(1)的右端，当T5的定时时间到则RC5输出被关断，水平油缸(10)的推杆立即停止运动，悬耕机具(1)停在当前的高度位置。如果转向与机具手柄(5)的手柄或按钮被持续按住，则执行机构能持续动作。其次，如果产生CAN接收中断，则判别是哪类指令：如果是向左转指令，则RC0输出被开通，从指令中取出定时时长，启动时间继电器T6，产生与T0相同效果的对左履带的控制。如果是向右转指令，则RC1输出被开通，从指令中取出定时时长，启动时间继电器T7，产生与T1相同效果的对右履带的控制。如果是抬升机具指令，则RC2输出被开通，从指令中取出定时时长，启动时间继电器T8，产生与T2相同效果的对旋耕机具(1)的控制。如果是下降机具指令，则RC3输出被开通，从指令中取出定时时长，启动时间继电器T9，产生与T3相同效果的对旋耕机具(1)的控制。如果是水平控制抬升指令，则RC4输出被开通，从指令中取出定时时长，启动时间继电器T10，产生与T4相同效果的对悬耕机具(1)的水平控制。如果是水平控制下降指令，则RC5输出被开通，从指令中取出定时时长，启动时间继电器T11，产生与T5相同效果的对悬耕机具(1)的水平控制。如果是采集升降油缸(12)的位移传感器(11)指令，则启动A/D变换，把RA0引脚的模拟量转换为数字量，然后通过CAN网络发送给导航控制器(6)。如果是采集水平油缸(10)的位移传感器(9)指令，则启动A/D变换，把RA1引脚的模拟量转换为数字量，然后通过MCP2551CAN通信电路(27)发送给导航控制器(6)。
图5是导航控制器(6)综合自动控制履带式旋耕机直线行驶软件流程的一个实施例。软件系统上电之后，读入导航控制、机具高程控制、机具水平控制的各自的KP、KI、和KD参数，启动CAN通信线程、控制线程，把悬耕机降入作业深度，在人机界面设置此位置作为设定的作业深度，软件系统保存此时的升降油缸(12)的位移传感器(11)的读数值。CAN通信线程一旦接收到位姿数据采集卡的数据，控制线程立即解析出由测向型卫星定位系统(3)产生的车身的位置、航向角和俯仰角，以及由陀螺仪产生的车身绕X轴的角速率和俯仰角、绕Y轴的角速率和横滚角；把测向型卫星定位系统(3)产生的车身的X坐标、Y坐标、航向角、俯仰角和陀螺仪产生的绕车身X轴的角速率、绕Y轴的角速率、俯仰角、横滚角构成观测量，把车身的X坐标、Y坐标、航向角、绕X轴的角速率、Y轴的角速率、俯仰角和横滚角构成状态量，进行Kalman滤波器的递推计算。通过先期的实验，计算出状态变量的协方差矩阵Qk和观测量的协方差矩阵Rk。导航控制器(6)然后从履带机具板卡获取升降油缸(12)和水平油缸(10)的位移传感器(9，11)的数据，计算此时升降油缸(12)的推杆的伸出量、水平油缸(10)的推杆的伸出量。依据公式(7)计算出旋耕机具(1)中心点当前的作业深度与设置的作业深度之间的差值，依据公式(8)计算出当前的左右两端之间的高程差；依据车身的横向偏差和航向角，按照导航的非线性PID控制算法产生改变履带运动状态的纠正路径偏差的控制量，按照机具控制非线性PID控制算法产生使升降油缸(12)、水平油缸(10)动作的控制量。鉴于控制履带、升降油缸(12)、水平油缸(10)的油路属于串联性质，因此尽管每一次数据周期均可产生上述计算结果，但是输出控制需要按照一定的节拍。直行阶段，导航控制器(6)需要兼顾导航、作业深度、水平控制，以5拍为一个周期，按照输出节拍1：2：2的方式进行控制；转弯阶段，导航控制器(6)需要兼顾作业深度与水平控制，仍然以5拍为一个周期，按照输出节拍3：2的方式进行控制。
图6是履带式旋耕机逆时针方向围框型覆盖式作业的路径规划方法的一个实施例。设田块的宽度为W，长度为L，作业宽度为M,转弯半径为R，前进方向坐标为Y，横向方向坐标为X，从田块的右侧由南向北开始作业。履带式旋耕机首先按照从外向内的路径作业，第一条路径定义为X＝-0.5M，该路径的直行终点是Y＝L-0.5M-2.5R；履带式旋耕机往往是在水田中作业，让它直接进行一个90°的转弯比较困难，旧的路径切换到新的路径采用1条45°弧线路径加一小段直行，再加1条45°弧线路径的方式；第二条路径定义为Y＝L-0.5M，该路径的直行终点是X＝-W+0.5M+2.5R；第三条路径定义为X＝-W+0.5M，该路径的直行终点是Y＝0.5M+2.5R；第四条路径定义为Y＝0.5M，该路径的直行终点是X＝-1.5M-2.5R。如此这样，履带式旋耕机完成一个整圈的作业。此后，第n条路径是一条与紧邻的外侧路径(第n-1条)平行的、间距一个作业宽度M的路径，第n条路径的终点比紧邻的外侧路径(第n-1条)的终点缩短距离M。当这种覆盖式作业使履带式旋耕机运动到田块中央部位之后，以最靠近中线的那条路径为起点，实行从内向外的路径：新的路径逐条外移，每次移动一个作业宽度M，新路径的终点比紧邻的内侧路径的终点延长距离M。如此这样，履带式旋耕机将自动靠近田块的最外围路径，如果没有人为的停车干预，新的路径将再次按照从外向内的方式逐行推进，等履带式旋耕机到达中线之后，新的路径再次按照从内向外的方式逐行推进。通过这样的路径设置方法，可使履带式旋耕机反复地自动耕地，达到预期的农艺要求。
图7是履带式旋耕机逆时针方向围框型覆盖式作业的综合自动控制的一个实施例。导航控制器(6)按照顺序执行的方式进行路径的控制。在直线路径上启动直行自动控制，兼顾导航、作业深度和水平控制,按规划的路径前进作业，在距离路径的终点1.0米处，导航控制器(6)发出慢速指令给调速控制卡，使得履带式旋耕机以慢速精确地到达路径的终点。履带式旋耕机进入转弯阶段，此阶段导航控制器(6)兼顾作业深度和水平控制；导航控制器(6)发出左转指令给履带机具板卡，左履带被制动，右履带运动，当航向角改变45°时，导航控制器(6)发出直行指令给履带机具板卡，两条履带同时运动，此直行动作持续1.6m距离之后，导航控制器(6)发出左转指令给履带机具板卡，当航向角再次改变45°时，履带式旋耕机已经整体转动了90°，转弯阶段结束，履带式旋耕机进入新的一条路径，再次进入直行阶段，继续兼顾导航、作业深度和水平控制，在慢速中履带式旋耕机纠正路径偏差和航向姿态，持续2米之后，导航控制器(6)发出中速指令给调速控制卡，按规划的路径前进作业。在距离路径的终点1.0米处，依次进入慢速、转弯模式，直到进入一条新的路径。
图8是履带式开沟机从左向右逐排平行行开沟作业的路径规划方法的一个实施例。开沟作业的时，土壤一般是比较干燥的，履带式开沟机可以直接进行一个90°的转弯。履带式开沟机的第一条路径(去程)定义为X＝0.5M，路径的直行终点是Y＝L-R；第二条路径(过渡直行路径)定义为Y＝L，路径的直行终点是X＝1.5M-R；第三条路径(回程)定义为X＝1.5M，路径的直行终点是Y＝R；第四条路径(过渡直行路径)定义为Y＝0，路径的直行终点是X＝2.5M-R。如此这样，履带式开沟机完成一个周期的路径规划。此后的路径规划重复这个周期，去程与回程路径之间的间距保持为一个作业宽度M，奇数序号的路径终点相同，都是Y＝L-R；偶数序号的路径终点相同，都是Y＝R。这种逐排平行行路径使履带式开沟机能自动运动到农田边界。设置一条与去程路径垂直的远端横直行路径，定义为Y＝L-M,上一条路径的终点是Y＝L-R-M，远端横直行路径的终点是X＝R；再设置一条近端横直行路径，定义为Y＝M,上一条路径的终点是Y＝R+M，近端横直行路径的终点是X＝W；两条横直行路径构成去程和回程，但不再有第四条路径。这样就构成了纵向为主，纵横联通的开沟路径。
图9是履带式开沟机的综合自动控制的一个实施例。导航控制器(6)按照顺序执行的方式进行路径的控制。在直线路径上读取第一条路径设置，启动直行自动控制，兼顾导航、作业深度的控制，在距离路径的终点1.0米处，导航控制器(6)发出慢速指令给调速控制卡，使得履带式开沟机以慢速精确地到达路径的终点，导航控制器(6)发出抬升开沟机的指令给履带机具板卡。履带式开沟机进入转弯阶段，此阶段导航控制器(6)只监视转弯过程；导航控制器(6)发出右转指令给履带机具板卡，右履带被制动，左履带运动，当航向角改变90°时，转弯阶段结束，履带式开沟机进入第二条路径，导航控制器(6)只进行导航控制，当到达第二条路径的终点时，履带式开沟机再次进入90°转弯阶段，此阶段导航控制器(6)只监视转弯过程。当转弯阶段结束，履带式开沟机进入回程路径，导航控制器(6)发出下降开沟机的指令给履带机具板卡，履带式开沟机兼顾导航、作业深度的控制，此动作持续2米之后，导航控制器(6)发出中速指令给调速控制卡，按规划的路径前进作业。在距离路径的终点1.0米处，再次进入慢速、左转弯模式，直到进入第四条路径。在完成一个路径周期之后，履带式开沟机重新进入去程路径，履带式开沟机又进入慢速调整轨迹、中速作业的顺序动作过程。

Claims (4)

1.一种履带式农业机械的综合自动控制装置，由测向型卫星定位系统、导航控制器、ECU机箱、电磁液压集成阀、升降油缸的位移传感器、水平油缸的位移传感器、电动推杆调速装置和CAN网络组成，其特征在于：
导航控制器对履带式农机进行综合自动控制，软件系统启动CAN通信线程、控制线程；CAN通信线程一旦接收到位姿数据采集卡的数据，控制线程立即解析出由测向型卫星定位系统产生的车身的位置、航向角和俯仰角，以及由陀螺仪产生的车身绕X轴的角速率和俯仰角、绕Y轴的角速率和横滚角；把测向型卫星定位系统产生的车身的X坐标、Y坐标、航向角、俯仰角和陀螺仪产生的绕车身X轴的角速率、绕Y轴的角速率、俯仰角、横滚角构成观测量，把车身的X坐标、Y坐标、航向角、绕X轴的角速率、Y轴的角速率、俯仰角和横滚角构成状态量，进行Kalman滤波器的递推计算；状态变量为
Xk＝[xk,yk,zk,vk,ωxk,ωyk,γxk,γyk,ψzk]T (1)
状态转移矩阵是
观察量和观测矩阵是
式中，Xk是状态变量矩阵
xk，yk，zk分别是履带式农业机械测向型卫星定位系统的前GPS天线在时刻k的x、y、z坐标的状态量,m
vk是履带式农业机械在时刻k的车速的状态量,m/s
ωxk，ωyk分别是履带式农业机械在时刻k的车身绕X轴、Y轴旋转角速度的状态量,rad/s
γxk，γyk分别是履带式农业机械在时刻k的车身绕X轴俯仰角、绕Y轴横滚角的状态量,rad
ψzk是履带式农业机械在时刻k的车身绕Z轴航向角的状态量,rad
Φk是状态转移矩阵
T是采样的时间间隔,s
Zk是观测量矩阵
Hk是观测矩阵
ωx，ωy分别是履带式农业机械车身绕X轴、Y轴旋转角速度的观测量,rad/s
γx，γy分别是履带式农业机械车身绕X轴俯仰角、绕Y轴横滚角的观测量,rad
γGPS是由测向型卫星定位系统获得的车身绕X轴俯仰角的观测量,rad
ψGPS是由测向型卫星定位系统获得的车身绕Z轴航向角的观测量,rad
导航控制器然后从履带机具板卡获取升降油缸和水平油缸的位移传感器的数据，计算此时升降油缸的推杆的伸出量、水平油缸的推杆的伸出量；由此计算出悬挂机具当前的作业深度与设置的作业深度之间的差值、当前的左右两端之间的高程差：
其中，ΔEh是悬挂机具当前的作业深度与设置的作业深度之间的差值,m
ΔDh是悬挂机具当前的左右两端之间的高程差,m
Δs1是当前升降油缸伸出量与设定工作深度时的伸出量之间的差值产生的油缸行程量,m
Δs2是当前水平油缸伸出量与悬挂机具水平状态时的伸出量之间的差值产生的油缸行程量,m
ΔEGPS是前卫星定位天线的高程的改变量,m
l1，l11分别是上提升臂的总长、从机身支座到油缸铰接点之间的距离,m
l2，l21分别是下提升臂的总长、从机身支座到拉杆铰接点之间的距离,m
l3，l4分别是履带中点距离前卫星定位天线的水平距离、履带中点距离悬挂机具刀尖的水平距离,m
l5，l6分别是悬挂机具的拉杆铰接点之间的距离和悬挂机具的宽度,m
α是升降油缸与垂线之间的角度,rad
依据车身的横向偏差和航向角，按照导航的非线性PID控制算法产生改变履带运动状态的纠正路径偏差的控制量，按照机具控制非线性PID控制算法产生使升降油缸、水平油缸动作的控制量；鉴于控制履带、升降油缸、水平油缸的油路属于串联性质，因此尽管每一次数据周期均可产生式(1)、式(3)和式(4)的计算结果，但是输出控制需要按照一定的节拍，并考虑不同作业场景的差异；如果是挂接旋耕机进行耕地作业时，直行阶段，导航控制器需要兼顾导航、作业深度、水平控制，以5拍为一个周期，按照输出节拍1：2：2的方式进行控制；转弯阶段，导航控制器需要兼顾作业深度与水平控制，仍然以5拍为一个周期，按照输出节拍3：2的方式进行控制；如果是挂接开沟机进行开沟作业，直行阶段，导航控制器兼顾导航、作业深度，输出控制节拍为1：4；转弯阶段，开沟机被抬升后，导航控制器只控制航向。
2.按照权利要求1所述的履带式农业机械的综合自动控制装置，其特征是：履带式旋耕机在直行阶段，导航控制器需要兼顾导航、作业深度、水平控制；履带式旋耕机的围框型覆盖式作业的路径规划中，旧的路径切换到新的路径采用1条45°弧线路径加一小段直行，再加1条45°弧线路径的方式；首先按照从外向内的路径作业，第n条路径是一条与紧邻的外侧路径(第n-1条)平行的、间距一个作业宽度M的路径，第n条路径的终点比紧邻的外侧路径(第n-1条)的终点缩短距离M；当路径规划到接近中线后，以此条路径为起点，实行从内向外的路径：新的路径逐条外移，每次移动一个作业宽度M，新路径的终点比紧邻的内侧路径的终点延长距离M；履带式旋耕机将自动靠近田块的最外围路径，可使履带式旋耕机反复地自动耕地；在距离每条直行路径的终点1.0米处，导航控制器发出慢速指令给调速控制卡，使得履带式旋耕机以慢速精确地到达路径的终点；履带式旋耕机在转弯阶段，导航控制器兼顾作业深度和水平控制；转弯后，在慢速中履带式旋耕机纠正路径偏差和航向姿态，持续2米之后，导航控制器发出中速指令给调速控制卡，按规划的路径前进作业。
3.按照权利要求1所述的履带式农业机械的综合自动控制装置，其特征是：设田块的宽度为W，长度为L，作业宽度为M,转弯半径为R，前进方向坐标为Y，横向方向坐标为X；履带式开沟机设计四条路径为一个周期，不断重复这个周期的路径，去程与回程路径之间的间距保持为一个作业宽度M，奇数序号的路径终点相同，都是Y＝L-R；偶数序号的路径终点相同，都是Y＝R；这种逐排平行行路径使履带式开沟机能自动运动到农田边界；设置一条与去程路径垂直的远端横直行路径，定义为Y＝L-M,上一条路径的终点是Y＝L-R-M，远端横直行路径的终点是X＝R；再设置一条近端横直行路径，定义为Y＝M,上一条路径的终点是Y＝R+M，近端横直行路径的终点是X＝W；两条横直行路径构成去程和回程，但不再有第四条路径；这样就构成了纵向为主，纵横联通的开沟路径。
4.按照权利要求1所述的履带式农业机械的综合自动控制装置，其特征是：直行阶段，履带式开沟机兼顾导航、作业深度的控制，在距离路径的终点1.0米处，导航控制器发出慢速指令给调速控制卡，使得履带式开沟机以慢速精确地到达路径的终点，导航控制器发出抬升开沟机的指令给履带机具板卡；履带式开沟机进入转弯阶段，此阶段导航控制器只监视转弯过程；导航控制器发出右转指令给履带机具板卡，右履带被制动，左履带运动，当航向角改变90°时，转弯阶段结束，履带式开沟机进入第二条路径，导航控制器只进行导航控制，当到达第二条路径的终点时，履带式开沟机再次进入90°转弯阶段，此阶段导航控制器只监视转弯过程；当转弯阶段结束，履带式开沟机进入回程路径，导航控制器发出下降开沟机的指令给履带机具板卡，履带式开沟机兼顾导航、作业深度的控制，此动作持续2米之后，导航控制器发出中速指令给调速控制卡，按规划的路径前进作业；在距离路径的终点1.0米处，再次进入慢速、左转弯模式，直到进入第四条路径；在完成一个路径周期之后，履带式开沟机重新进入去程路径，履带式开沟机又进入慢速调整轨迹、中速作业的顺序动作过程。
CN202010207778.5A 2020-03-23 2020-03-23 履带式农业机械的综合自动控制装置 Active CN111427347B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010207778.5A CN111427347B (zh) 2020-03-23 2020-03-23 履带式农业机械的综合自动控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010207778.5A CN111427347B (zh) 2020-03-23 2020-03-23 履带式农业机械的综合自动控制装置

Publications (2)

Publication Number Publication Date
CN111427347A CN111427347A (zh) 2020-07-17
CN111427347B true CN111427347B (zh) 2023-09-29

Family

ID=71549037

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010207778.5A Active CN111427347B (zh) 2020-03-23 2020-03-23 履带式农业机械的综合自动控制装置

Country Status (1)

Country Link
CN (1) CN111427347B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114342646A (zh) * 2022-01-19 2022-04-15 华中农业大学 一种割台离地高度的仿形检测与自适应调节系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102241379A (zh) * 2010-05-13 2011-11-16 济南谨恒节能技术有限公司 节能型行走式液压搬运机械
CN104898687A (zh) * 2014-08-21 2015-09-09 宁波市鄞州麦谷农业科技有限公司 履带式联合收割机的自动驾驶系统及其控制方法
CN206691199U (zh) * 2017-04-13 2017-12-01 农业部南京农业机械化研究所 履带式联合收割机自动式转向系统
US10066367B1 (en) * 2016-06-20 2018-09-04 Robo Industries, Inc. System for determining autonomous adjustments to an implement position and angle
CN108803644A (zh) * 2018-07-20 2018-11-13 浙江大学宁波理工学院 悬挂式农具水平自动控制装置
CN110199673A (zh) * 2019-04-09 2019-09-06 丰疆智能科技股份有限公司 带有旋耕机的联合收割设备

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8639416B2 (en) * 2003-03-20 2014-01-28 Agjunction Llc GNSS guidance and machine control
CA3045154A1 (en) * 2017-01-19 2018-07-26 Agjunction Llc Low cost implement positioning

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102241379A (zh) * 2010-05-13 2011-11-16 济南谨恒节能技术有限公司 节能型行走式液压搬运机械
CN104898687A (zh) * 2014-08-21 2015-09-09 宁波市鄞州麦谷农业科技有限公司 履带式联合收割机的自动驾驶系统及其控制方法
US10066367B1 (en) * 2016-06-20 2018-09-04 Robo Industries, Inc. System for determining autonomous adjustments to an implement position and angle
CN206691199U (zh) * 2017-04-13 2017-12-01 农业部南京农业机械化研究所 履带式联合收割机自动式转向系统
CN108803644A (zh) * 2018-07-20 2018-11-13 浙江大学宁波理工学院 悬挂式农具水平自动控制装置
CN110199673A (zh) * 2019-04-09 2019-09-06 丰疆智能科技股份有限公司 带有旋耕机的联合收割设备

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
樊桂菊 ; 王永振 ; 张晓辉 ; 赵金英 ; 宋月鹏 ; .果园升降平台自动调平控制系统设计与试验.农业工程学报.2017,(11),全文. *
黎永键 ; 赵祚喜 ; 黄培奎 ; 关伟 ; 吴晓鹏 ; .基于DGPS与双闭环控制的拖拉机自动导航系统.农业机械学报.2017,(02),全文. *

Also Published As

Publication number Publication date
CN111427347A (zh) 2020-07-17

Similar Documents

Publication Publication Date Title
Nørremark et al. The development and assessment of the accuracy of an autonomous GPS-based system for intra-row mechanical weed control in row crops
US10752237B2 (en) System and method for automatically leveling an agricultural implement
JP6525902B2 (ja) 圃場作業車両
JP2014187953A (ja) 作業情報共有システム
DE102021100324A1 (de) Steuern der Bewegung einer Maschine unter Verwendung von Sensorfusion
CN111427347B (zh) 履带式农业机械的综合自动控制装置
CN110476527B (zh) 作业车
US11737385B2 (en) Automated implement level sensing control system of a work machine and method thereof
CN109729772A (zh) 一种拖拉机多自由度电控液压悬挂控制系统及方法
Jing et al. Path tracking control with slip compensation of a global navigation satellite system based tractor-scraper land levelling system
EP3854190A1 (en) Systems and methods for monitoring tillage conditions
Jing et al. Development of a GNSS/INS-based automatic navigation land levelling system
JP2024038359A (ja) 連結装置の制御方法
CN108803644A (zh) 悬挂式农具水平自动控制装置
CN115176562B (zh) 一种可实现路径跟踪的玉米免耕播种机器人
CN109804733A (zh) 多功能半悬挂式自动控制翻转犁及工作方法
CN213426853U (zh) 一种拖拉机自动平衡液压悬挂装置
CA3124082A1 (en) AUTONOMOUS FOLDING AGRICULTURAL DEVICE AND METHOD
CN115997510B (zh) 一种电动拖拉机电液调平悬挂系统及其控制方法
RU2794670C1 (ru) Система автономного управления дорожно-строительной машины
JPH09248012A (ja) クローラ式土工車両の作業機耕深制御装置及びその方法
CN209643284U (zh) 多功能半悬挂式自动控制的翻转犁
JP3618226B2 (ja) 作業機
CN220776406U (zh) 一种新型液压翻转犁
CN221728850U (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