高地隙施藥機自動駕駛系統(tǒng)研制與試驗

印 祥，安家豪，王艷鑫，王應(yīng)寬,2，金誠謙,3※

（1. 山東理工大學(xué)農(nóng)業(yè)工程與食品科學(xué)學(xué)院，淄博 255000；2. 農(nóng)業(yè)農(nóng)村部規(guī)劃設(shè)計研究院，北京 100125； 3. 農(nóng)業(yè)農(nóng)村部南京農(nóng)業(yè)機械化研究所，南京 210000）

0 引言

隨著衛(wèi)星定位、自動導(dǎo)航、機電液融合控制等技術(shù)在農(nóng)業(yè)中的深入應(yīng)用，農(nóng)業(yè)機械的自動化和智能化水平不斷提高。具備自動導(dǎo)航和自動駕駛的智能農(nóng)機裝備已經(jīng)開始應(yīng)用于農(nóng)業(yè)生產(chǎn)，在保證田間作業(yè)質(zhì)量的同時減輕了工作人員勞動強度，代表著未來農(nóng)業(yè)的發(fā)展方向[1-3]。

農(nóng)業(yè)機械在田間行駛的同時需要完成既定的作業(yè)任務(wù)，即實現(xiàn)行走底盤和作業(yè)機構(gòu)的一體化控制。在自動駕駛作業(yè)過程中，需要以機具路徑跟蹤為研究對象進行實時定位與導(dǎo)航控制[4-5]。黎永鍵等[6-10]以實時動態(tài)全球?qū)Ш叫l(wèi)星系統(tǒng)（Real-Time Kinematic Global Navigation Satellite System, RTK-GNSS）和慣性測量單元（Inertial Measurement Unit, IMU）作為導(dǎo)航傳感器開發(fā)具備自動行走與機具控制的拖拉機、高地隙施藥機、聯(lián)合收獲機、插秧機。

高地隙施藥機作為一種高效的田間管理農(nóng)業(yè)機械，主要用于液態(tài)農(nóng)藥和化肥的噴施。其自動駕駛系統(tǒng)主要包括導(dǎo)航控制系統(tǒng)、遙控操作系統(tǒng)、行走控制系統(tǒng)和噴藥控制系統(tǒng)等4個子系統(tǒng)。在導(dǎo)航控制系統(tǒng)研究方面，許多研究人員針對輪式農(nóng)田車輛的路徑跟蹤建立了車輛運動數(shù)學(xué)模型、導(dǎo)航誤差計算方法和跟蹤控制算法，設(shè)計了轉(zhuǎn)向控制器和導(dǎo)航控制器，在水平路面上的直線路徑跟蹤誤差小于5 cm，田間試驗路徑跟蹤誤差均小于10 cm[11-15]。自動駕駛高地隙施藥機的行走控制功能主要包括自動轉(zhuǎn)向、速度自動調(diào)節(jié)和油門自動控制。楊洋等[16-18]采用多種型式的電機及傳動機構(gòu)替代原車方向盤，通過控制電機的旋轉(zhuǎn)速度和旋轉(zhuǎn)方向?qū)崿F(xiàn)轉(zhuǎn)向輪的角度偏轉(zhuǎn)。在噴藥控制方面，蔣煥煜等[19-21]采用基于機器行駛速度或作物空間變異的精量噴霧控制方法，調(diào)節(jié)電控流量閥的出口開度或脈沖寬度調(diào)制（Pulse Width Modulation, PWM）噴頭的占空比以達到施藥量的自動控制。

從以上分析可以看出，在農(nóng)業(yè)機械自動導(dǎo)航、電動自動轉(zhuǎn)向、精量施藥等方面已經(jīng)具備較為成熟的技術(shù)和產(chǎn)品，其中的各個產(chǎn)品均具備獨立的操作系統(tǒng)和通信協(xié)議。對于一個完整的自動駕駛作業(yè)機組，要實現(xiàn)自主行走、精量作業(yè)等功能的集成控制，打破各個子系統(tǒng)間的軟硬件技術(shù)壁壘，就必須解決操控機構(gòu)自動化及軟硬件標(biāo)準(zhǔn)化的問題。在高地隙施藥機的自動駕駛系統(tǒng)研究方面，需要考慮上述各個子系統(tǒng)的融合控制、自動導(dǎo)航和遙控操作2種模式間的切換、各子系統(tǒng)間的數(shù)據(jù)交換以及整機性能的優(yōu)化。

