黃騰達(dá)，蔣蘋，胡文武，肖菲菲，吳帆，劉展名

（湖南農(nóng)業(yè)大學(xué)機(jī)電工程學(xué)院，長沙410128）

農(nóng)業(yè)機(jī)械導(dǎo)航技術(shù)有效地減輕了勞動(dòng)強(qiáng)度，提高了生產(chǎn)效率，是精準(zhǔn)農(nóng)業(yè)體系中的重要組成部分[1-3]。自動(dòng)轉(zhuǎn)向是實(shí)現(xiàn)農(nóng)機(jī)導(dǎo)航駕駛的關(guān)鍵技術(shù)。目前，農(nóng)業(yè)機(jī)械自動(dòng)轉(zhuǎn)向研究集中在機(jī)械轉(zhuǎn)向和全液壓轉(zhuǎn)向器自動(dòng)化技術(shù)改進(jìn)上，主要方法是在原有的轉(zhuǎn)向系統(tǒng)上加裝電機(jī)驅(qū)動(dòng)轉(zhuǎn)向或者并聯(lián)電控轉(zhuǎn)向液壓系統(tǒng)[4-5]?，F(xiàn)有的自動(dòng)轉(zhuǎn)向方案技術(shù)成本較高，自動(dòng)轉(zhuǎn)向系統(tǒng)和手動(dòng)轉(zhuǎn)向系統(tǒng)相互獨(dú)立。

路徑控制算法是農(nóng)機(jī)導(dǎo)航駕駛的核心。近年來，國內(nèi)外導(dǎo)航路徑跟蹤控制算法有比例-積分-微分（proportion-integration-differentiation, PID）控制[6]、純追蹤算法[7-12]、模糊控制[13-19]、神經(jīng)網(wǎng)絡(luò)[20-21]等。其中，純追蹤算法應(yīng)用最廣泛，并且，為了改善單獨(dú)的純追蹤算法路徑跟蹤上線效果不佳問題，研究者對(duì)該算法進(jìn)行了優(yōu)化改進(jìn)。如：張聞?dòng)畹萚22]建立雙切圓尋線模型，設(shè)置門限參數(shù)條件確保轉(zhuǎn)向相切上線，其中對(duì)有限的拖拉機(jī)門限參數(shù)進(jìn)行設(shè)置，使得控制方法適應(yīng)性有限；陳康等[23]使用兩步航向校正模型，在車體已經(jīng)偏向規(guī)劃路徑時(shí)減小期望轉(zhuǎn)向角，對(duì)車體航向角進(jìn)行校正，但試驗(yàn)平均誤差較大，銜接過渡不平滑；王輝等[24]以預(yù)瞄追蹤模型采用二元線性控制律和極點(diǎn)配置方法構(gòu)建線性最優(yōu)控制算法，該算法可在小角度線性近似條件下取得較好的效果，但大角度偏差僅考慮了單因素航向偏差不合理問題。上述路徑跟蹤控制算法通過建立數(shù)學(xué)分析模型，解決了模型中農(nóng)機(jī)在靠近規(guī)劃路徑時(shí)車輛航向與規(guī)劃路徑偏差較大的問題。為了更好地解決這一問題，本文提出了一種基于四輪轉(zhuǎn)向前視距離在線調(diào)整路徑跟蹤算法，該算法根據(jù)純追蹤算法決策期望轉(zhuǎn)向角，并以橫向偏差、航向偏差作為輸入，以前視距離系數(shù)為輸出的模糊控制在線修整前視距離參數(shù)，不僅實(shí)現(xiàn)了不同速度前視距離自適應(yīng)調(diào)整，而且解決了上線位置不佳的問題，為農(nóng)業(yè)機(jī)械自動(dòng)駕駛提供了一定的理論依據(jù)。

同時(shí)，本文設(shè)計(jì)了一種電控手柄液壓轉(zhuǎn)向方案：當(dāng)進(jìn)行手動(dòng)轉(zhuǎn)向操作時(shí)，控制器可根據(jù)手柄動(dòng)作行程進(jìn)行轉(zhuǎn)向角控制；當(dāng)進(jìn)行自動(dòng)轉(zhuǎn)向時(shí)，控制器可根據(jù)上位機(jī)期望轉(zhuǎn)向角完成自動(dòng)轉(zhuǎn)向。同現(xiàn)有的自動(dòng)轉(zhuǎn)向方案比較，該方案不需要安裝其他執(zhí)行元件，電控手柄操作靈活，轉(zhuǎn)向精度能滿足農(nóng)機(jī)轉(zhuǎn)向控制要求。

