有機蔬菜大棚除草機器人磁導(dǎo)航模糊控制系統(tǒng)研制

楊 婕，楊超淞，洪曉瑋，陳 勇*，周衛(wèi)鵬

（1.南京林業(yè)大學(xué) 機械電子工程學(xué)院，南京 210037;2.鎮(zhèn)江臨泰農(nóng)業(yè)科技有限公司，鎮(zhèn)江 212000）

0 引言

目前有機蔬菜生產(chǎn)中不能使用除草劑，一般采用人工除草[1]，但人工除草耗時長，效率低。機械除草作為一種綠色無公害除草方式在現(xiàn)代有機蔬菜行業(yè)中已得到廣泛重視[2,3]，具有非常樂觀的前景。

LiangYunlin等[4]研制了具有機器視覺和框架式激光指示器的除草機器人，提出了靜態(tài)除草路徑規(guī)劃算法。Zhang Q等[5]提出了動態(tài)路徑跟蹤算法，用于農(nóng)業(yè)拖拉機跟蹤目標(biāo)路徑。李會賓等[6]采用拓展卡爾曼濾波算法對用三維激光雷達結(jié)合RANSAC算法獲取果園地圖的行直線信息優(yōu)化，設(shè)計了純跟蹤式的自主行間導(dǎo)航算法。金小俊等[7]開發(fā)了基于機器視覺導(dǎo)航的除草機器人，提出一種圖像分割算法。王鵬等[8]針對溫室大棚內(nèi)噴霧機器人提出了一種導(dǎo)航線和QR碼組合的視覺導(dǎo)航算法，實現(xiàn)精準(zhǔn)導(dǎo)航。目前，農(nóng)業(yè)上多采用視覺導(dǎo)航，但是有很多不確定性且對于有機蔬菜大棚內(nèi)除草機器人導(dǎo)航的研究較少。針對上述問題，因磁導(dǎo)航在工業(yè)上應(yīng)用廣泛，成熟可靠，本文研發(fā)了一種有機蔬菜大棚內(nèi)除草機器人的磁導(dǎo)航模糊控制系統(tǒng)。工業(yè)上磁條多在地面上或瓷磚下，本文提出將磁條鋪設(shè)在大棚鋼架上，機器人沿著磁條行駛，設(shè)計模糊控制器實現(xiàn)對機器人處于各種偏差現(xiàn)象的調(diào)整，從而進行自主導(dǎo)航。

1 除草機器人總體結(jié)構(gòu)

如圖1所示，大棚中的田地分成塊狀區(qū)域來種植不同種類的蔬菜。因此本文中機器人的工作路線如圖2所示，機器人從區(qū)域1的底端出發(fā)，到達頂端后，控制原地轉(zhuǎn)向機構(gòu)，移動到區(qū)域2的頂端，實現(xiàn)壟與壟的橫向行駛。依次運動，在到達區(qū)域4的底端后，按照原路線返回到起點，如此往復(fù)行駛。

圖1 蔬菜大棚示意圖

圖2 自動行駛路線

機器人的整體結(jié)構(gòu)如圖3所示，主要由輪式移動平臺、線性模組、末端執(zhí)行裝置以及雜草識別裝置四個部分組成，其中移動平臺包括四個行駛輪胎、四輪轉(zhuǎn)向機構(gòu)、移動平臺框架以及磁傳感器等；雜草識別裝置由FPGA開發(fā)板等構(gòu)成；供電電池固定在移動平臺框架的四個頂點處；磁傳感器通過支架板安裝在機器人兩側(cè)的幾何中心點；末端執(zhí)行器固裝在Z軸下方且可調(diào)節(jié)其縱向位置以適應(yīng)不同高度工作。樣機實物如圖4所示。

圖3 除草機器人結(jié)構(gòu)圖

圖4 樣機實物圖

2 基于模糊控制器的磁導(dǎo)航路徑跟蹤研究

2.1 方案介紹