為提高田間施藥的作業(yè)效率和質(zhì)量、有效應(yīng)對勞動人員農(nóng)藥中毒的潛在風(fēng)險，本研究以高地隙施藥機自動駕駛為研究對象，開展以自主行走與執(zhí)行機構(gòu)自動控制為核心的多系統(tǒng)融合控制研究?；谧灾餮邪l(fā)的電動自動轉(zhuǎn)向系統(tǒng)、自動導(dǎo)航系統(tǒng)、油門調(diào)節(jié)器和靜液壓傳動（Hydro-Static Transmission, HST）調(diào)節(jié)器，建立適用于高地隙施藥機的自動控制策略、傾斜補償方法、路徑規(guī)劃方法和噴霧控制方法，實現(xiàn)高地隙施藥機的自動駕駛。

1 高地隙施藥自動駕駛系統(tǒng)組成

自動駕駛高地隙施藥系統(tǒng)以山東華盛中天機械集團股份有限公司的3WP-500G噴桿噴霧機為平臺，由行走控制系統(tǒng)、噴霧控制系統(tǒng)、導(dǎo)航控制系統(tǒng)、遙控處理模塊、自動駕駛地面站組成，如圖1所示。其中，噴桿噴霧機的性能參數(shù)如表1所示。導(dǎo)航控制系統(tǒng)和遙控處理模塊同時接收自動駕駛地面站的操控信號，將控制指令發(fā)布至CAN總線，行走控制系統(tǒng)和噴霧控制系統(tǒng)接收并執(zhí)行CAN總線指令。

表1 華盛3WP-500G噴桿噴霧機主要技術(shù)指標(biāo) Table 1 Main technical index of Huasheng 3WP-500G sprayer

高地隙施藥機自動駕駛系統(tǒng)所使用的平臺具備全液壓助力轉(zhuǎn)向器、HST驅(qū)動系統(tǒng)、拉線式的無級變速器、油門調(diào)節(jié)器和制動裝置，其三段噴桿的升降和伸縮均采用電磁換向閥控制，液泵輸入軸通過電磁離合器與發(fā)動機輸出軸聯(lián)接。噴霧控制系統(tǒng)采用寧波市力成農(nóng)用噴霧技術(shù)有限公司的三段式噴霧閥組，能夠根據(jù)行駛車速實時調(diào)節(jié)流量閥的開口大小以保證施藥量的均勻一致，如圖2所示。

導(dǎo)航控制系統(tǒng)采用基于天寶定位板卡BD982和RTX差分服務(wù)的雙天線定位定向接收機和VectorNav的慣性測量單元VN100作為導(dǎo)航傳感器。導(dǎo)航控制器由山東理工大學(xué)自主研發(fā)[15]，用以接收位置和姿態(tài)信息、運行數(shù)據(jù)處理和導(dǎo)航算法，并向行走控制系統(tǒng)和噴霧控制系統(tǒng)發(fā)送指令數(shù)據(jù)。

自動駕駛地面站通過收發(fā)電臺與導(dǎo)航控制系統(tǒng)、遙控處理模塊進行數(shù)據(jù)傳輸，其導(dǎo)航操控終端與導(dǎo)航控制系統(tǒng)遠(yuǎn)程連接，進行參數(shù)設(shè)置、路徑規(guī)劃、過程監(jiān)控等導(dǎo)航操作。遙控器與遙控接收機無線連接，接收機的輸出信號由信號預(yù)處理器負(fù)責(zé)轉(zhuǎn)換并發(fā)布至CAN總線上。

