高地隙噴霧機(jī)自轉(zhuǎn)向電動(dòng)底盤控制系統(tǒng)設(shè)計(jì)與試驗(yàn)

沈 躍 何思偉 劉 慧 崔業(yè)民

(1.江蘇大學(xué)電氣信息工程學(xué)院， 鎮(zhèn)江 212013； 2.南通廣益機(jī)電有限責(zé)任公司， 南通 226631)

0 引言

目前，我國(guó)的植保機(jī)械仍以背負(fù)式手動(dòng)噴霧器和背負(fù)式機(jī)動(dòng)彌霧機(jī)為主[1-3]。與傳統(tǒng)人工施藥相比，高地隙噴霧機(jī)具有作業(yè)效率高、施藥均勻性好、對(duì)施藥人員健康危害小等優(yōu)點(diǎn)，已成為大田高稈類作物的重要施藥機(jī)械[4-9]，國(guó)內(nèi)外學(xué)者對(duì)此進(jìn)行了廣泛的研究。張京等[10]設(shè)計(jì)了一種農(nóng)用輪式機(jī)器人四輪獨(dú)立轉(zhuǎn)向驅(qū)動(dòng)控制系統(tǒng)，每個(gè)移動(dòng)輪采用2個(gè)電機(jī)完成行走與轉(zhuǎn)向功能，并基于低速阿克曼四輪轉(zhuǎn)向模型與 PID控制算法分析并驗(yàn)證了該四輪獨(dú)立轉(zhuǎn)向驅(qū)動(dòng)控制策略的有效性；范國(guó)強(qiáng)等[11]針對(duì)玉米和甘蔗等高稈作物生長(zhǎng)中后期田間管理缺乏有效作業(yè)機(jī)械的問題，設(shè)計(jì)了一種四輪菱形布置的農(nóng)用高地隙作業(yè)機(jī)，并進(jìn)行了試驗(yàn)，該機(jī)采用門架式結(jié)構(gòu)，具有離地間隙高、重心低、轉(zhuǎn)向半徑小和抗側(cè)翻能力強(qiáng)的優(yōu)點(diǎn)；YE等[12]開發(fā)了一種適用于果園的四輪獨(dú)立轉(zhuǎn)向系統(tǒng)，其轉(zhuǎn)向結(jié)構(gòu)與文獻(xiàn)[11]設(shè)計(jì)的高地隙作業(yè)機(jī)類似，只是其轉(zhuǎn)向與前進(jìn)的動(dòng)力來(lái)源于液壓系統(tǒng)，而非電機(jī)；許超等[13]設(shè)計(jì)了離地間隙2 m的自走式噴桿噴霧機(jī)，整機(jī)采用基于前輪輪距可調(diào)機(jī)構(gòu)的雙液壓缸轉(zhuǎn)向系統(tǒng)和后輪驅(qū)動(dòng)方式，為解決玉米等高稈作物生長(zhǎng)后期無(wú)法施藥的難題奠定了基礎(chǔ)；李偉等[14]為提高噴霧機(jī)的機(jī)動(dòng)性能和作業(yè)效率，設(shè)計(jì)了一套全液壓多輪轉(zhuǎn)向系統(tǒng)，并提出了基于 PID 控制方法的四輪轉(zhuǎn)向系統(tǒng)控制方法；劉志剛等[15]設(shè)計(jì)一種噴霧機(jī)底盤液壓傳動(dòng)系統(tǒng)，該系統(tǒng)具有高低速行駛、駐車制動(dòng)、防打滑等功能。上述結(jié)構(gòu)底盤轉(zhuǎn)向系統(tǒng)均是采用外部助力轉(zhuǎn)向，文獻(xiàn)[16-17]也采用了類似的設(shè)計(jì)。

對(duì)高地隙底盤結(jié)構(gòu)的研究已經(jīng)較為普遍，但高地隙底盤在復(fù)雜水田作業(yè)環(huán)境中存在轉(zhuǎn)向困難，仍容易陷入泥濘和深溝[18-19]，從而無(wú)法正常行駛。本文設(shè)計(jì)一種高地隙四輪獨(dú)立驅(qū)動(dòng)自轉(zhuǎn)向機(jī)構(gòu)電動(dòng)底盤，針對(duì)其結(jié)構(gòu)特點(diǎn)提出部分動(dòng)力學(xué)建模的方法，然后設(shè)計(jì)ESO，利用輸出進(jìn)行擾動(dòng)補(bǔ)償，對(duì)無(wú)擾動(dòng)的線性模型設(shè)計(jì)串級(jí)比例控制器，并通過試驗(yàn)驗(yàn)證本文方法的有效性。