1 轉(zhuǎn)向結(jié)構(gòu)設(shè)計(jì)及線控轉(zhuǎn)向原理

1.1 轉(zhuǎn)向結(jié)構(gòu)設(shè)計(jì)

3WPZ-750田間管理機(jī)采用高地隙通用作業(yè)底盤設(shè)計(jì)[25]，結(jié)構(gòu)如圖1所示。其轉(zhuǎn)向系統(tǒng)主要由4個(gè)獨(dú)立轉(zhuǎn)向支腿組成，其中轉(zhuǎn)向支腿、轉(zhuǎn)向軸安裝固定在支腿套管中，由轉(zhuǎn)向馬達(dá)提供轉(zhuǎn)向動(dòng)力。支腿套管上的垂直立板鉸接平行四邊形結(jié)構(gòu)一端，另一端立板焊接固定在作業(yè)底盤上。車輪轉(zhuǎn)向角度傳感器旋轉(zhuǎn)軸與轉(zhuǎn)向軸平行布置，安裝固定在支腿垂直立板上，通過柔性齒輪與轉(zhuǎn)向軸上的齒輪嚙合，實(shí)時(shí)監(jiān)測(cè)車輪轉(zhuǎn)向角度。車輪轉(zhuǎn)向力矩通過支腿直角支撐架傳遞至車輪。支腿直角支撐架上部安裝行走馬達(dá)，通過行走鏈輪箱向車輪傳遞行走動(dòng)力。

1.2 自動(dòng)轉(zhuǎn)向

田間管理機(jī)液壓轉(zhuǎn)向系統(tǒng)如圖2所示。田間管理機(jī)液壓轉(zhuǎn)向系統(tǒng)由前后輪轉(zhuǎn)向電磁閥串聯(lián)相應(yīng)轉(zhuǎn)向馬達(dá)，每個(gè)液壓馬達(dá)并聯(lián)轉(zhuǎn)向旁通閥，當(dāng)在兩側(cè)車輪出現(xiàn)因負(fù)載不同導(dǎo)致轉(zhuǎn)向不同步情況時(shí)，控制器控制轉(zhuǎn)向旁通閥進(jìn)行轉(zhuǎn)向同步性調(diào)整?？刂破鞑捎镁€控技術(shù)實(shí)時(shí)監(jiān)測(cè)轉(zhuǎn)向電控手柄目標(biāo)轉(zhuǎn)向角、轉(zhuǎn)向角度傳感器實(shí)際轉(zhuǎn)向角，構(gòu)成轉(zhuǎn)向閉環(huán)控制。在轉(zhuǎn)向過程中，控制器控制轉(zhuǎn)向電磁閥上的轉(zhuǎn)向電磁閥動(dòng)作，當(dāng)一側(cè)車輪轉(zhuǎn)向至目標(biāo)角度時(shí)，對(duì)應(yīng)的兩位三通旁通閥導(dǎo)通該側(cè)車輪，直至兩側(cè)車輪轉(zhuǎn)向同步。

圖1 田間管理機(jī)機(jī)械結(jié)構(gòu)Fig.1 Mechanical structure of field management machine

圖2 液壓轉(zhuǎn)向系統(tǒng)示意圖Fig.2 Schematic diagram of hydraulic steering system

為了提高自動(dòng)液壓轉(zhuǎn)向精度，采用卡爾曼濾波方法，減小工作過程中噪聲等干擾對(duì)角度傳感器的影響，試驗(yàn)結(jié)果如圖3所示。其中，靜態(tài)無濾波角度傳感器電壓值標(biāo)準(zhǔn)差為0.03 V，啟動(dòng)后振動(dòng)噪聲干擾角度傳感器電壓值標(biāo)準(zhǔn)差為0.028 V，啟動(dòng)后卡爾曼濾波角度傳感器電壓值標(biāo)準(zhǔn)差為0.02 V。表明該方法有效地抑制了工作噪聲干擾，角度傳感器采樣電壓值標(biāo)準(zhǔn)差降低了33%左右，提高了自動(dòng)轉(zhuǎn)向精度。

