基于STC15的5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)設(shè)計(jì)

潘志國，紀(jì)國寧，張圣龍，劉善琪，張 健

(青島農(nóng)業(yè)大學(xué)機(jī)電工程學(xué)院，山東 青島 266109)

0 引言

隨著社會(huì)和科技的發(fā)展，我國的電動(dòng)農(nóng)業(yè)機(jī)械在動(dòng)力系統(tǒng)的電氣化改進(jìn)基礎(chǔ)之上有了很大的進(jìn)展。電動(dòng)農(nóng)業(yè)機(jī)械具有小巧、靈活的特點(diǎn)，可以在較狹小空間內(nèi)使用。同時(shí)，電能作為一種新的清潔能源，可替代石油成為未來環(huán)保型農(nóng)業(yè)機(jī)械主要應(yīng)用能源。隨著環(huán)境保護(hù)力度日益高漲，農(nóng)業(yè)生產(chǎn)所需能源走向環(huán)保化，電動(dòng)農(nóng)業(yè)機(jī)械發(fā)展空間前景大，推動(dòng)了電動(dòng)農(nóng)業(yè)機(jī)械的發(fā)展[1-2]。

當(dāng)今機(jī)械化農(nóng)業(yè)生產(chǎn)仍需要人力對(duì)其進(jìn)行機(jī)械控制和管理，效率低且人力資源浪費(fèi)嚴(yán)重。市場目前在電動(dòng)農(nóng)業(yè)機(jī)械遙控器方面大多以航模遙控系統(tǒng)為主，其大多難以兼容控制電動(dòng)農(nóng)業(yè)機(jī)械，并且在控制精度和控制距離方面難以達(dá)到農(nóng)機(jī)精準(zhǔn)控制的要求。與此同時(shí)，5G遙控系統(tǒng)在農(nóng)業(yè)領(lǐng)域的應(yīng)用已是大勢所趨，傳統(tǒng)控制系統(tǒng)已無法滿足人們對(duì)功能及穩(wěn)定性的需求。在農(nóng)業(yè)勞動(dòng)力缺乏和農(nóng)機(jī)作業(yè)效率要求越來越高的當(dāng)今社會(huì)，5G遙控系統(tǒng)無疑具有很高的優(yōu)越性和良好的市場潛力[3-4]。

針對(duì)航模遙控系統(tǒng)無法滿足農(nóng)機(jī)控制需求的問題，本文研發(fā)了一種5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)。該系統(tǒng)包括遙控端和接收端兩部分：遙控系統(tǒng)通過遙控端霍爾操縱桿進(jìn)行操縱，控制接收端經(jīng)過比例積分微分(proportion integral differential, PID)算法調(diào)節(jié)后，產(chǎn)生脈沖寬度調(diào)制(pulse width modulation, PWM)信號(hào)，兩端之間利用5G模塊進(jìn)行遠(yuǎn)距離數(shù)據(jù)傳輸。該系統(tǒng)具有安全性高、傳輸距離遠(yuǎn)、使用簡便等優(yōu)點(diǎn)，能夠滿足農(nóng)業(yè)機(jī)械作業(yè)控制需求[5]。

1 系統(tǒng)概述

本文設(shè)計(jì)的電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)整體結(jié)構(gòu)設(shè)計(jì)如圖1所示。

圖1 整體結(jié)構(gòu)設(shè)計(jì)圖

本文所設(shè)計(jì)的5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)分為遙控端和接收端兩部分。主控模塊中央處理器(central processing unit,CPU)均采用STC公司芯片STC15W4K32S4。霍爾操縱桿模塊將操縱桿位置信息轉(zhuǎn)換為電壓信號(hào)輸出、濾波，并由CPU模塊進(jìn)行模擬/數(shù)字(analog/digital,A/D)轉(zhuǎn)換，以實(shí)現(xiàn)對(duì)操縱桿位置信息的實(shí)時(shí)測量。5G模塊實(shí)現(xiàn)數(shù)據(jù)的遠(yuǎn)距離通信，同時(shí)，憑借高速的5G網(wǎng)絡(luò)實(shí)現(xiàn)信號(hào)的實(shí)時(shí)傳輸。接收端主控模塊通過PID算法處理后，產(chǎn)生對(duì)應(yīng)PWM輸出信號(hào)[6-7]。