根據(jù)高地隙施藥機的行走操作機構(gòu)、噴霧閥組的動作原理、自動駕駛系統(tǒng)結(jié)構(gòu)及功能，本研究在設(shè)計自動操控機構(gòu)的基礎(chǔ)上制定了CAN總線通信控制協(xié)議，并針對高地隙施藥機自動導(dǎo)航需求提出基于傾斜補償?shù)亩ㄎ徽`差校正方法、適用于寬幅作業(yè)的路徑規(guī)劃方法以及相對安裝位置自動標(biāo)定方法。

2 高地隙施藥機的控制系統(tǒng)設(shè)計

高地隙施藥機的自動控制包括行走控制和噴霧控制兩部分。在行走控制方面，因變速、油門、制動等機構(gòu)均采用拉線式，在此以自動油門裝置設(shè)計為例介紹其結(jié)構(gòu)和工作原理。自動轉(zhuǎn)向裝置采用低成本的普通直流無刷電機，進行轉(zhuǎn)向控制器設(shè)計。

2.1 自動油門裝置

自動油門裝置用于實時接收操作指令，根據(jù)指令數(shù)據(jù)調(diào)節(jié)油門大小。薛金林等[22]針對拖拉機油門踏板的動作過程設(shè)計了基于電動推桿的油門調(diào)節(jié)裝置，用編碼器檢測并反饋油門開度。本研究中的高地隙施藥機采用拉線式油門通過操作手柄調(diào)節(jié)其大小，如圖3所示。

自動油門裝置由油門電子控制單元（Electronic Control Unit, ECU）、WDD35D旋轉(zhuǎn)電位計、減速電機、拉線輪組成，主要工作部件的性能參數(shù)如表2所示。

表2 自動油門裝置主要部件參數(shù) Table 2 Values of main components of automatic throttle mechanism

油門拉線的一端固定并繞在拉線輪上，拉線輪在減速電機帶動下轉(zhuǎn)動以改變油門大小。旋轉(zhuǎn)電位計的輸入軸隨拉線輪轉(zhuǎn)動以測量拉線輪的旋轉(zhuǎn)位置。油門ECU以PIC18F258處理器為核心，由PCA82C250提供CAN總線物理接口，由4個CMOS功率管的通斷組合控制電機的正反轉(zhuǎn)，其接線原理如圖4所示。

當(dāng)C0高電平、C1低電平時，S1和S4導(dǎo)通，減速電機正轉(zhuǎn)；當(dāng)C0低電平、C1高電平時，S2和S3導(dǎo)通，減速電機反轉(zhuǎn)。油門ECU通過A/D轉(zhuǎn)換端口A0實時讀取電位計反饋的數(shù)值，將此數(shù)值與CAN總線上的油門指令進行比較，通過端口C0、C1的高底電平控制MOS管開關(guān)S1、S2、S3、S4的通斷，使減速電機帶動拉線輪旋轉(zhuǎn)至期望位置。

自動變速裝置通過拉線調(diào)節(jié)靜液壓傳動（Hydro-Static Transmission，HST）轉(zhuǎn)臂的位置，而自動制動裝置通過拉線壓緊制動器的定盤和動盤。除拉線行程不同外，其結(jié)構(gòu)和工作過程均與自動油門裝置相同。在實際安裝使用時，需根據(jù)拉線的極限位置確定拉線輪的旋轉(zhuǎn)角度范圍。

2.2 自動轉(zhuǎn)向裝置

自動轉(zhuǎn)向系統(tǒng)根據(jù)轉(zhuǎn)向指令將導(dǎo)向輪旋轉(zhuǎn)至期望角度。楊洋等[16,23]采用直流電機帶動全液壓助力轉(zhuǎn)向器的方式實現(xiàn)了高速插秧機等農(nóng)業(yè)機械的自動轉(zhuǎn)向，針對電機工作原理、控制方式和通信協(xié)議開發(fā)了轉(zhuǎn)向控制器。其系統(tǒng)的工作性能、輸出扭矩和集成應(yīng)用受限于廠家提供的電機結(jié)構(gòu)和通信協(xié)議，無法滿足自動駕駛高地隙施藥機對轉(zhuǎn)向裝置兼容性的功能需求。

本文開發(fā)的自動轉(zhuǎn)向裝置由轉(zhuǎn)向電機、轉(zhuǎn)向控制器、角度傳感器組成。轉(zhuǎn)向電機由12V、100W的直流無刷電機和速比為40的減速器組成，其輸出扭矩和轉(zhuǎn)速的額定值分別為10 N·m和80 r/min，如圖5所示。轉(zhuǎn)向電機為空心軸輸出，輸出軸的下端與液壓轉(zhuǎn)向器聯(lián)接，上端與方向盤聯(lián)接以便于觀察轉(zhuǎn)向機構(gòu)的動作。角度傳感器用于測量轉(zhuǎn)向輪的偏轉(zhuǎn)角度，以模擬電壓形式反饋至轉(zhuǎn)向控制器。

轉(zhuǎn)向控制器由轉(zhuǎn)向控制模塊和電機驅(qū)動器組成，轉(zhuǎn)向控制模塊以PIC18F258為核心處理器，接收CAN總線上的轉(zhuǎn)向指令，讀取角度傳感器的測量值，控制減速電機帶動全液壓轉(zhuǎn)向器動作，使轉(zhuǎn)向輪旋轉(zhuǎn)至期望角度，其工作原理如圖6所示。

2.3 精量噴霧控制器

針對噴霧閥組中流量閥的執(zhí)行機構(gòu)及其特性，設(shè)計了如圖7所示的精量噴霧控制器，包括PIC18F258單片機及外圍電路、CAN總線物理芯片PCA82C250、L298N電機驅(qū)動器。

精量噴霧控制器接收CAN總線上的速度信息和期望流量值，通過端口C0、C1、C2控制流量閥電機的動作以調(diào)節(jié)其開口大小從而改變藥液流量。

2.4 CAN總線通信網(wǎng)絡(luò)

自動駕駛高地隙施藥機具備油門、車速、剎車、噴桿、液泵、精量噴霧、發(fā)動機啟停等多個控制裝置的ECU，均需接收導(dǎo)航系統(tǒng)和遙控裝置的控制指令。為便于ECU間的數(shù)據(jù)傳輸，設(shè)計了圖8所示的CAN總線通信網(wǎng)絡(luò)，具備不同ID的所有節(jié)點均可收發(fā)CAN總線信息。

人工遙控/自動導(dǎo)航2種控制模式間的切換由遙控操作系統(tǒng)進行決定，各個執(zhí)行機構(gòu)的ECU接收導(dǎo)航控制系統(tǒng)和遙控操作系統(tǒng)發(fā)布的CAN總線控制指令（油門、車速、轉(zhuǎn)向、剎車、噴桿伸縮與升降、液泵啟停、發(fā)動機啟動/熄火等）并根據(jù)控制模式和節(jié)點ID選擇執(zhí)行相應(yīng)的CAN總線控制指令。

3 導(dǎo)航控制方法

3.1 定位誤差校正

自動駕駛高地隙施藥機為自走式農(nóng)業(yè)機械，整機質(zhì)量1 300 kg，輪胎寬度12 mm。與拖拉機、聯(lián)合收獲機相比，其質(zhì)量較小、胎面較窄，受田間地面起伏的影響極易發(fā)生傾斜。底盤最小離地間隙為1 100 mm，GNSS天線固定位置的離地高度為2.46 m，在左右傾斜（即橫滾角）1°時天線偏離誤差達40 mm，在作業(yè)過程中需要實時感知車體的傾斜角度以進行定位測量誤差校正，如圖9所示。

He等[24]基于三維姿態(tài)傳感器測量插秧機的空間姿態(tài)，并根據(jù)RTK定位系統(tǒng)測量得到的位置數(shù)據(jù)計算插秧機構(gòu)的實際位置，以消除機體傾斜引起的定位誤差。其在計算過程中，需要精確測量天線與機體、機體與插秧部的相對位置。而對于不同機型，實際相對測量精度難以保證。在直線導(dǎo)航過程中，在一定傾斜范圍內(nèi)機體的橫滾角對橫向偏差影響最大、對航向角的影響可忽略，而俯仰角對橫向偏差和航向角測量的影響可以忽略。因此，本研究在考慮橫滾角的前提下，只需測量天線中心位置與機具中心的相對距離，便于導(dǎo)航系統(tǒng)在現(xiàn)場的快速安裝使用。

定位天線和定向天線分別安裝于機器的左右兩側(cè)，以垂直于地面的天線所在平面、車體中心線、地面三者的交點位置作為機器的實際位置，則在車體橫向平面內(nèi)定位天線與重心O的橫向距離ε為：

其中，

根據(jù)Δδ的值可以判斷點AL相對于車體中心線的位置。當(dāng)AL位于車體中心線的左側(cè)和右側(cè)時，矢量ALO的方向角ΨA分別如式（3）和（4）所示。

式中ΨV為RTK-GNSS車體航向角，以UTM平面坐標(biāo)系的正北為基準(zhǔn)。點O的平面坐標(biāo)（EO，NO）由AL坐標(biāo)（EA，NA）按式（5）計算。

3.2 作業(yè)路徑規(guī)劃

自動駕駛高地隙施藥機在自動導(dǎo)航模式下，能夠按照路徑規(guī)劃完成直線自動行駛、地頭自動調(diào)頭、自動上線等基本動作。在水平路面上的最小轉(zhuǎn)彎半徑R是3.5 m，噴幅W是12 m，按照矩形地頭轉(zhuǎn)彎方式進行路徑規(guī)劃，如圖10所示。

當(dāng)機器到達點A后開始執(zhí)行地頭調(diào)頭過程，以最小轉(zhuǎn)彎半徑轉(zhuǎn)彎至點B后沿直線行駛至點C，然后以最小轉(zhuǎn)彎半徑到達點D，接著沿下一作業(yè)路徑繼續(xù)直線作業(yè)。在自動導(dǎo)航過程中機器一直處于行駛狀態(tài)，因?qū)Ш秸`差和位置測量采樣間隔的存在，機器不可能經(jīng)過點A。因此，需要綜合考慮以上因素判斷機器是否到達地頭。在采樣頻率足夠大、導(dǎo)航精度較高的情況下，機器以較小的橫向偏差經(jīng)過點A，按公式（6）計算當(dāng)前位置測量點E與點A的距離d。

