基于AGV的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)設(shè)計(jì)

孫 聰 曹 亮 雷鳳蕓

成都市農(nóng)林科學(xué)院，四川 成都 611134

0 引言

無人搬運(yùn)車（Automated Guided Vehicle，AGV）的應(yīng)用能夠有效提升我國農(nóng)業(yè)生產(chǎn)效率，但對(duì)其進(jìn)行調(diào)度及控制存在一定的難度。當(dāng)多個(gè)AGV同時(shí)作業(yè)時(shí)，時(shí)常出現(xiàn)路徑擁堵、沖突等狀況，在一定程度上限制了其應(yīng)用［1］。為此，筆者針對(duì)設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)的設(shè)計(jì)展開深入探討，以期助力我國農(nóng)業(yè)發(fā)展。

1 設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)作業(yè)流程

為了實(shí)現(xiàn)設(shè)施農(nóng)業(yè)物流運(yùn)輸自動(dòng)化，筆者設(shè)計(jì)了一種基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)。該系統(tǒng)總體結(jié)構(gòu)如圖1 所示?；贏GV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)主要分為3 個(gè)層次，每個(gè)層次分別完成不同規(guī)模的任務(wù)，并且任務(wù)規(guī)模由下至上呈遞增趨勢(shì)［2］。當(dāng)用戶對(duì)控制系統(tǒng)下達(dá)任務(wù)請(qǐng)求時(shí)，任務(wù)規(guī)劃層接收到請(qǐng)求進(jìn)行設(shè)施農(nóng)業(yè)物流運(yùn)輸任務(wù)規(guī)劃，并將規(guī)劃好的任務(wù)映射至子任務(wù)，由任務(wù)規(guī)劃層對(duì)子任務(wù)進(jìn)行優(yōu)化排序，從而生成AGV 的控制路徑，最后將其傳輸至行為決策層。行為決策層接收到子任務(wù)后將其映射至AGV 行為，從而生成一系列的AGV 控制行為指令，如起步、轉(zhuǎn)彎、加速、停止等，再將行為指令下達(dá)至智能控制層。智能控制層接收到AGV 行為控制指令后，將其映射至AGV 的動(dòng)作控制，從而控制AGV 完成相應(yīng)的動(dòng)作。由此可見，在筆者所設(shè)計(jì)的基于AGV的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)中，每一個(gè)層次的邏輯方式、時(shí)域跨度及對(duì)實(shí)現(xiàn)控制任務(wù)所賦予的指令等各不相同，但是這種遞階合作式的控制結(jié)構(gòu)可以使被控的AGV 在不確定環(huán)境下?lián)碛辛己玫倪m應(yīng)能力，進(jìn)而滿足設(shè)施農(nóng)業(yè)物流運(yùn)輸?shù)母呔?、?shí)時(shí)性等要求。

圖1 基于AGV的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)

2 基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)硬件設(shè)計(jì)

基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)主要由AGV、主控制器、節(jié)點(diǎn)傳感器及執(zhí)行設(shè)備配電箱等組件構(gòu)成。

2.1 主控制器

主控制器是基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)的核心，其性能至關(guān)重要。筆者綜合考慮AGV 的實(shí)際結(jié)構(gòu)，選用STM32F407 單片機(jī)作為主控芯片。該單片機(jī)內(nèi)置32 位核心處理器，主要功能特點(diǎn)如表1所示。

表1 STM32F407單片機(jī)參數(shù)

STM32F407 單片機(jī)不僅具有較好的穩(wěn)定性，而且運(yùn)算速度較快。應(yīng)用STM32F407 單片機(jī)可大大提升AGV 控制程序的執(zhí)行效率，完全能滿足設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)對(duì)主控制器的需求。

2.2 節(jié)點(diǎn)傳感器

在基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)中，農(nóng)業(yè)生產(chǎn)環(huán)境信息采集主要依靠溫濕度傳感器來完成。在進(jìn)行節(jié)點(diǎn)傳感器選型時(shí)，筆者綜合考慮傳感器的測(cè)量精度及抗干擾能力，選用DHT90數(shù)字溫濕度傳感器。該傳感器具有多種封裝形式，可以適應(yīng)不同的設(shè)施農(nóng)業(yè)物流運(yùn)輸場(chǎng)景。其引腳分布情況如圖2所示。

圖2 DHT90數(shù)字溫濕度傳感器引腳示意圖