2 硬件設(shè)計(jì)

2.1 硬件總體設(shè)計(jì)

系統(tǒng)遙控端硬件主要由霍爾操縱桿模塊、主控STC15、5G模塊、電源模塊組成；系統(tǒng)接收端主要由電源模塊、5G模塊、主控STC15、信號(hào)輸出端口組成。通過操控霍爾操縱桿，可實(shí)現(xiàn)對(duì)輸出PWM信號(hào)的控制。

整體硬件框圖如圖2所示。

圖2 整體硬件框圖

2.2 STC15W4K32S4單片機(jī)主控模塊

STC15W4K32S4主控模塊由增強(qiáng)型單時(shí)鐘周期8051 CPU組成，工作頻率范圍可達(dá)5～28 MHz。系統(tǒng)需要5 V的電源。為保證遙控端電流供應(yīng)，選擇12 V電池作為電源，因此需設(shè)計(jì)降壓電路。

降壓模塊電路如圖3所示。

圖3 降壓模塊電路圖

STC15W4K32S4主控板能實(shí)現(xiàn)以下功能。

①通用異步收發(fā)傳輸器(universal asynchronous receiver/transmitter,UART)處理5G模塊接收的數(shù)據(jù)信息。

②控制農(nóng)業(yè)機(jī)械的PWM輸出信號(hào)生成。

③霍爾操縱桿位置數(shù)據(jù)采集。

④PID算法處理。

降壓電路采用的是LM2576降壓芯片。此芯片最大輸出電流可達(dá)到3 A，并且具備完善的保護(hù)電路。保護(hù)電路是一款開關(guān)型降壓電路，具有發(fā)熱低、轉(zhuǎn)換效率強(qiáng)的特點(diǎn)。在降壓電路中添加一個(gè)電感和二極管。其具有儲(chǔ)能和續(xù)流的作用，可保證輸出電能的連續(xù)性[8]。

2.3 霍爾操縱桿模塊

2.3.1 霍爾操縱桿

5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)所采用的霍爾操縱桿為非接觸式霍爾傳感器，具有較高靈敏度的特點(diǎn)，可以檢測較小幅度的位移，從而在一定程度上減小因操縱桿搖動(dòng)角度過大而引發(fā)故障的概率。上電后，傳感器內(nèi)部產(chǎn)生磁場。操縱桿位置變化時(shí)會(huì)改變磁場的強(qiáng)度。磁場強(qiáng)度的變化通過操縱桿內(nèi)部輸出的放大后的霍爾電壓反映出來，即通過搖動(dòng)搖桿到不同位置可以改變輸出電壓的大小。該霍爾操縱桿通過前后左右兩路輸出電壓信號(hào)反映操縱桿位置變化。CPU通過兩路輸出電壓信號(hào)的大小判斷霍爾操縱桿的位置[9]。

霍爾操縱桿信號(hào)輸出特性如圖4所示。

圖4 霍爾操縱桿信號(hào)輸出特性圖

2.3.2 濾波電路

霍爾操縱桿輸出電壓信號(hào)為0～5 V模擬信號(hào)，不可避免地存在干擾，因此需要設(shè)計(jì)濾波電路。濾波電路如圖5所示。

圖5 濾波電路圖

2.4 5G通信模塊

2.4.1 5G模塊MW800

系統(tǒng)采用5G模塊MW800進(jìn)行數(shù)據(jù)通信。該模塊是基于MH5000-31LGA 模塊開發(fā)的一款多接口工業(yè)級(jí)5G模塊，預(yù)留多個(gè)類型硬件接口，能極為方便地把現(xiàn)有設(shè)備升級(jí)到5G，不需要對(duì)硬件進(jìn)行十分大的改造，可縮短研發(fā)周期、降低研發(fā)成本。該模塊具有一路四線UART接口和一路二線UART接口。5G模塊二線UART接口僅用于調(diào)試，故采用系統(tǒng)通過四線UART與5G模塊建立通信，實(shí)現(xiàn)數(shù)據(jù)傳遞。5G模塊UART接口定義如表1所示。