1 數(shù)學(xué)建模

1.1 電動(dòng)底盤自轉(zhuǎn)向機(jī)構(gòu)設(shè)計(jì)

高地隙噴霧機(jī)自轉(zhuǎn)向電動(dòng)底盤實(shí)物圖如圖 1所示。蓄電池組由6組標(biāo)稱12 V鉛蓄電池組串連組成，主要承擔(dān)在發(fā)電機(jī)未工作時(shí)提供電能以及在發(fā)電機(jī)工作時(shí)儲(chǔ)存多余電能和穩(wěn)定發(fā)電機(jī)輸出電壓的作用；為了解決無(wú)刷直流電機(jī)直驅(qū)轉(zhuǎn)矩小的問題，設(shè)計(jì)了內(nèi)部有行星齒輪同軸變速的輪轂電機(jī)，4 kW無(wú)刷直流電機(jī)內(nèi)嵌在輪轂電機(jī)中，電機(jī)輸出的動(dòng)力經(jīng)過減速比為9的行星齒輪后放大輸出，車輪半徑為0.46 m；發(fā)電機(jī)功率28.5 kW，可以為噴霧機(jī)連續(xù)工作提供充足電能；車架長(zhǎng)2.8 m，寬1.4 m，工作設(shè)備皆安裝在車架上。

圖1 高地隙自轉(zhuǎn)向電動(dòng)底盤實(shí)物圖Fig.1 Picture of high clearance self-steering electric chassis1.蓄電池組 2.右后輪 3.右前輪 4.發(fā)電機(jī) 5.車架 6.左后輪 7.左前輪

底盤自轉(zhuǎn)向機(jī)構(gòu)由3部分組成：底盤車架(圖2)和前轉(zhuǎn)向橋和后轉(zhuǎn)向橋(圖3)，其中前后轉(zhuǎn)向橋機(jī)構(gòu)一致。前轉(zhuǎn)向橋通過平面軸承在前橋轉(zhuǎn)向中心點(diǎn)A與車架連接，后轉(zhuǎn)向橋與車架在后橋轉(zhuǎn)向中心點(diǎn)B連接。

圖2 底盤車架Fig.2 Chassis frame

圖3 前、后轉(zhuǎn)向橋Fig.3 Front/rear steering axle

高地隙噴霧機(jī)自轉(zhuǎn)向機(jī)構(gòu)采用4個(gè)輪轂電機(jī)驅(qū)動(dòng)，每個(gè)電機(jī)的轉(zhuǎn)矩均可獨(dú)立控制。4個(gè)電機(jī)分為前后2組，分別為左前、右前、左后和右后，左前電機(jī)和右前電機(jī)安裝在前轉(zhuǎn)向橋上，左后電機(jī)和右后電機(jī)安裝在后轉(zhuǎn)向橋上。前后轉(zhuǎn)向橋通過平面軸承與車架連接在一起，并且每個(gè)電機(jī)的轉(zhuǎn)矩均獨(dú)立可控，因此可以通過控制安裝于轉(zhuǎn)向橋兩側(cè)的輪轂電機(jī)的轉(zhuǎn)速來(lái)調(diào)節(jié)轉(zhuǎn)向橋與車架的夾角。通過控制轉(zhuǎn)向橋與車架夾角便可以達(dá)到控制噴霧機(jī)轉(zhuǎn)向的目的。轉(zhuǎn)向機(jī)構(gòu)由前后4個(gè)電驅(qū)動(dòng)輪兩兩安裝在前后轉(zhuǎn)向橋，并協(xié)同完成自轉(zhuǎn)向，沒有方向盤，無(wú)需額外轉(zhuǎn)向動(dòng)力。

高地隙噴霧機(jī)實(shí)物圖如圖4 所示，噴桿長(zhǎng)度11.2 m，噴幅12 m；藥箱容積500 L；高地隙噴霧機(jī)實(shí)物質(zhì)量1 380 kg，離地間隙1.1 m。

