泉州基于GPS导航的插秧机作业控制系统

    引言

    农机智能化是国内外农业机械发展的必然趋势，是实现精准农业的关键手段。插秧机的智能化研究可分为自主导航控制和田间作业的自动控制两部分。在自主导航控制方面，Nagasaka Yoshisada等开发了久保田SPU -650型插秧机的自动导航系统。张智刚、胡炼等开发了基于GPS技术和CAN总线通信的导航控制系统，田间作业直线跟踪误差小于0.2 m。任文涛等以久保田NSD8型插秧机为研究平台，在不改变原有转向机构的前提下，设计了一种遥控自动转向系统。伟利国等以XDN2630型水稻插秧机为试验平台，采用RTK-GPS技术和PID控制算法，实现了自动对行导航及地头转向控制。胡静涛等研制了农机导航试验平台，开发了具有较强通用性的农机自动导航控制系统。

    国内研究机构在进行插秧机导航控制研究的同时，也进行了插秧机栽插作业的自动控制初步探索。华南农业大学对插秧机变速机构和栽插作业机构采用直流电动机进行电控改造，实现了转向机构、变速机构和机具升降机构的自动控制，其电控操作时间比驾驶员操作时间略长。中国农业机械化科学研究院对插秧机的无级变速系统、制动系统、栽插升降系统原有的机械结构进行了改进，采用电动推杆进行控制口，并开发了根据插秧机行进速度无级调节插秧株距的控制系统，设计了插秧机插植部水平智能控制系统。

    本文以洋马VP6型高速插秧机为试验平台，对主变速操作、插植操作机构和变速机构进行电控改造，在此基础上设计基于GPS导航的田间作业控制系统，该系统能够根据处方图来控制插植机构的升降、插植动作的启停以及插秧机的行驶速度。

1  插秧机田间作业主要操作机构电控改造

1.1  插秧机操作机构

    洋马VP6型高速水稻插秧机为4轮驱动的6行乘坐式插秧机。为满足智能操作控制系统的要求，对主要作业操作机构包括主变速手柄、插植手柄和变速踏板进行了电控改造。

    插秧机主变速手柄与行走变速轴的外变速臂相连，用于行进方向与行走速度的切换，可在移动、中立、前进、补苗、后退挡位间切换，其结构如图1所示。其中移动挡位用于插秧机高速行走在农道上，中立位置用于仅驱动插植机构。因此，插秧机在田间工作时主要在前进、补苗、后退3个挡位之间切换。

    插秧机插植手柄与变速箱的插植离合臂相连，

可进行插植机构的升降，以及插植动作的开始与停

止，其结构如图2所示。其中，升、中立、降3挡位用

于插植机构的升降及固定，合和离2挡位用于控制

插植动作的开始和停止。

    插秧机把传动效率高的齿轮变速和易操作的HST (Hydro static transmission，HST)变速相结合开发出了液压机械无级变速结构，使速度调节简单易操作，从零起动到高速插秧，只要通过变速踏板的踩踏就能实现。插秧机变速踏板与HST无级变速箱的变速臂相连，如图3所示。踩下变速踏板行走速度加快，松开变速踏板则行走速度减慢，完全松开则行走停止。

1.2  主变速操作和插植操作机构电控改造

    插秧机主变速操作和插植操作机构的机械结构类似，其动作可以看作为绕某一转动轴的圆周运动，挡位之间的切换可以简化为转动角度的变换。为了不影响插秧机的手动操作，对2个手柄本身的机械机构未进行改变，而是采用了步进电动机驱动2个操作手柄的转动轴，实现了主变速和插植作业的自动控制，其改造如图4所示。与直流电动机控制方法相比，步进电动机更易于实现位置控制，并且电控操作时间可通过调节控制频率的方法实现。

1.3变速机构电控改造

    变速踏板的踩踏幅度可改变插秧机行驶速度。在本系统中，选用带位置反馈的电动推杆实现对插秧机行驶速度的控制，将变速踏板与电动推杆用钢丝绳连接，其改造如图5所示。电动推杆收缩时，钢丝绳拉动踏板实现加速；电动推杆伸长时，踏板靠弹力恢复原位。同时，变速踏板的位置可通过电动推杆内置的电位器进行测量用于控制，其结构更加紧凑，且安装方便。2  田间作业控制系统设计