式中η為機器當(dāng)前位置E的平面坐標(biāo)；ηA為點A的平面位置坐標(biāo)。當(dāng)距離d小于設(shè)定值時，即判斷為到達地頭。在導(dǎo)航精度較差的情況下，因橫向偏差較大，距離d不會小于設(shè)定值，采用如下方法計算夾角α：

若α>90°，即判斷機器到達地頭。

在實際作業(yè)過程，因作業(yè)地塊土質(zhì)差異和機器自重變化，其最小轉(zhuǎn)彎半徑有所不同。為保證地頭調(diào)頭時路徑跟蹤的準(zhǔn)確性、調(diào)頭后上線的快速精準(zhǔn)，在作業(yè)過程中實時測量最小轉(zhuǎn)彎半徑R。

在機器到達點B后，根據(jù)半徑R的大小由公式（9）和（10）分別計算點B和點C的平面坐標(biāo)（EB，NB）和（EC，NC），以生成導(dǎo)航路徑并使機器沿路徑BC自動行駛。

矢量的方向角ΨAB和ΨAC由公式（12）計算。

3.3 關(guān)鍵參數(shù)自動標(biāo)定

因機體結(jié)構(gòu)尺寸不同、安裝過程存在一定的隨機性，導(dǎo)航傳感器在自動駕駛高地隙施藥機上的固定位置有所差異，需要事先對與導(dǎo)航控制相關(guān)的多個關(guān)鍵參數(shù)進行標(biāo)定，主要包括航向、姿態(tài)、轉(zhuǎn)向角度極限位置、直線行駛前輪角度等。其中，航向的準(zhǔn)確測量受定位天線和定向天線安裝位置的影響，且需要在機器行駛過程中進行標(biāo)定。