表1 UART接口定義

2.4.2 UART通信模塊

系統(tǒng)采用UART進(jìn)行主控模塊與5G模塊通信。為此，設(shè)計(jì)UART通信電路。SP232為5 V供電TTL-232電平轉(zhuǎn)換芯片，DIN及ROUT端連接單片機(jī)TTL電平UART，則從SP232芯片DOUT及RIN可將其轉(zhuǎn)換為232電平UART。UART通信模塊電路如圖6所示。

圖6 UART通信模塊電路圖

2.5 光耦隔離模塊

由于STC15W4K32S4單片機(jī)的I/O口驅(qū)動(dòng)能力相對(duì)較弱，為了防止負(fù)載所需要的電流過大，以及被控系統(tǒng)電流倒灌損壞CPU，系統(tǒng)采用光耦隔離模塊。

當(dāng)在CH1處輸入高電平，引腳1、引腳2之間發(fā)光二極管點(diǎn)亮，引腳3、引腳4兩端光電三極管在光作用下進(jìn)入飽和區(qū)，則C1處輸出5 V電壓；當(dāng)在CH1處輸入低電平，引腳1、引腳2之間發(fā)光二極管熄滅，引腳3、引腳4兩端光電三極管進(jìn)入截止區(qū)，則C1處輸出0 V電壓。

光耦隔離模塊電路如圖7所示。

圖7 光耦隔離模塊電路圖

3 軟件設(shè)計(jì)

3.1 軟件總體設(shè)計(jì)

遙控端首先通過主控模塊內(nèi)部模擬數(shù)字轉(zhuǎn)換器(ananlog to digital converter,ADC)對(duì)霍爾操縱桿輸出電壓進(jìn)行采集以獲取操縱杠桿位置信息，而后通過對(duì)5G模塊發(fā)送AT指令建立與接收端5G模塊的通信。成功建立通信后，主控模塊將位置信息處理打包通過遙控端5G模塊發(fā)送至接收端。接收端接收到發(fā)送端數(shù)據(jù)后，首先按數(shù)據(jù)格式進(jìn)行解包處理，然后通過內(nèi)部PWM發(fā)生器產(chǎn)生對(duì)應(yīng)PWM信號(hào)，實(shí)現(xiàn)對(duì)農(nóng)機(jī)的控制。軟件總體流程如圖8所示。

圖8 軟件總體流程圖

3.2 5G通信軟件設(shè)計(jì)

設(shè)計(jì)采用5G模塊撥號(hào)上網(wǎng)方式進(jìn)行5G通信，撥號(hào)上網(wǎng)連接成功后即可利用5G數(shù)據(jù)網(wǎng)絡(luò)進(jìn)行數(shù)據(jù)訪問。5G撥號(hào)上網(wǎng)AT指令如表2所示。

表2 5G撥號(hào)上網(wǎng)AT指令

3.3 數(shù)據(jù)整合與解析

遙控端將操縱桿兩路電壓信號(hào)經(jīng)由內(nèi)部ADC將兩路電壓信號(hào)轉(zhuǎn)化為數(shù)字量為0～255的兩路位置信息，以此標(biāo)定操縱桿位置。

同時(shí)，位置信息通過每一包數(shù)據(jù)按照格式“a(起始標(biāo)識(shí)符)，左右位置數(shù)據(jù)，前后位置數(shù)據(jù)，和校驗(yàn)數(shù)據(jù)，e(結(jié)束標(biāo)識(shí)符)”打包發(fā)送至接收端，實(shí)現(xiàn)位置信息發(fā)送。