另外，使用電腦向控制器發(fā)送單個(gè)車輪轉(zhuǎn)向命令后，記錄目標(biāo)轉(zhuǎn)向角和實(shí)際車輪轉(zhuǎn)向角，供轉(zhuǎn)向分析。將目標(biāo)轉(zhuǎn)向角和實(shí)際車輪轉(zhuǎn)向角進(jìn)行線性擬合，得出的左前、右前、左后、右后轉(zhuǎn)向輪線性擬合關(guān)系式如下。

圖3 角度傳感器去噪效果Fig.3 Denoising effect of angle sensor

轉(zhuǎn)向角誤差如圖4 所示：角度傳感器實(shí)際轉(zhuǎn)向角與目標(biāo)轉(zhuǎn)向角構(gòu)成的轉(zhuǎn)向閉環(huán)控制誤差范圍為－0.5°～0.5°，滿足農(nóng)業(yè)機(jī)械自動(dòng)轉(zhuǎn)向要求。

圖4 目標(biāo)轉(zhuǎn)向角與實(shí)際轉(zhuǎn)向角誤差Fig.4 Error between target steering angle and actual steeringangle

另外，為了評(píng)價(jià)該自動(dòng)液壓轉(zhuǎn)向系統(tǒng)的響應(yīng)性，對(duì)該液壓系統(tǒng)響應(yīng)時(shí)間進(jìn)行試驗(yàn)。具體試驗(yàn)操作步驟：1）啟動(dòng)田間管理機(jī)；2）通過上位機(jī)發(fā)送“車輪轉(zhuǎn)向30°”的命令；3）使用雷諾液壓測(cè)試儀實(shí)時(shí)監(jiān)測(cè)轉(zhuǎn)向馬達(dá)流量大小；4）從使用的雷諾液壓測(cè)試儀中導(dǎo)出轉(zhuǎn)向馬達(dá)運(yùn)行時(shí)間和流量，為自動(dòng)轉(zhuǎn)向試驗(yàn)結(jié)果分析提供參考。測(cè)得土槽中土壤濕度為72%時(shí)，車輪轉(zhuǎn)向至最大轉(zhuǎn)向角的時(shí)間為3.8 s；在水泥路面所需時(shí)間為1.9 s。根據(jù)轉(zhuǎn)向馬達(dá)流量、壓力數(shù)據(jù)計(jì)算分析，土槽中轉(zhuǎn)向馬達(dá)進(jìn)出口壓差達(dá)8.111 MPa，轉(zhuǎn)向扭矩為145.3 N·m；水泥地面上轉(zhuǎn)向馬達(dá)進(jìn)出口壓差達(dá)1.224 MPa，轉(zhuǎn)向扭矩為21.927 N·m?？傮w來看，復(fù)雜土壤地況所需轉(zhuǎn)向扭矩比水泥平坦地面大，轉(zhuǎn)向響應(yīng)時(shí)間更長，說明自動(dòng)轉(zhuǎn)向液壓系統(tǒng)轉(zhuǎn)向響應(yīng)和穩(wěn)定性有效。

2 模型與分析

2.1 路徑跟蹤技術(shù)路線

為了實(shí)現(xiàn)路徑跟蹤功能，本研究在原有車載電子控制單元（electronic control unit, ECU）上設(shè)計(jì)了一套基于微軟集成開發(fā)環(huán)境（visual studio）的上位機(jī)路徑跟蹤控制界面。上位機(jī)接收來自北斗定位系統(tǒng)的車體位姿、速度信息后，通過純追蹤算法搜索規(guī)定路徑上的預(yù)瞄點(diǎn)，經(jīng)算法處理獲得期望的車輪轉(zhuǎn)向角、車速信號(hào)，通過串口通信傳遞到車載控制器，從而控制執(zhí)行相應(yīng)轉(zhuǎn)向和行走動(dòng)作，其技術(shù)路線如圖5所示。