如圖11所示，航向自動標(biāo)定過程中，機器從η0開始以固定的轉(zhuǎn)向角前進，同時記錄RTK-GNSS測量的位置序列和航向序列，計算行駛距離d0：

當(dāng)d0大于行駛距離設(shè)定值時，航向角變化值ΔΨ為：

式中Ψ和Ψ0分別為機器在η和η0時的航向角，(°)。若ΔΨ小于航向角變化設(shè)定值1.5°，則認(rèn)為機器直線行駛，此時機器實際航向角ΨV由公式（15）計算。

其中（E0，N0）和（E，N）分別為位置η0和η的UTM平面坐標(biāo)。在位置η時的航向測量值為Ψm，測量航向偏差為

則在標(biāo)定后的航向角為

同時，記錄位置η處的角度傳感器的測量值φ0，即為機器直線行駛時的前輪角度。在自動轉(zhuǎn)向過程中，轉(zhuǎn)向控制器以φ0值為直線行駛基準(zhǔn)，根據(jù)轉(zhuǎn)向指令計算前輪的目標(biāo)角度。

4 田間試驗

為了測試人工遙控和自動導(dǎo)航2種操作模式下的系統(tǒng)穩(wěn)定性和路徑跟蹤精度，于2020年9月在山東省淄博市山東理工大學(xué)生態(tài)無人農(nóng)場進行田間試驗。