利用DHT90 數(shù)字溫濕度傳感器采集設(shè)施農(nóng)業(yè)物流運(yùn)輸環(huán)境信息時(shí)，傳感器AO 引腳會(huì)輸出采集的溫濕度信息模擬量，經(jīng)過模擬/數(shù)字（Analog/Digital，A/D）轉(zhuǎn)換后顯示設(shè)施農(nóng)業(yè)物流環(huán)境的溫濕度數(shù)值。

2.3 執(zhí)行設(shè)備配電箱

執(zhí)行設(shè)備配電箱（見圖3）主要由9部分構(gòu)成，即氣泵、主動(dòng)圈、從動(dòng)圈、承接凸輪、滾軸、主動(dòng)圈連桿、主動(dòng)圈葉片、從動(dòng)圈葉片和從動(dòng)圈連桿。筆者選用MNS型執(zhí)行設(shè)備配電箱進(jìn)行設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)配電控制。MNS 型執(zhí)行設(shè)備配電箱應(yīng)裝設(shè)端正、牢固，固定式配電箱的中心點(diǎn)與地面的垂直距離應(yīng)為1.4～1.6 m。

圖3 執(zhí)行設(shè)備配電箱

3 基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)軟件設(shè)計(jì)

3.1 AGV運(yùn)動(dòng)控制模型

筆者設(shè)計(jì)的基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)的主要被控對(duì)象為AGV，因此設(shè)計(jì)系統(tǒng)軟件時(shí)需要了解AGV 運(yùn)動(dòng)控制模型。AGV 運(yùn)動(dòng)控制模型的控制原理如圖4所示［3］。

圖4 AGV運(yùn)動(dòng)控制模型原理

首先確定AGV開環(huán)傳遞函數(shù)C，公式為

式（1）中：δ表示拉普拉斯算子，ω表示控制截止頻率，η表示AGV阻尼。

利用自適應(yīng)律調(diào)節(jié)控制器的參數(shù)，得到AGV線性控制模型為［4］

式（2）中：U 表示AGV 控制變量，α0、α1、α2分別表示AGV 驅(qū)動(dòng)在未知負(fù)載作用下的系數(shù)，β 表示參考模型的控制輸出表示AGV控制器的一階輸出表示AGV 控制器的二階輸出。式（2）通過選取合適的自適應(yīng)律，即可使AGV 的輸出與參考模型輸出保持一致，從而達(dá)到AGV的運(yùn)動(dòng)控制目的。

3.2 設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑規(guī)劃算法

在基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)中，合理的設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑規(guī)劃對(duì)確保控制效果至關(guān)重要［5］。筆者綜合考慮設(shè)施農(nóng)業(yè)物流的實(shí)際運(yùn)輸環(huán)境及AGV的運(yùn)行情況，引入A-STAR算法來規(guī)劃設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑，即控制AGV 行走的最優(yōu)路徑［6］。該算法可以有效適應(yīng)設(shè)施農(nóng)業(yè)作業(yè)環(huán)境的拓?fù)渥兓?，屬于啟發(fā)式搜索算法。A-STAR 算法在規(guī)劃物流運(yùn)輸路徑時(shí)不會(huì)盲目遍歷全部節(jié)點(diǎn)，而是先對(duì)各個(gè)節(jié)點(diǎn)進(jìn)行評(píng)估，根據(jù)評(píng)估結(jié)果來規(guī)劃設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑。所以，該系統(tǒng)引入A-STAR 算法可以顯著提升AGV的控制效率［7］。A-STAR算法的評(píng)估函數(shù)為

式（3）中：P（i）表示設(shè)施農(nóng)業(yè)物流運(yùn)輸規(guī)劃路徑中路過節(jié)點(diǎn)i的距離代價(jià)評(píng)估值；D（i）表示規(guī)劃設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑對(duì)節(jié)點(diǎn)i 遍歷的實(shí)際距離代價(jià)，即估計(jì)運(yùn)輸路徑的耗時(shí)；F（i）表示遍歷節(jié)點(diǎn)i 的啟發(fā)代價(jià)值［8-9］。該算法的關(guān)鍵是估價(jià)函數(shù)F（i），其表達(dá)形式有很多種。筆者主要采用曼哈頓距離函數(shù)來代表估價(jià)函數(shù)，計(jì)算公式為