圖5 路徑跟蹤技術(shù)路線Fig.5 Technical route of path tracking

2.2 四輪轉(zhuǎn)向模型分析

2.3 純追蹤算法改進(jìn)

純追蹤模型被廣泛應(yīng)用在車輛和機(jī)器人的路徑跟蹤研究上[26-28]。如圖7所示：車體轉(zhuǎn)向中心N（x，y）在規(guī)劃路徑T 上的目標(biāo)點(diǎn)為M（gx，gy）；O 為轉(zhuǎn)向圓心；弧NM 半徑為R；L0為橫向偏差；θ 為航向偏差；2θ為沿弧NM到目標(biāo)點(diǎn)M的圓心角；L為車身軸距；E為前視距離。

根據(jù)圖7，由三角形MNO正弦定理可得：

由四輪轉(zhuǎn)向模型分析已知轉(zhuǎn)向角與轉(zhuǎn)向半徑的關(guān)系如下：

圖6 四輪轉(zhuǎn)向模型Fig.6 Model of four-wheel steering

圖7 純追蹤模型Fig.7 Pure tracking model

由式（5）～（7）可得車輪轉(zhuǎn)向角與橫向偏差、前視距離的關(guān)系式：

式（8）闡明了期望車輪轉(zhuǎn)向角與前視距離參數(shù)取值問題。固定前視距離不能滿足快速上線要求，實(shí)時(shí)動(dòng)態(tài)最優(yōu)前視距離參數(shù)難以確定。因此，純追蹤模型前視距離應(yīng)根據(jù)橫向偏差、航向偏差和車速合理地進(jìn)行在線動(dòng)態(tài)調(diào)整。

前視距離的取值與當(dāng)前位置橫向偏差、航向偏差和車速有直接關(guān)系。參考車速與前視距離研究文獻(xiàn)[29]，車速（v）和前視距離（E）的關(guān)系可以表示為：

{2≤E ＜4 m，0＜v ＜10 km/h；4≤E ＜5m，10≤v ＜20 km/h；5≤E ＜6 m，20≤v ＜30 km/h.

田間管理機(jī)在作業(yè)過程中車速較低且變化不大，通常認(rèn)為是勻速作業(yè)，車速為前視距離取值提供了參考區(qū)間。所以，前視距離在線動(dòng)態(tài)調(diào)整時(shí)應(yīng)以橫向偏差、航向偏差作為模糊控制輸入，獲取該車速區(qū)間內(nèi)前視距離值。

根據(jù)實(shí)際駕駛操作，前視距離在線調(diào)整模糊控制器的規(guī)則是：當(dāng)航向偏差和橫向偏差較大時(shí)，減小前視距離來消除偏差，使農(nóng)機(jī)航向偏差和橫向偏差迅速得到糾正；當(dāng)航向偏差和橫向偏差較小時(shí)，以增大前視距離來使農(nóng)機(jī)穩(wěn)定地沿規(guī)劃路徑行駛[30-32]。前視距離在線調(diào)整主要是指在某一車速區(qū)間內(nèi)調(diào)整橫向偏差和航向偏差的權(quán)重，以得到較好的在線前視距離[33]，前視距離在線調(diào)整模糊控制規(guī)則如表1 所示。通過田間管理機(jī)實(shí)際操作，定義車體橫向偏差、航向偏差相對(duì)規(guī)劃路徑左偏差為負(fù)值，右偏差為正值；車輪轉(zhuǎn)向角相對(duì)車輪零度角左偏差為正值，右偏差為負(fù)值，最大轉(zhuǎn)向角為30°。

表1 模糊控制規(guī)則表Table 1 Regulation table of fuzzy control

橫向偏差L0基本論域?yàn)椋郏?.6 m，0.6 m］，量化等級(jí)為{－6，－5，－4，－3，－2，－1，0，1，2，3，4，5，6}，量化因子KL0為0.1。航向偏差θ 基本論域［－90°，90°］，量化等級(jí)為{－6，－5，－4，－3，－2，－1，0，1，2，3，4，5，6}，量化因子Kθ為1/15。前視距離控值系數(shù)k 基本論域?yàn)椋?，1 m］，量化等級(jí)為{－6，－5，－4，－3，－2，－1，0，1，2，3，4，5，6}，量化因子Kk為6。