圖4 高地隙噴霧機(jī)實(shí)物圖Fig.4 Picture of high clearance sprayer1.噴桿 2.藥箱 3.發(fā)電機(jī)

自轉(zhuǎn)向機(jī)構(gòu)運(yùn)行時(shí)需要實(shí)時(shí)調(diào)節(jié)轉(zhuǎn)向橋兩側(cè)電機(jī)的輸出轉(zhuǎn)矩，設(shè)計(jì)控制系統(tǒng)之前需建立電機(jī)轉(zhuǎn)矩與轉(zhuǎn)向橋、車架之間夾角的動(dòng)力學(xué)模型。自轉(zhuǎn)向機(jī)構(gòu)由4個(gè)輪轂電機(jī)共同驅(qū)動(dòng)，前后轉(zhuǎn)向橋存在強(qiáng)耦合，同時(shí)前后轉(zhuǎn)向橋繞點(diǎn)A、B作旋轉(zhuǎn)運(yùn)動(dòng)，會(huì)引入含三角函數(shù)的坐標(biāo)變換，因此也存在著非線性特性。基于此，本文借助于擾動(dòng)觀測(cè)技術(shù)，建立部分動(dòng)力學(xué)模型，將未建模動(dòng)態(tài)包括耦合作為系統(tǒng)擾動(dòng)的一部分，和實(shí)時(shí)外部擾動(dòng)一并作為總擾動(dòng)來(lái)進(jìn)行觀測(cè)，再利用ESO具有估計(jì)不確定擾動(dòng)的能力估計(jì)總擾動(dòng)，并采用控制器予以補(bǔ)償[20]。

1.2 自轉(zhuǎn)向底盤運(yùn)動(dòng)學(xué)建模

圖5 自轉(zhuǎn)向底盤運(yùn)動(dòng)學(xué)模型簡(jiǎn)圖Fig.5 Kinematics model sketch of self-steering chassis

中間車架的長(zhǎng)度為L(zhǎng)(點(diǎn)A與點(diǎn)B之間的直線距離)，前后轉(zhuǎn)向橋的長(zhǎng)度為D(fl與fr或rl與rr的距離)。點(diǎn)A速度為vA，前轉(zhuǎn)向橋兩側(cè)的輪子fl、fr與地面的相對(duì)速度為vfl和vfr，根據(jù)速度之間關(guān)系可得

(1)

(2)

vfl=v′fl+vA

(3)

vfr=v′fr+vA

(4)

式中δ——轉(zhuǎn)換系數(shù)，取π/180

v′fl——左前輪由于前轉(zhuǎn)向橋定軸轉(zhuǎn)動(dòng)產(chǎn)生的速度

v′fr——右前輪由于前轉(zhuǎn)向橋定軸轉(zhuǎn)功產(chǎn)生的速度

假設(shè)車輪和地面不打滑，如圖6所示。

可得車輪角速度與速度關(guān)系為

(5)

式中ωi——角速度vi——車輪速度

dw——半徑

1.3 轉(zhuǎn)向橋動(dòng)力學(xué)建模

前后轉(zhuǎn)向橋受力分析類似，因此只進(jìn)行前轉(zhuǎn)向橋的受力分析。如圖7所示，前轉(zhuǎn)向橋總共受到5個(gè)力的作用，分別為由左、右2個(gè)電機(jī)輸出轉(zhuǎn)矩產(chǎn)生的主動(dòng)力Ffl、Ffr，地面摩擦力ffl、ffr以及車架對(duì)前轉(zhuǎn)向橋的作用力FA。主動(dòng)力Ffl與Ffr由電機(jī)產(chǎn)生，模取決于電機(jī)的輸入電壓與車輪轉(zhuǎn)速，方向則為車輪的縱向；地面摩擦力ffl、ffr和車架對(duì)前轉(zhuǎn)向橋作用力FA的模以及方向均取決于底盤的運(yùn)動(dòng)狀態(tài)，與車速、方向和路面情況等諸多因素相關(guān)，其模和方向均不固定。

圖7 前轉(zhuǎn)向橋動(dòng)力學(xué)模型Fig.7 Dynamic model of forward steering axle