有機蔬菜大棚除草機器人的控制系統(tǒng)是一個復(fù)雜的非線性系統(tǒng)，經(jīng)典控制理論方法只適用于線性系統(tǒng)。模糊控制器作為一種較為容易理解的非線性控制器[9]，具有良好的實時性、魯棒性以及容錯性，其最大特點是不依賴于被控對象的精確數(shù)學(xué)模型，適用于各種非線性系統(tǒng)的控制。因此本文基于磁傳感器，采用模糊控制理論的方法研究大棚內(nèi)除草機器人的導(dǎo)航路徑跟蹤，此導(dǎo)航方式定位精確，路徑鋪設(shè)、變更相對簡單，成本較低，可根據(jù)大棚自身的鋼結(jié)構(gòu)進行鋪設(shè)。

2.2 磁導(dǎo)航模糊控制器的設(shè)計

機器人行駛時出現(xiàn)位置偏差是由其兩側(cè)輪轂電機之間的差速運動產(chǎn)生，控制相關(guān)電機轉(zhuǎn)速就能直接控制機器人的位姿狀態(tài)。因此，本文以磁傳感器相對于磁條正中位置的偏差以及偏差的變化率作為模糊控制器的輸入以控制電機轉(zhuǎn)速，被控電機的PWM占空比值作為輸出設(shè)計了一種二維雙輸入單輸出的磁導(dǎo)航模糊控制器[10]，如圖5所示。

圖5 磁導(dǎo)航模糊控制器

2.2.1 輸入和輸出變量的模糊化

磁導(dǎo)航傳感器必須與對應(yīng)極性的磁條配套使用，與磁條的有效感應(yīng)距離多為10mm～65mm。本文選用具有8路開關(guān)量信號輸出的CNS-MGS-08磁傳感器。將磁傳感器垂直安裝在移動平臺的前方和側(cè)方，距離磁條表面40mm左右，磁條寬度為30mm，利用傳感器內(nèi)部間隔的8個采樣點檢測出磁條周圍的磁場，每個采樣點都有一路對應(yīng)輸出信號，當(dāng)采樣點采集到磁信號時，就會輸出低電平，而沒有采集到磁信號的通道會被置于高阻狀態(tài)，磁傳感器輸出的信號經(jīng)過光電 合器處理后能直接與DSP芯片的I/O后連接。

本文將磁傳感器的8路磁信號通道依次從左往右編號，然后將傳感器以偏差量為一厘米分別做左偏和右偏測試，直到完全偏出磁條，左偏、右偏測得的實際輸出信號分別如圖6(a)、圖6(b)所示，紅圈代表有信號輸出，白圈代表無信號輸出，其行駛時的左右偏離狀況分別有6種磁信號輸出組合狀態(tài)。

圖6 輸出信號

若中間有四路信號為紅色，則表示機器人正處于磁條中間位置。根據(jù)檢測到的信號狀況把偏差的實際范圍定為[-4cm，4cm]，偏差量的單位為1cm，設(shè)置偏差E的論域為{-3，-2，-1，0，1，2，3}，將偏差E的模糊子集定為7檔。模糊控制器的第二輸入偏差變化率EC是當(dāng)前誤差與上次誤差的比較，即EC=E(K)-E(K-1)，設(shè)定EC的實際范圍為[-3，3]，其論域定為{-3，-2，-1，0，1，2，3}。