由前視距離模糊控制系數(shù)與實(shí)時(shí)車速前視距離區(qū)間得到的前視距離表達(dá)式為：

式中：k為前視距離模糊控制系數(shù)；SE為實(shí)時(shí)車速前視距離區(qū)間長度值；E0為實(shí)時(shí)車速前視距離基值。

使用MATLAB軟件對(duì)該算法模型進(jìn)行仿真，設(shè)定相關(guān)初始條件：橫向偏差為2 m，航向偏差為53°，初始車輪轉(zhuǎn)向角度為0，仿真車速為2 m/s，k取值為1，SE為1 m，E0為2 m。仿真結(jié)果如圖8所示。從中可知，在橫向偏差2 m 的條件下，車體橫向偏差在2 s 靠近規(guī)劃路徑，其中航向偏差、轉(zhuǎn)向角度突然變化是根據(jù)模糊控制規(guī)則為了穩(wěn)定完成上線操作對(duì)前視距離動(dòng)態(tài)調(diào)整引起的，4 s 后車體橫向偏差、航向偏差滿足田間管理機(jī)上線穩(wěn)定要求。從整體上看，該路徑跟蹤方法能迅速消除橫向偏差，振蕩較小，上線曲線平滑，具有較好的動(dòng)態(tài)特性。表明該前視距離在線調(diào)整路徑跟蹤算法對(duì)提高田間管理機(jī)上線響應(yīng)性和穩(wěn)定性是可行的。

3 驗(yàn)證與討論

3.1 試驗(yàn)平臺(tái)信息

圖8 仿真效果Fig.8 Simulation effect

田間管理機(jī)試驗(yàn)平臺(tái)如圖9 所示，其搭載了北斗定位系統(tǒng)、上位機(jī)、控制器、液壓執(zhí)行元件等。北斗定位系統(tǒng)采用“合眾思?jí)驯诨ⅰ北倍犯呔热驅(qū)Ш叫l(wèi)星系統(tǒng)差分接收機(jī)，差分定位精度為2 cm；采用Robobrain公司的霍爾型角度傳感器，基本參數(shù)為工作電壓DC-24 V，輸出0～5 V 模擬量信號(hào)，精度為0.5%FS。試驗(yàn)平臺(tái)上位機(jī)技術(shù)路線設(shè)計(jì)思路：上位機(jī)先將北斗定位的經(jīng)緯度投影轉(zhuǎn)換至平面坐標(biāo)，其中高斯投影采用我國2000 國家大地坐標(biāo)系橢球參數(shù)；然后利用純追蹤算法模型搜索規(guī)劃路徑上的預(yù)瞄點(diǎn)，以獲取當(dāng)前位置下的橫向偏差、航向偏差和車速，經(jīng)前視距離在線調(diào)整后得出期望四輪轉(zhuǎn)向角。

圖9 試驗(yàn)平臺(tái)Fig.9 Experimental platform

3.2 直線路徑跟蹤試驗(yàn)

為驗(yàn)證路徑跟蹤效果，分別在水泥路面和田間不同作業(yè)環(huán)境下進(jìn)行直線跟蹤試驗(yàn)。具體試驗(yàn)過程如下：1）在試驗(yàn)場(chǎng)地預(yù)先使用北斗定位系統(tǒng)規(guī)劃好跟蹤路徑；2）將田間管理機(jī)放置在規(guī)劃路徑起點(diǎn)；3）啟動(dòng)田間管理機(jī)，置油門開度于1/2 處；4）田間管理機(jī)從規(guī)劃路徑起點(diǎn)處開始行走，上位機(jī)導(dǎo)航控制界面通過實(shí)時(shí)監(jiān)控四輪轉(zhuǎn)向角實(shí)現(xiàn)田間管理機(jī)沿規(guī)劃路徑直線跟蹤，至規(guī)劃路徑終點(diǎn)；5）從上位機(jī)導(dǎo)航控制界面導(dǎo)出路徑跟蹤過程參數(shù)，為后續(xù)試驗(yàn)結(jié)果分析提供參考依據(jù)。路徑跟蹤過程參數(shù)主要有實(shí)時(shí)行駛軌跡定位坐標(biāo)、橫向偏差、航向偏差等，實(shí)驗(yàn)數(shù)據(jù)處理結(jié)果均以一次路徑跟蹤所得。水泥路面場(chǎng)地為湖南農(nóng)業(yè)大學(xué)西籃球場(chǎng)，水田試驗(yàn)場(chǎng)地為湖南農(nóng)業(yè)大學(xué)耘園水稻試驗(yàn)田，水稻生長處于灌漿結(jié)實(shí)期，土質(zhì)較黏。