在底盤轉(zhuǎn)向控制上需分析各力對(duì)點(diǎn)A的矩，即前轉(zhuǎn)向橋受到的主矩。力FA作用于點(diǎn)A，力臂為0，因此不產(chǎn)生轉(zhuǎn)矩；電機(jī)輸出的力Ffl、Ffr對(duì)轉(zhuǎn)角α的影響最大，依據(jù)本文的建模思想，首先建立部分動(dòng)力學(xué)模型，然后將未建模部分作為擾動(dòng)進(jìn)行實(shí)時(shí)估計(jì)。因此在建模時(shí)將模型簡(jiǎn)化為只存在力Ffl和Ffr，其他的力一律作為擾動(dòng)。

令Ffl=|Ffl|，F(xiàn)fr=|Ffr|，可得前轉(zhuǎn)向橋受到的主矩為

(6)

式中TF——前轉(zhuǎn)向橋受到的主矩

根據(jù)歐拉方程可得

(7)

(8)

式中JF——前轉(zhuǎn)向橋的轉(zhuǎn)動(dòng)慣量

利用直流電機(jī)的動(dòng)力學(xué)方程可得

(9)

式中Fi——車輪輸出的力

Jwi——車輪轉(zhuǎn)動(dòng)慣量

fwi——車輪軸摩擦因數(shù)

Ti——電機(jī)輸出轉(zhuǎn)矩

直流電機(jī)轉(zhuǎn)矩與輸入電壓的關(guān)系為

(10)

式中kI——電樞常數(shù)

U——直流電機(jī)輸入電壓

ke——反電勢(shì)常數(shù)

R——電機(jī)內(nèi)阻

將式(9)代入式(6)， 可得

(11)

轉(zhuǎn)向橋兩側(cè)電機(jī)以及車輪制作工藝相同，參數(shù)相近，因此模型中可認(rèn)為相等，即Jwfr=Jwfl=Jw，fwfr=fwfl=fw，并且將式(10)與式(7)代入式(11)可得

(12)

其中

將式(5)代入式(12)，可得

(13)

其中

又由式(1)～(4)可得

(14)

(15)

對(duì)式(13)～(15)進(jìn)一步整理可得

(16)

(17)

(18)

同理也可獲取后轉(zhuǎn)向橋的動(dòng)力學(xué)模型為

(19)

其中

UR=Urr-Url

前后轉(zhuǎn)向橋結(jié)構(gòu)一致，材料和制作工藝相同，故前后轉(zhuǎn)向橋的轉(zhuǎn)動(dòng)慣量近似相等，則可以認(rèn)為C3=C1，C4=C2。

2 控制系統(tǒng)設(shè)計(jì)

2.1 擴(kuò)張觀測(cè)器設(shè)計(jì)

ESO是一種特殊的狀態(tài)觀測(cè)器[21]，其基本原理是依據(jù)系統(tǒng)的微分方程，利用可測(cè)量輸出對(duì)系統(tǒng)中的不可測(cè)量狀態(tài)進(jìn)行重構(gòu)，其核心思想是將擾動(dòng)作為系統(tǒng)的擴(kuò)張狀態(tài)，再利用特殊反饋機(jī)制估計(jì)出系統(tǒng)的擴(kuò)張狀態(tài)[22-23]。由此可知，首先需要將本系統(tǒng)轉(zhuǎn)換為狀態(tài)空間描述形式，即

(20)

(21)

(22)

(23)

如式(23)所示，此時(shí)二階系統(tǒng)被擴(kuò)張為三階，設(shè)計(jì)三階ESO[25]估計(jì)系統(tǒng)狀態(tài)為

(24)

式中e——角度偏差

z1——轉(zhuǎn)角x1的估計(jì)量

z2——角速度x2的估計(jì)量

z3——總擾動(dòng)h的估計(jì)量

l1、l2、l3——誤差反饋系數(shù)

g(e)——非線性函數(shù)

為了盡可能減少參數(shù)個(gè)數(shù)并提高觀測(cè)器的估計(jì)效率，式(24)中對(duì)z1和z2的觀測(cè)采用了線性反饋，對(duì)z3的觀測(cè)采用了非線性函數(shù)g(e)構(gòu)造了非線性反饋，其中g(shù)(e)為fal(e,a,b)[22]，其中a和b為參數(shù)。fal函數(shù)定義為

(25)

2.2 控制器設(shè)計(jì)