數(shù)據(jù)接收后，首先通過檢測數(shù)據(jù)起始標(biāo)志位‘a(chǎn)’以及檢測結(jié)束標(biāo)志位‘e’進(jìn)行數(shù)據(jù)篩選，然后通過讀取格式化的字符串中的數(shù)據(jù)來提取數(shù)據(jù)，最后根據(jù)和校驗(yàn)位檢測數(shù)據(jù)正確性，以確保使用數(shù)據(jù)為有效數(shù)據(jù)。獲取有效信息后，利用CPU內(nèi)部PWM產(chǎn)生PWM輸出信號(hào)[10-11]。

操縱桿位置標(biāo)定如圖9所示。

圖9 操縱桿位置標(biāo)定

3.4 PID算法

為保證PWM控制信號(hào)準(zhǔn)確性，輸出PWM控制信號(hào)采用PID算法處理。通過主控芯片自帶ADC測量輸出PWM有效電壓值，以此確定PWM實(shí)際輸出值，并結(jié)合預(yù)設(shè)輸出PWM進(jìn)行PID運(yùn)算[10]。本設(shè)計(jì)采用位置式PID算法，即：

(1)

式中：u(k)為系統(tǒng)的實(shí)際輸出PWM；r(k)為給定預(yù)設(shè)輸出PWM；e(k)為給定值與實(shí)際輸出值構(gòu)成的控制偏差，e(k)=r(k)-u(k)，同時(shí)作為PID控制的輸入；KP為控制器的比例系數(shù)；KI為控制器的積分系數(shù)；KD控制器的微分系數(shù)。

本設(shè)計(jì)中，位置式PID系統(tǒng)原理如圖10所示。

圖10 PID系統(tǒng)原理框圖

3.5 脫控檢測與緊急停止

為防止被控農(nóng)機(jī)在未接收遙控端信號(hào)時(shí)出現(xiàn)誤動(dòng)作，本文增設(shè)一定時(shí)脫控檢測程序模塊。脫控檢測程序模塊每10 ms進(jìn)行一次檢測，每次均檢測是否接收到遙控系統(tǒng)遙控端數(shù)據(jù)。若未檢測到遙控端數(shù)據(jù)，則強(qiáng)制產(chǎn)生使農(nóng)機(jī)停止的PWM輸出波形，控制農(nóng)機(jī)停止，避免在脫控狀態(tài)下農(nóng)機(jī)產(chǎn)生失控誤動(dòng)作[12]。

4 系統(tǒng)調(diào)試及試驗(yàn)

經(jīng)測試：12 V電壓經(jīng)過降壓模塊將電壓降為5 V。霍爾操縱桿控制兩路產(chǎn)生PWM輸出波形，從而實(shí)現(xiàn)設(shè)計(jì)要求。

電壓跟隨器在濾波電路中主要負(fù)責(zé)阻抗匹配和穩(wěn)定電壓。通過改變電壓跟隨器輸入電壓，并與輸出電壓進(jìn)行多次測量比，可得到如表3所示的電壓跟隨器測試數(shù)據(jù)。

表3 電壓跟隨器測試數(shù)據(jù)

濾波電路測試數(shù)據(jù)如表4所示。

表4 濾波電路測試數(shù)據(jù)

降壓模塊電路為整個(gè)遙控系統(tǒng)提供電壓，包括CPU和各個(gè)電路。供電嚴(yán)重影響整個(gè)控制器的穩(wěn)定性。降壓電路測試數(shù)據(jù)如表5所示。

表5 降壓電路測試數(shù)據(jù)

5 車輛試驗(yàn)

為驗(yàn)證5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)的實(shí)用性，將該遙控系統(tǒng)安裝于履帶式平臺(tái)車上，通過驅(qū)動(dòng)器對(duì)履帶式平臺(tái)車進(jìn)行了控制測試。

5.1 霍爾操縱桿測試

遙控過程中，霍爾操縱桿將前后、左右兩軸位置轉(zhuǎn)換為兩路電壓信號(hào)。

兩路采集信號(hào)變化如表6所示。

表6 采集信號(hào)變化