田間管理機(jī)在水泥路面直線路徑跟蹤時(shí)車輛擺放初始橫向偏差、航向偏差較大，橫向偏差實(shí)際測(cè)量值為0.1 m，但上線后行駛軌跡與規(guī)劃路徑基本一致，水泥路面試驗(yàn)中行駛軌跡如圖10所示。在水田直線路徑跟蹤時(shí)，由于場(chǎng)地條件有限，車輛擺放初始橫向偏差、航向偏差較小，橫向偏差實(shí)際測(cè)量值為0.05 m，且車輪下陷量較大，實(shí)際測(cè)量值為25 cm，晃動(dòng)較小，水田試驗(yàn)中行駛軌跡如11 圖所示。試驗(yàn)結(jié)果表明：在上線過程中水泥路面路徑跟蹤誤差均值為6.92 cm，標(biāo)準(zhǔn)差為4.84 cm；水田路徑跟蹤誤差均值為2.25 cm，標(biāo)準(zhǔn)差為1.35 cm。在不同環(huán)境下，路徑跟蹤控制偏差基本符合設(shè)計(jì)要求，但在水泥路面試驗(yàn)效果較水田試驗(yàn)效果差。分析原因可知：田間管理機(jī)在水泥路面和水田中的車輪附著力不相同，水田環(huán)境下因土壤較黏，車輪下陷，車輪附著力大于水泥路面。且當(dāng)在水泥路面行走時(shí)液壓系統(tǒng)中分流集流閥未達(dá)到最佳分流狀態(tài)，4個(gè)車輪轉(zhuǎn)速不一致，致使田間管理機(jī)不停地進(jìn)行轉(zhuǎn)向上線調(diào)整，跟蹤誤差較大；而在水田環(huán)境下田間管理機(jī)車輪同步誤差較小，雖然在開始進(jìn)行跟蹤時(shí)位置誤差較大，但靠近規(guī)劃路徑后，車體會(huì)沿著以前的車轍繼續(xù)行駛，跟蹤誤差明顯減小。

3.3 曲線路徑跟蹤試驗(yàn)

參考農(nóng)藝農(nóng)機(jī)作業(yè)規(guī)范要求和路徑規(guī)劃轉(zhuǎn)向方式，田間管理機(jī)在大田進(jìn)行植保作業(yè)時(shí)完成一行后需轉(zhuǎn)向180°才能進(jìn)入另一行繼續(xù)作業(yè)。因作業(yè)寬幅為12 m，故采用牛耕法弓形轉(zhuǎn)向換行作業(yè)操作。所以，田間管理機(jī)曲線路徑跟蹤試驗(yàn)采用最小轉(zhuǎn)彎半徑定曲率曲線機(jī)進(jìn)行跟蹤試驗(yàn)，跟蹤車速設(shè)置為0.2 m/s，具體試驗(yàn)步驟參考直線路徑跟蹤試驗(yàn)。如圖12～13所示：在水泥路面定曲率曲線路徑跟蹤誤差均值為12.49 cm，標(biāo)準(zhǔn)差為9.16 cm；在水田路徑跟蹤誤差均值為8.72 cm，標(biāo)準(zhǔn)差為5.59 cm。對(duì)水泥路面和水田曲線路徑跟蹤試驗(yàn)結(jié)果進(jìn)行分析，水田曲線跟蹤試驗(yàn)車輪在泥土中有25 cm 左右沉陷，前后車輪轉(zhuǎn)向附著力比水泥路面大，因此在進(jìn)行轉(zhuǎn)向時(shí)，行走液壓系統(tǒng)中分流集流閥達(dá)到最佳分流狀態(tài)，車輪速度同步誤差小，致使水田曲線跟蹤效果優(yōu)于水泥路面曲線跟蹤效果。