在設(shè)計(jì)ESO時(shí)，將系統(tǒng)總擾動(dòng)h等效到系統(tǒng)輸入端。h的估計(jì)值z(mì)3與u單位相同，則將控制律取為

u=u0-z3

(26)

系統(tǒng)總擾動(dòng)在系統(tǒng)輸出時(shí)被補(bǔ)償。將式(26)代入式(22)可得

(27)

如式(27)所示，此時(shí)系統(tǒng)已為線性系統(tǒng)，并且系統(tǒng)中含有一個(gè)積分器，故無(wú)需設(shè)計(jì)積分控制器，于是針對(duì)這個(gè)系統(tǒng)設(shè)計(jì)了串級(jí)比例控制器。首先對(duì)角度誤差作第1級(jí)閉環(huán)，然后再將第1級(jí)閉環(huán)的結(jié)果作為第2級(jí)閉環(huán)的輸入，從而實(shí)現(xiàn)兩級(jí)閉環(huán)控制。控制器為

(28)

式中αd——期望轉(zhuǎn)角

k0——第1級(jí)閉環(huán)參數(shù)

k1——第2級(jí)閉環(huán)參數(shù)

根據(jù)式(12)、(21)、(23)可知控制系統(tǒng)輸出u=UF=Ufr-Ufl。本設(shè)計(jì)并未進(jìn)行速度控制，通過開環(huán)給定油門，令電壓油門信號(hào)m為

m=Ufr+Ufl

(29)

其中

(30)

(31)

圖8為前轉(zhuǎn)向橋控制系統(tǒng)結(jié)構(gòu)圖，后轉(zhuǎn)向橋控制系統(tǒng)結(jié)構(gòu)和前轉(zhuǎn)向橋相同，只是期望轉(zhuǎn)角的方向與前轉(zhuǎn)向橋相反。電壓油門信號(hào)m和期望轉(zhuǎn)角αd為系統(tǒng)參考輸入，試驗(yàn)時(shí)由遙控器給定。在控制系統(tǒng)中，油門信號(hào)是開環(huán)給定，因此油門也會(huì)耦合到轉(zhuǎn)向橋系統(tǒng)，但此耦合最終會(huì)被計(jì)入到總擾動(dòng)，依賴ESO和控制律予以補(bǔ)償。

圖8 前轉(zhuǎn)向橋控制系統(tǒng)結(jié)構(gòu)圖Fig.8 Front axle steering mechanism control system structure diagram

3 仿真與試驗(yàn)

3.1 電動(dòng)底盤參數(shù)辨識(shí)

為了驗(yàn)證本文設(shè)計(jì)控制算法的可行性，首先需辨識(shí)出模型參數(shù)。由式(16)可知，需要辨識(shí)的參數(shù)為C1和C2。電動(dòng)底盤前后轉(zhuǎn)向橋結(jié)構(gòu)一樣，理想情況下C1=C3，C2=C4，因此只需辨識(shí)前轉(zhuǎn)向橋參數(shù)即可。

將電動(dòng)底盤置于平坦路面，以盡量避免外部干擾影響辨識(shí)結(jié)果。使用Jlink-pro仿真器進(jìn)行數(shù)據(jù)采集，并通過J-Scope軟件顯示并保存采集的數(shù)據(jù)，如圖9所示，數(shù)據(jù)采樣率為500 Hz。

圖9 高地隙噴霧機(jī)試驗(yàn)系統(tǒng)Fig.9 High ground clearance sprayer test system1.J-Scope軟件 2.主控 3.Jlink-pro仿真器

參數(shù)辨識(shí)是利用系統(tǒng)的輸入輸出數(shù)據(jù)計(jì)算出模型參數(shù)的方法，因此只需要開環(huán)給定前轉(zhuǎn)向橋機(jī)構(gòu)輸入U(xiǎn)F，再采集輸出α，便可以辨識(shí)得出參數(shù)C1、C2。試驗(yàn)需采集2組數(shù)據(jù)，一組數(shù)據(jù)用于參數(shù)辨識(shí)，另一組數(shù)據(jù)用于模型驗(yàn)證。試驗(yàn)得到的2組數(shù)據(jù)如圖10所示。

圖10 輸入電壓與輸出轉(zhuǎn)角Fig.10 Input voltage and output angle data