2.1  总体设计方案

    系统设计的主要目标是实现插秧机田间作业的自动控制，并与GPS导航系统相结合，实现精准作业。其主要功能包括：作业处方图的下载和解析；插植作业的自动控制；插秧机行驶速度控制。系统总体结构设计如图6所示。

    田间计算机负责人机交互，配置各种参数，实时显示农机位置和速度等信息，并把处方图通过CAN总线下载到智能作业控制器；导航控制器根据规划路径控制插秧机精确跟踪行驶；智能作业控制器与导航控制器相配合，根据处方图通过插植手柄控制插植机构的升降和插植动作的启停，完成插秧机田间插秧作业，并根据处方图的要求调节主变速手柄挡位控制插秧机的前进、后退和停止，同时实时采集插秧机的行驶速度发送到田间计算机显示，通过变速踏板控制插秧机按照处方图设定的速度行驶。

2.2  智能作业控制器硬件设计

    插秧机作业控制器是以NXP公司ARM9处理器LPC3250为基础设计的，根据其功能划分为ARM9控制器最小系统、速度控制电路、CAN收发电路、手柄控制电路及扩展功能电路5部分，其硬件结构如图7所示。

    ARM9控制器最小系统包括YL3250核心电路、电源电路及JTAG接口；速度控制电路包括速度信号调理电路和推杆驱动电路，速度信号调理电路将速度传感器输出的频率信号经过调理后送至LPC3250的定时计数器端口，推杆驱动电路选用双全桥电动机专用驱动芯片L298控制推杆电动机正反转，通过控制推杆运行时间来实现插秧机行驶速度的改变；手柄控制电路能够通过外置的定时／计数芯片82C54来产生用于控制手柄控制步进电动机的频率控制信号，从而控制主变速手柄和插植手柄的动作；系统使用CAN控制器SJA1000T和CAN驱动器CTM8251T的CAN收发电路，支持CAN2. OB协议。

2.3  智能作业控制器软件设计

    插秧机智能作业控制器的软件部分是基于uC／OS实时操作系统开发的，它是一种公开源代码、结构小巧、可移植、可固化、可裁剪、可剥夺型实时内核‘埘。它包含了任务调度、任务管理、时间管理、内存管理和任务间的通信和同步等基本功能。

    uC／OS内核使用时将其完成的功能划分成优先级不同的任务，然后对每个任务编程。任务划分是软件设计的主要任务。

    根据上面所提到的插秧机作业控制器的主要功能，将控制器的任务设计为5个：

    1)开始任务StartTask O，对系统需要的定时器、EMC、I/O口等进行初始化。

    2) CAN分析任务CANTask O，读取CAN总线的数据，并对CAN数据进行分析，实现处方图解析、开始或停止控制等。

    3)速度测量任务SpeedTask O，周期性地测量速度值，并发送到CAN总线，用于田间计算机显示和速度控制。

    4）手柄操作任务HandleTask 0，根据插秧机田间作业处方图，当插秧机行驶到相应位置时，降下插植机构并开始插植动作或停止插植动作并升起插植机构，同时根据处方图的要求实现插秧机的前进、后退以及停止控制。

    5)速度控制任务ControlTask 0，将实时测得的插秧机行驶速度值与处方图设定的行驶速度值进行比较，采用增量式不完全微分PD速度控制算法，控制插秧机的行驶速度，

3试验

    为了验证插秧机的田间作业控制系统的整体性能和控制精度，在上述电控改造的插秧机平台上，进行作业自动控制的路面试验，如图8所示。

    系统试验基于A -B直线导航作业，其行驶路径规划如图9所示。插秧机沿4 -B间直线行驶，当插秧机行进到A点时，插秧机减速，到达A，点时停止，此时降下插植机构，开始插植动作，并拉下变速踏板，控制插秧机行驶速度保持在设定值；当插秧机行进到B，点时，松开变速踏板，到达B点时停止，此时升起插植机构。系统试验设定插秧机行驶速度为多个值，进行多次试验观察控制结果。

    道路试验开始时，先将包含起止作业位置与设定作业速度信息的处方图由田间计算机的任务管理功能下载到智能作业控制器。智能作业控制器根据处方图的要求实现插植作业的自动控制，并控制插秧机行驶在设定速度。

    试验结果表明，作业控制系统能够根据处方图的要求在规划的位置完成插秧机插植作业和行走速度的自动控制。当速度值设定分别为0.5、0.8和1.0 m/s时，其速度控制结果如图10所示。

由图10和表1可知，插秧机速度控制的调整时间随着设定值的加大而增加；当速度设定值为0.5 m/s时，速度控制的各个误差均最小，控制效果最好；插秧机在不同设定速度下的速度控制平均误差小于0.011 3 m/s，满足了插秧机作业的需求。

4  结束语

    设计了基于GPS导航系统的插秧机作业控制系统，实现了插植机构升降和插植动作启停的电控操作以及行驶速度的自动控制，并与导航系统相配合进行了道路试验。试验结果表明，作业控制系统能够与GPS导航系统相结合，实现插秧机田间作业的智能控制，速度控制平均误差小于0. 011 3 m/s，满足了插秧机自动控制的要求。