模糊控制器的輸出是機器人移動平臺兩側(cè)輪轂電機的PWM波占空比的差值U=右側(cè)電機占空比—左側(cè)電機占空比。根據(jù)電機調(diào)速試驗知輸出U的實際范圍為[-15%，12%]，其論域定為[-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6]；為對應(yīng)輸入等級，輸出的模糊子集也取7檔。建立輸出量的模糊語言為{右電機加大速，右電機加中速，右電機加小速，左右電機速度不變，左電機加小速，左電機加中速，左電機加大速。

2.2.2 建立模糊規(guī)則

規(guī)則庫是模糊控制器的核心部分，反映了控制器輸入與輸出的對應(yīng)關(guān)系。機器人在沿磁條行駛時，其自身位姿狀態(tài)與給定路徑的偏差情況如圖7所示。

圖7 機器人位姿狀態(tài)

依據(jù)機器人與磁條的位姿狀態(tài)和實際駕駛經(jīng)驗總結(jié)調(diào)整機器人行駛路徑偏差的原則大致為：當(dāng)車體位置如圖7(a)中所示出現(xiàn)左偏時，若偏差量極大，應(yīng)直接輸出較大的控制量使左側(cè)電機加大速實現(xiàn)糾偏；若偏差量適中，且有減小偏差的趨勢，應(yīng)控制左側(cè)電機適當(dāng)加速回到正軌；若偏差量較小，則直接控制左側(cè)電機輸出較小的控制量實現(xiàn)糾偏；車體位置如圖7(c)中所示出現(xiàn)右偏的情況與上述同理。

2.2.3 模糊決策和反模糊化

目前大量研究表明采用以關(guān)系合成推理（CRI）為基礎(chǔ)能衍生出多種模糊推理方法，其中以Mamdani推理方法最為廣泛使用，它的推理表達式為：

在計算R前，首先依據(jù)模糊規(guī)則的輸入部分得到向量矩陣Qi，然后將Qi轉(zhuǎn)化成隸屬函數(shù)向量同對應(yīng)規(guī)則的輸出部分作直積得到每條規(guī)則下的模糊向量矩陣Ri，最后將所有的Ri作合成運算得到總模糊關(guān)系矩陣R。在進行模糊推理時，只能根據(jù)輸入量在論域中的等級值進行合成運算。

經(jīng)過模糊推理得出的輸出控制量還是模糊集合，不能直接作用于實際輸出環(huán)節(jié)。因此，必須將控制器輸出的模糊量轉(zhuǎn)化為精確的數(shù)字量，本文將采用加權(quán)平均法對輸出的模糊量進行清晰化，其離散情況下的公式如下，式中控制決策值是模糊控制器的輸出量PWM波占空比差值。

3 實驗與分析

以機器人前進動作為研究對象，包括縱向和橫向行駛，通過實驗結(jié)果對機器人的直線糾偏能力和行駛速度性能進行綜合實驗分析。設(shè)定行駛距離為3米，速度定為0.3m/s，計時得出機器人的實際移動速度，將黑色油墨筆貼在鋼板的中心位置，機器人在移動時會在地上畫出軌跡，根據(jù)畫出的軌跡與鋪設(shè)的直線軌跡比較測出每次實驗的最大偏差距離。將機器人的起始位置分別置于偏離磁條2cm、1cm和無偏差位置進行實驗，如圖8、圖9所示，前五次初始位置為右偏，后五次為左偏。速度近似曲線如圖10所示。

圖8 縱向最大橫向偏差距離

圖9 橫向最大橫向偏差距離

圖10 速度性能曲線

由圖可見，機器人行駛時相對于鋪設(shè)磁條的偏差距離范圍在0～20mm之間，縱向偏差整體略小于橫向偏差，當(dāng)機器人初始位置處于正中位置時最大橫向偏差距離最?。粰C器人在行駛速度方面較為穩(wěn)定，沒有明顯的波動變化，基本滿足設(shè)計要求。

4 結(jié)語

本文主要針對有機蔬菜大棚除草機器人的路徑跟蹤研究，將工業(yè)上的磁導(dǎo)航應(yīng)用到有機蔬菜大棚內(nèi)，提出將磁條鋪設(shè)在大棚鋼架上，機器人沿著磁條行駛，使用模糊控制理論的方法實現(xiàn)機器人的直線行走，通過比較采集到的磁信號對移動平臺的輪轂電機不斷進行調(diào)速和控制機器人沿著制定好的行駛路線行駛。實驗結(jié)果顯示，該方法適用于蔬菜大棚除草機器人，行駛速度穩(wěn)定，沿直線行駛的能力較好，與理想路徑誤差在0～20mm之間，滿足蔬菜大棚的需求。