模型參數(shù)辨識(shí)使用Matlab系統(tǒng)辨識(shí)工具箱，導(dǎo)入待辨識(shí)數(shù)據(jù)，可得辨識(shí)結(jié)果為：C1=0.592 06、C2=2.798 38。

圖11為模型驗(yàn)證結(jié)果?？梢钥闯瞿Ｐ洼敵雠c采集的轉(zhuǎn)角數(shù)據(jù)十分接近，其擬合度為90.1%，擬合結(jié)果較好。

圖11 模型驗(yàn)證結(jié)果Fig.11 Model validation

3.2 控制器仿真

根據(jù)辨識(shí)得到的參數(shù)，利用Matlab腳本構(gòu)建仿真程序。為盡量逼近真實(shí)情況，在采樣的轉(zhuǎn)角信號(hào)中加入標(biāo)準(zhǔn)差為0.1的高斯白噪聲。仿真參數(shù)如表1所示。

表1 仿真參數(shù)Tab.1 Simulation parameters

噴霧機(jī)在啟動(dòng)時(shí)轉(zhuǎn)向角很難保證為0°，為了更接近實(shí)際情況，在仿真時(shí)將模型狀態(tài)變量轉(zhuǎn)角x1初值設(shè)為10°，角速度x2初值設(shè)置為0(°)/s，ESO狀態(tài)變量z1、z2、z3初值均設(shè)置為0，期望轉(zhuǎn)角αd和擾動(dòng)h初值也設(shè)置為0，運(yùn)行至4 s時(shí)擾動(dòng)h由0突加至60 V(圖12c)，8 s時(shí)期望轉(zhuǎn)角αd由0°階躍至20°?？刂葡到y(tǒng)仿真結(jié)果如圖12所示。

圖12 控制系統(tǒng)仿真結(jié)果Fig.12 Simulation results of control system

在前4 s時(shí)間內(nèi)，外部擾動(dòng)為0，期望轉(zhuǎn)角為0°，系統(tǒng)實(shí)際轉(zhuǎn)角初值為10°，實(shí)際角速度初值為0(°)/s，圖12a、12b為ESO輸出的觀測(cè)轉(zhuǎn)角在0.3 s時(shí)收斂到實(shí)際轉(zhuǎn)角，觀測(cè)角速度在0.5 s時(shí)收斂到實(shí)際角速度。圖12c顯示擾動(dòng)觀測(cè)值在0.9 s時(shí)收斂到實(shí)際擾動(dòng)。圖12b、12c顯示在開始啟動(dòng)前0.9 s內(nèi)，觀測(cè)角速度和觀測(cè)擾動(dòng)都出現(xiàn)了嚴(yán)重偏離實(shí)際值的情況，這是由于ESO初始值偏離真實(shí)值導(dǎo)致，此時(shí)角速度和擾動(dòng)估計(jì)值誤差會(huì)導(dǎo)致控制器輸出異常，嚴(yán)重時(shí)會(huì)導(dǎo)致系統(tǒng)在啟動(dòng)時(shí)振蕩，因此啟動(dòng)時(shí)先等ESO收斂，然后再允許控制器輸出。

當(dāng)系統(tǒng)運(yùn)行至4 s時(shí)，外部擾動(dòng)由0突加至60 V，如圖12c所示，實(shí)際轉(zhuǎn)角受突變擾動(dòng)影響偏離期望轉(zhuǎn)角1.9°，在0.5 s后ESO擾動(dòng)觀測(cè)值即收斂到真實(shí)擾動(dòng)，實(shí)際轉(zhuǎn)角在控制器的作用下也隨之收斂到期望轉(zhuǎn)角0°，可知本控制系統(tǒng)可以消除未知擾動(dòng)影響。當(dāng)系統(tǒng)運(yùn)行至8 s時(shí)，期望轉(zhuǎn)角αd由0°階躍至20°，如圖12d所示，轉(zhuǎn)角跟蹤控制響應(yīng)曲線的上升時(shí)間為1.9 s，超調(diào)量2.3%。仿真結(jié)果證明了ESO的估計(jì)性能和控制器的有效性。

3.3 試驗(yàn)驗(yàn)證

為了驗(yàn)證控制器在噴霧機(jī)上的工作效果和在田間行走的通過性，分別進(jìn)行了平坦路面行走試驗(yàn)和在泥濘田間通過性試驗(yàn)。