4.1 試驗條件

試驗地塊的前茬作物是青貯玉米，行距60 cm，青貯收獲后的留茬高度20～25 cm，如圖12所示。

試驗區(qū)域為60 m×30 m，在人工遙控和自動導(dǎo)航2種模式下的直線行駛和地頭轉(zhuǎn)彎分別重復(fù)3次，用車體上安裝的VectorNav VN-100型IMU測得田間行駛時的橫滾角范圍是-3.5°～+3.5°。

4.2 試驗方法

自動駕駛高地隙施藥機的作業(yè)幅寬是12 m，作業(yè)路徑為直線，采用矩形地頭轉(zhuǎn)彎方式。人工遙控和自動導(dǎo)航時的測試速度均為3.6 km/h。

如圖13所示，用RTK-GNSS測量作業(yè)區(qū)域中A0、B0兩點的坐標(biāo)（588 536.219，4 073 823.937）、（588 587.175，4 073 817.858），用拉直的軟繩標(biāo)記出基準(zhǔn)行A0B0及相鄰行A1B1為人工遙控操作提供參考。為避免標(biāo)記路線與實際行駛路徑重合不便于人工操作，設(shè)置50 cm的左側(cè)偏移量使目標(biāo)路徑與規(guī)劃路徑橫向偏移50 cm。自動駕駛高地隙施藥機從點A0開始啟動作業(yè)，行駛路線為A0→B0、B1→A1，到達邊界時進行地頭轉(zhuǎn)彎后進入鄰接行繼續(xù)作業(yè)。在人工遙控模式下，操作人員跟隨機器移動的同時使用遙控器控制機器的動作使其沿軟繩標(biāo)記出的直線作業(yè)行前進，用RTK-GNSS記錄行駛路徑并計算橫向偏差和航向偏差。在自動導(dǎo)航模式下，導(dǎo)航控制器向機器各ECU發(fā)送指令實現(xiàn)路徑自動跟蹤等動作，自動完成地頭轉(zhuǎn)彎并進入下一直線作業(yè)行。

4.3 結(jié)果與分析

圖14 為人工遙控和自動導(dǎo)航2種模式下的實際行駛路徑與規(guī)劃路徑對比。在人工遙控模式下，由人工操作遙控器使自動駕駛高地隙施藥機從點C0（588 541.066，4 073 824.061）出發(fā)沿目標(biāo)路徑A0B0和A1B1。在自動導(dǎo)航模式下，自動駕駛高地隙施藥機從點C0（588 540.798，4 073 824.147）出發(fā)，其初始橫向偏移和航向偏角分別為14 cm和4.4°，上線距離是2.2 m，橫向偏差和航向偏角收斂至平均值的距離是3.3 m。

在地頭轉(zhuǎn)彎控制方面，人工遙控模式下的轉(zhuǎn)彎過程存在一定的隨機性，在積累一定的作業(yè)經(jīng)驗后操作人員能夠保證轉(zhuǎn)彎后的準(zhǔn)確快速上線。而自動導(dǎo)航模式下的轉(zhuǎn)彎過程較為穩(wěn)定，能夠根據(jù)轉(zhuǎn)彎方式自動完成調(diào)頭并準(zhǔn)確快速上線。人工遙控和自動導(dǎo)航下的直線路徑跟蹤誤差如表3所示。