式（4）中：x 表示設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑中目標(biāo)點(diǎn)的橫坐標(biāo)，y 表示設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑中目標(biāo)點(diǎn)的縱坐標(biāo)，xi表示節(jié)點(diǎn)i的橫坐標(biāo)，yi表示節(jié)點(diǎn)i的縱坐標(biāo)。式（4）所示的曼哈頓距離函數(shù)可以確保估價(jià)函數(shù)描述的設(shè)施農(nóng)業(yè)物流運(yùn)輸路徑起點(diǎn)與終點(diǎn)之間距離更加接近，進(jìn)而保證控制AGV沿著最優(yōu)路徑向目標(biāo)終點(diǎn)前進(jìn)。

4 系統(tǒng)測(cè)試

系統(tǒng)測(cè)試是驗(yàn)證基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)可行性與可靠性的關(guān)鍵。筆者在MATLAB 環(huán)境下開展仿真試驗(yàn)，測(cè)試該系統(tǒng)的控制性能。首先，搭建一個(gè)如圖5 所示的柵格地圖模型作為仿真環(huán)境。

圖5 系統(tǒng)測(cè)試仿真環(huán)境

由圖5 可知，此次系統(tǒng)測(cè)試所使用的柵格地圖模型尺寸為15 cm×15 cm，其中AGV 的起始點(diǎn)坐標(biāo)為（1，1），目標(biāo)終點(diǎn)坐標(biāo)為（15，15），地圖中的障礙物為隨機(jī)生成。為客觀評(píng)價(jià)該系統(tǒng)的控制性能，選用基于多因子約束的AGV 控制系統(tǒng)、基于自適應(yīng)控制的AGV控制系統(tǒng)作為對(duì)照。測(cè)試過程中，分別使用這3 個(gè)系統(tǒng)控制AGV由起始點(diǎn)走向目標(biāo)點(diǎn)，每經(jīng)過一個(gè)柵格需要2 s，如果在格內(nèi)轉(zhuǎn)彎則需要4 s 經(jīng)過柵格，獲得測(cè)試結(jié)果如圖6所示。

圖6 系統(tǒng)路徑規(guī)劃結(jié)果

由圖6 可知，使用多因子約束系統(tǒng)在該地圖中規(guī)劃的AGV行走路徑共轉(zhuǎn)折10次，AGV行走時(shí)間為72 s；使用自適應(yīng)控制系統(tǒng)在該地圖中規(guī)劃的AGV 行走路徑共轉(zhuǎn)折9 次，AGV 行走時(shí)間為70 s；使用基于AGV的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)在該地圖中規(guī)劃的AGV 行走路徑共轉(zhuǎn)折4次（較基于多因子約束的AGV控制系統(tǒng)、基于自適應(yīng)控制的AGV控制系統(tǒng)分別減少了6 次、5 次），AGV 行走時(shí)間為60 s（較基于多因子約束的AGV 控制系統(tǒng)、基于自適應(yīng)控制的AGV 控制系統(tǒng)分別縮短了12、10 s）。這說明筆者設(shè)計(jì)的系統(tǒng)可以尋求到最優(yōu)AGV行走路徑。此外，系統(tǒng)分別統(tǒng)計(jì)在不同尺寸柵格地圖中這3 個(gè)系統(tǒng)規(guī)劃AGV 行走路徑時(shí)所遍歷的節(jié)點(diǎn)數(shù)目，對(duì)比結(jié)果如圖7所示。

圖7 控制系統(tǒng)遍歷節(jié)點(diǎn)數(shù)量對(duì)比圖

由圖7 可知，隨著柵格地圖尺寸的增加，系統(tǒng)在控制AGV行走時(shí)所遍歷的節(jié)點(diǎn)數(shù)目也在不斷增加，而筆者所設(shè)計(jì)的系統(tǒng)在控制過程中遍歷節(jié)點(diǎn)的數(shù)目一直遠(yuǎn)遠(yuǎn)小于對(duì)照，有效加快了AGV路徑規(guī)劃算法的計(jì)算速度。此次測(cè)試結(jié)果可以驗(yàn)證基于AGV 的設(shè)施農(nóng)業(yè)物流遞階智能控制系統(tǒng)是可行且可靠的，具有優(yōu)越的控制性能。

5 結(jié)語

通過系統(tǒng)測(cè)試，筆者驗(yàn)證了所設(shè)計(jì)的系統(tǒng)在規(guī)劃AGV 作業(yè)路徑時(shí)，可以優(yōu)化路徑的轉(zhuǎn)折次數(shù)及控制過程中的節(jié)點(diǎn)遍歷數(shù)量。但今后相關(guān)學(xué)者還需要對(duì)更多的復(fù)雜細(xì)節(jié)問題進(jìn)行綜合研究。