平坦路面行走試驗(yàn)可以獲取控制器的響應(yīng)情況以測(cè)試控制器的性能。使用Jlink-pro仿真器采集數(shù)據(jù)并保存成文本文件，再利用Matlab繪圖分析；通過遙控器開環(huán)給定油門，緩加油門使其速度達(dá)到1 m/s，然后撥動(dòng)遙控器方向搖桿——給定期望轉(zhuǎn)角，執(zhí)行轉(zhuǎn)向動(dòng)作。試驗(yàn)結(jié)果如圖13所示，可知前轉(zhuǎn)向橋轉(zhuǎn)角上升時(shí)間為3.1 s，后轉(zhuǎn)向橋轉(zhuǎn)角上升時(shí)間為2.0 s；前轉(zhuǎn)向橋轉(zhuǎn)角上升時(shí)間大于后轉(zhuǎn)向橋，原因是在運(yùn)動(dòng)過程中前轉(zhuǎn)向橋所受到的擾動(dòng)大于后轉(zhuǎn)向橋。試驗(yàn)結(jié)果表明控制器滿足控制要求。

圖13 平坦路面行走試驗(yàn)結(jié)果Fig.13 Test results

田間通過性試驗(yàn)選擇場(chǎng)地為南通廣益機(jī)電有限責(zé)任公司內(nèi)部試驗(yàn)田，場(chǎng)地采用開溝機(jī)開出多條深40 cm、寬20 cm的溝，經(jīng)過灌水浸泡后場(chǎng)地較為泥濘。田間試驗(yàn)時(shí)噴霧機(jī)藥箱裝滿500 L水，為滿載狀態(tài)，同時(shí)發(fā)電機(jī)為開啟狀態(tài)以提供充足電能。駕駛噴霧機(jī)通過泥濘深溝障礙，試驗(yàn)情況如圖14所示。圖14a為噴霧機(jī)連續(xù)橫越深溝，在試驗(yàn)中，噴霧機(jī)可以輕松越過此類障礙；圖14b為噴霧機(jī)右側(cè)車輪陷入深溝，由于陷入深溝的輪子不斷打滑，造成了通過此類障礙時(shí)沒有橫越深溝時(shí)輕松，但也可通過。

圖14 泥濘田間通過性試驗(yàn)Fig.14 Mud field through test

4 結(jié)論

(1)針對(duì)現(xiàn)有高地隙噴霧機(jī)在復(fù)雜水田環(huán)境中行走，時(shí)常會(huì)陷在泥濘和深溝中，無(wú)法繼續(xù)工作的問題，設(shè)計(jì)了一種四輪獨(dú)立驅(qū)動(dòng)自轉(zhuǎn)向電動(dòng)底盤，根據(jù)底盤自轉(zhuǎn)向機(jī)構(gòu)特點(diǎn)，對(duì)轉(zhuǎn)向橋進(jìn)行建模，設(shè)計(jì)了ESO和控制器，并進(jìn)行了參數(shù)辨識(shí)試驗(yàn)，利用Matlab辨識(shí)了模型參數(shù)。

(2)通過仿真對(duì)ESO和控制器進(jìn)行了驗(yàn)證，使用階躍信號(hào)模擬擾動(dòng)，得到ESO的擾動(dòng)觀測(cè)值可在0.5 s內(nèi)收斂到實(shí)際擾動(dòng)；在擾動(dòng)觀測(cè)器收斂后，期望轉(zhuǎn)角階躍至20°，得到轉(zhuǎn)角響應(yīng)曲線的上升時(shí)間為1.9 s，超調(diào)量2.3%。說(shuō)明ESO和控制器可以完成控制任務(wù)。

(3)在平坦路面行走試驗(yàn)中，噴霧機(jī)速度緩加至1 m/s，給定期望轉(zhuǎn)角后可得前轉(zhuǎn)向橋轉(zhuǎn)角上升時(shí)間3.1 s，后轉(zhuǎn)向橋轉(zhuǎn)角上升時(shí)間為2.0 s，與仿真所得結(jié)果相近；在田間通過性試驗(yàn)中，噴霧機(jī)在滿載情況下仍可以越過寬20 cm、深40 cm的水溝，證實(shí)其在田間具有良好的通過性。