實(shí)際采集信號(hào)變化與理論相同。兩路信號(hào)與操縱桿移動(dòng)角度成正比函數(shù)，在-60°～+60°以內(nèi)，信號(hào)電壓大小隨著轉(zhuǎn)向角度的增大而增大。

5.2 5G通信模塊測試

5G模塊通過AT指令建立5G網(wǎng)絡(luò)通信連接，根據(jù)回復(fù)指令完成通信的建立，同時(shí)根據(jù)回復(fù)指令判斷建立是否成功。當(dāng)回復(fù)指令表示5G通信建立成功時(shí)，通過四線UART進(jìn)行數(shù)據(jù)發(fā)送接收測試正常，可實(shí)現(xiàn)5G通信。AT指令回復(fù)如表7所示。

表7 AT指令回復(fù)

5.3 系統(tǒng)PWM輸出信號(hào)測試

系統(tǒng)使用系統(tǒng)遙控端霍爾操縱桿，通過5G通信對(duì)接收端產(chǎn)生的PWM輸出信號(hào)進(jìn)行精確控制。測試遙控端霍爾操縱桿角度與接收端產(chǎn)生PWM輸出信號(hào)關(guān)系如表8所示。

表8 操縱桿角度與PWM輸出信號(hào)關(guān)系

5.4 農(nóng)機(jī)控制行駛測試

將遙控系統(tǒng)接收端加裝于履帶式平臺(tái)車，通過操控遙控端進(jìn)行農(nóng)機(jī)控制的測試。當(dāng)操縱桿處于靜止中間位置時(shí)，測試車輛靜止；經(jīng)測試，向前(后)推動(dòng)操縱桿時(shí)，測試車輛前進(jìn)，隨著操縱桿前(后)推位移增大速度加快；當(dāng)向左(右)推動(dòng)操縱桿時(shí)，測試車輛向左(右)原地轉(zhuǎn)彎，隨著操縱桿左(右)推位移增大轉(zhuǎn)彎速度加快；當(dāng)向前(后)推動(dòng)操縱桿時(shí)向左(右)推動(dòng)操縱桿時(shí)，測試車輛可在前進(jìn)(后退)的同時(shí)時(shí)向左(右)轉(zhuǎn)彎。該測試結(jié)果證明，所設(shè)計(jì)的系統(tǒng)實(shí)現(xiàn)了預(yù)期功能。

遙控端控制測試車輛的運(yùn)動(dòng)，實(shí)際測試車輛啟停延時(shí)時(shí)間，進(jìn)行試驗(yàn)記錄。運(yùn)動(dòng)控制延時(shí)如表9所示。

表9 運(yùn)動(dòng)控制延時(shí)

6 結(jié)論

本文通過PWM輸出信號(hào)控制以及5G通信，研制了5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)。該系統(tǒng)通過霍爾操縱桿控制兩路PWM輸出信號(hào)占空比，以此控制大部分電動(dòng)農(nóng)機(jī)系統(tǒng)運(yùn)動(dòng)；結(jié)合PID算法控制，控制精確且易于操作。當(dāng)出現(xiàn)遙控信號(hào)中斷、農(nóng)用機(jī)械超出范圍限度等情況時(shí)，通過系統(tǒng)實(shí)現(xiàn)急停功能，可避免事故的發(fā)生。

試驗(yàn)證明，本文設(shè)計(jì)的基于STL15的5G電動(dòng)農(nóng)業(yè)機(jī)械遙控系統(tǒng)具有安全性高、實(shí)用性強(qiáng)、適用范圍廣、傳輸距離遠(yuǎn)、使用簡便、節(jié)省勞動(dòng)力等優(yōu)點(diǎn)，能夠滿足當(dāng)前大部分PWM輸出信號(hào)控制農(nóng)機(jī)的需求，可解決當(dāng)前航模遙控系統(tǒng)存在的種種問題，并替代航模遙控系統(tǒng)實(shí)現(xiàn)農(nóng)機(jī)控制，具有較強(qiáng)的優(yōu)越性和良好的市場潛力。