4 結(jié)論

目前，我國農(nóng)業(yè)機(jī)械自動(dòng)導(dǎo)航技術(shù)多在原來的全液壓或機(jī)械轉(zhuǎn)向上進(jìn)行自動(dòng)轉(zhuǎn)向改裝，采用純追蹤算法作路徑跟蹤；其純追蹤算法多以兩因素進(jìn)行分析。這種方法雖然能達(dá)到自動(dòng)駕駛目的，但人工駕駛、自動(dòng)駕駛轉(zhuǎn)向系統(tǒng)不能共用一種設(shè)計(jì)方案，成本較高，不利于廣泛應(yīng)用。

圖10 水泥路面試驗(yàn)效果Fig.10 Experimental effect on cement pavement

本研究采用四輪獨(dú)立液壓轉(zhuǎn)向設(shè)計(jì)方案，不同于前輪轉(zhuǎn)向模型路徑跟蹤，并以車載控制器作為中控單元來有效地將人工駕駛、自動(dòng)駕駛轉(zhuǎn)向系統(tǒng)結(jié)合，并以速度、橫向偏差、航向偏差三因素優(yōu)化純追蹤算法前視距離參數(shù)，解決了四輪獨(dú)立自動(dòng)轉(zhuǎn)向設(shè)計(jì)方案和純追蹤算法多因素影響問題，減少了相應(yīng)成本。并通過微軟集成開發(fā)環(huán)境（visual studio）建立了上位機(jī)軟件控制系統(tǒng)，以及通過MATLAB軟件進(jìn)行上線仿真，得到4 s穩(wěn)定上線結(jié)果，能夠滿足田間管理機(jī)自動(dòng)導(dǎo)航的功能，為實(shí)際應(yīng)用提供了一定的依據(jù)。

圖11 水田試驗(yàn)效果Fig.11 Experimental effect of paddy field

圖12 水泥路面曲線跟蹤Fig.12 Curve tracking on cement pavement

圖13 水田曲線跟蹤Fig.13 Curve tracking in paddy field

試驗(yàn)結(jié)果表明：在0.5 m/s的車速下，田間管理機(jī)在水泥路面環(huán)境下，路徑跟蹤誤差均值為6.92 cm，其標(biāo)準(zhǔn)差為4.84 cm，定曲率曲線路徑跟蹤誤差均值為12.49 cm，其標(biāo)準(zhǔn)差為9.16 cm；在0.2 m/s 的車速下，田間管理機(jī)在南方水田環(huán)境下，路徑跟蹤誤差均值為2.25 cm，其標(biāo)準(zhǔn)差為1.35 cm，定曲率曲線路徑跟蹤誤差均值為8.72 cm，其標(biāo)準(zhǔn)差為5.59 cm。通過MATLAB 軟件仿真、路面與田間試驗(yàn)驗(yàn)證，其自動(dòng)導(dǎo)航效果能夠滿足田間管理機(jī)行駛和田間作業(yè)需要。所以，本研究的路徑跟蹤系統(tǒng)符合農(nóng)業(yè)機(jī)械自動(dòng)導(dǎo)航的設(shè)計(jì)要求。

在試驗(yàn)過程中，發(fā)現(xiàn)影響田間作業(yè)環(huán)境的因素較多，其中，水田土壤堅(jiān)實(shí)度不同對(duì)田間管理機(jī)四輪自動(dòng)轉(zhuǎn)向的同步性也不同，后續(xù)有待進(jìn)一步研究水田不同土壤堅(jiān)實(shí)度對(duì)四輪轉(zhuǎn)向同步性的影響，以調(diào)整相應(yīng)轉(zhuǎn)向液壓設(shè)計(jì)參數(shù)，保證水田四輪轉(zhuǎn)向同步性和響應(yīng)時(shí)間。此外，還需進(jìn)一步研究該路徑跟蹤算法響應(yīng)時(shí)間、誤差精度以及轉(zhuǎn)向支腿結(jié)構(gòu)的設(shè)計(jì)。