由表3中可知，人工遙控模式下直線路徑跟蹤的橫向偏差和航向偏角的最大值分別為20.81 cm和7.86°，RMS誤差最大值分別為7.47 cm和2.66°。橫向偏差在0附近波動，平均值為0.02和0.90 cm，表明操作人員能夠感知到較大偏離并及時操控機器做出響應(yīng)，同時表明自動轉(zhuǎn)向系統(tǒng)能夠?qū)崟r執(zhí)行人工遙控操作指令將轉(zhuǎn)向輪偏轉(zhuǎn)至目標(biāo)角度，轉(zhuǎn)向響應(yīng)特性和準(zhǔn)確度均滿足作業(yè)要求。自動導(dǎo)航模式下直線路徑跟蹤的橫向偏差和航向偏角的最大值分別為8.84 cm和2.48°，直線作業(yè)路徑的RMS誤差最大值分別為4.66 cm和1.08°。由人工遙控和自動導(dǎo)航兩種模式下的數(shù)據(jù)對比可以看出，自動導(dǎo)航模式下路徑跟蹤的RMS誤差值均小于人工遙控模式下的誤差值，具備較高的路徑跟蹤精度。同文獻[7]所研制的噴桿噴霧機自動導(dǎo)航系統(tǒng)在旱田條件下的試驗結(jié)果相比，其最大橫向偏差和最大RMS誤差均較小，能夠滿足噴霧作業(yè)要求。因此，在自動導(dǎo)航模式下所研制的高地隙施藥機自動駕駛系統(tǒng)具備快速收斂性且保持較高的穩(wěn)定性和準(zhǔn)確度。而人工遙控模式下，需要操作人員兼顧橫向偏差和航向偏角的同時自行確定前輪轉(zhuǎn)向角的大小，且航向偏角較小時肉眼難以感知導(dǎo)致誤差過大且不穩(wěn)定。

表3 人工遙控和自動導(dǎo)航模式下的路徑跟蹤誤差 Table 3 Path tracking errors under manual remote control and autonomous navigation

5 結(jié) 論

為提高施藥作業(yè)機械的自動化和智能化程度，避免操作人員現(xiàn)場農(nóng)藥中毒等潛在風(fēng)險，本文以高地隙施藥機自動駕駛系統(tǒng)為研究對象，設(shè)計了操縱機械關(guān)鍵部件和自動導(dǎo)航控制方法，并對高地隙施藥機自動駕駛系統(tǒng)的田間作業(yè)性能進行了試驗驗證，主要結(jié)論如下：

1）設(shè)計了用于油門調(diào)節(jié)、車速調(diào)節(jié)、自動轉(zhuǎn)向、發(fā)動機啟停、噴桿伸縮、液泵啟停的自動執(zhí)行機構(gòu)、控制ECU和CAN總線通信控制系統(tǒng)，能夠接收人工遙控系統(tǒng)和自動導(dǎo)航系統(tǒng)的控制指令，實現(xiàn)了作業(yè)模式的實時切換；

2）通過分析定位誤差來源，提出了傾斜誤差補償方法，根據(jù)天線安裝位置和車體橫滾角度實時解算機器的實際位置，能夠有效應(yīng)對田間地面起伏不平的作業(yè)狀態(tài)；

3）通過實時記錄轉(zhuǎn)彎過程計算最小轉(zhuǎn)彎半徑，進行地頭轉(zhuǎn)彎過程中的直線路徑規(guī)劃，提高了地頭導(dǎo)航的準(zhǔn)確度，同時減小鄰接行的上線距離；

4）田間試驗表明，作業(yè)速度為3.6 km/h時，人工遙控和自動導(dǎo)航均能使機器沿作業(yè)路徑行駛；在有參考標(biāo)記的情況下，人工遙控和自動導(dǎo)航的最大橫向偏差為20.81和8.84 cm，平均值為0.90和3.16 cm，均方根誤差最大為7.47和4.66 cm，表明高地隙施藥機自動駕駛系統(tǒng)的轉(zhuǎn)向機構(gòu)具備較高的穩(wěn)定性和準(zhǔn)確度。