基于STM32的公共場所清潔機器人＊

陳 楊，彭友玉，謝邵春，鄭辰雅，張雯麗

（合肥工業大學 儀器科學與光電工程學院，安徽 合肥 230009）

1 背景

家用清潔機器人是一款能夠把人從家庭地面清潔工作中解放出來的，可以在地面自主移動，同時完成地面清掃、吸塵任務，而不需要人類監督的機器人[1]。目前，市場上的清潔機器人僅適用于家庭環境[2-4]，對于科技館、科研所、醫院、辦公樓等公共場所，沒有適用的清潔產品，而在公用場所使用家用清潔機器人多有不便。在人工智能越來越普及的今天，各種用途的樓宇也陸續實現智能化，讓人們的生活更加便捷。在這種大趨勢下，清潔機器人也必將向智能化邁進。因此，結合公共場所清潔機器人的市場空缺以及人工智能的普及，智能化的樓宇清潔機器人將有巨大的發展前景[5]。鑒于目前ARM微處理器在國內市場上的廣泛使用及其廣闊的發展前景，本研究選擇STM32F407微處理器作為系統核心，設計了一款可以在智能樓宇的公共場所中進行地面清潔的公共場所清潔機器人，它具有自動清潔、智能防盜報警、智能語音控制等功能。

2 系統結構

本設計中，清潔機器人由7部分組成，包括主控系統、移動系統、感知系統、電源系統、清潔系統、智能語音控制系統和智能防盜報警系統。系統結構如圖1所示。

主控系統由STM32F407單片機開發板構成，功能包括對感知系統獲得的環境信息進行處理，對清潔系統和移動系統進行控制。內部也燒錄進了模糊規則算法和PID控制算法等軟件程序，對機器人的前進路徑進行規劃。移動系統包括2個直流電機控制的橡膠輪和1個萬向輪，直流電機使用L298N驅動芯片進行PWM控制，同時使用PID算法來保證輪子的精確轉向。電源系統即為單片機、移動機構的直流電機、清掃機構的直流電機等部件供電的整體設計。在感知系統中，使用避障傳感器和防跌落傳感器來保證機器人能夠獲得環境信息，使用光電編碼器獲取機器人移動的數據。清潔系統包括2個旋轉刷毛、1個拖布和1個塵盒，使用大功率的電機來實現強力清掃吸塵。智能語音控制系統使用LD3320芯片獲取聲音信息，單片機處理信息后向移動系統發出相應的指令。智能防盜報警系統使用ESP8266WIFI模塊，當智能樓宇中的清潔機器人離開大樓時，WIFI連接會斷開，從而出發警報。

圖1 系統結構示意圖

3 硬件部分

3.1 STM32F407微處理器

STM32F4系列是意法半導體出品的一款高性能、低成本、低功耗的微控制器。本次設計選用STM32F407ZGT6芯片，該芯片基于最新的ARM Cortex-M4內核，最高時鐘頻率為168 MHz，支持單周期DSP指令和浮點單元、192 KB的SRAM容量、512 KB～1 MB的嵌入式閃存和影像、網絡接口、數據加密等更先進的外設，其強大的功能以及豐富的外設資源滿足本次設計的要求[6]。

3.2 移動機構

移動機構由機器人底部的1個萬向輪和2個12 V直流電機驅動的橡膠輪組成。直流電機使用L298N電機驅動模塊驅動，模塊如圖2所示。L298N是雙H橋直流電機驅動芯片，供電范圍為＋5～＋35 V。本設計采用＋12 V可充電機器人鎳氫電池供電。通過STM32F407中的通用定時器TIM2產生PWM波，經過GPIOF2/3引腳輸出，再通過GPIOF0/1引腳和GPIO9/10引腳分別控制電機的正轉和反轉。實現機器人轉向的方式是，當2個輪子轉向相反時，機器人原地旋轉。

圖2 L298N驅動直流電機電路原理圖

3.3 傳感器機構

3.3.1 避障傳感器

5個紅外傳感器均勻分布在機器人前端。當紅外傳感器前方出現障礙物時，接收管接收到反射信號，經過LM339比較器處理后，輸出1個低電平給單片機，單片機根據內置的算法控制機器人的移動系統。電位器旋鈕可以調節障礙物的探測距離，本設計中調整探測距離為5 cm。工作電壓為＋3～＋5 V，采用STM32F407單片機上的＋5 V電源進行供電。紅外線傳感器的工作原理如圖3所示。

3.3.2 防跌落傳感器

2個紅外線傳感器位于機器人前端的底部。通過調節電位器，當地面距離傳感器大于5 cm時，傳感器向單片機對應GPIO口輸出低電平。單片機控制機器人向后移動，防止機器人跌落。

3.3.3 光電編碼器

光電編碼器和光電碼盤均安裝在移動機構12 V直流電機上，車輪轉動時帶動碼盤轉動，編碼器采集電平變化，再使用STM32F407單片機的通用定時器TIM2的輸入捕獲功能，使用計數器的脈沖計數記錄編碼器采集到的電平上升沿的數量，從而計算出清潔機器人單個車輪移動的距離。據此結合PID算法可以精確控制清潔機器人的轉向。

3.4 智能語音控制

語音識別部分采用LD3320語音識別芯片。該芯片是一顆基于非特定人語音識別芯片，芯片上集成了高精度的A/D接口和D/A接口，不再需要外接輔助的Flash和RAM即可以實現語音識別功能，并且識別的關鍵詞語列表可以動態編輯。因此，其語音識別率比較穩定，準確率也比較高[7，8]。智能語音識別模塊系統及其工作原理如圖4所示。

圖3 紅外線傳感器電路原理圖

圖4 LD3320系統框圖及原理圖

在本設計中，LD3320芯片采用并行方式直接與STM32F407單片機相接，并均采用1 K電阻上拉。在圖5中，A0用于判斷是數據段還是地址段控制信號。RDB、WRB、CSB、STB（復位信號）以及中斷返回信號INTB與STM32F407直接相連，為了輔助系統穩定工作，均采用10 K電阻上拉。

LD3320芯片內部的語音識別原理是：①將通過MIC輸入的聲音進行頻譜分析；②提取語音特征，通過以上2步后將得到語音（即關鍵詞）的特征信息；③將關鍵詞語列表（即訓練模板）中的數據與特征信息進行對比匹配；④找出得分最高的關鍵詞語作為識別結果輸出，進而控制清潔機器人執行相應的語音動作。

3.5 電源系統

總電源采用12 V、3 500 mAh的清潔機器人鎳氫充電電池，分別為STM32F407、清潔刷直流電機、吸塵器直流電機和移動結構直流電機直接提供＋12 V電壓。5個避障傳感器、2個防跌落傳感器和2個光電編碼器則采用STM32F4單片機上提供的＋5 V、＋3.3 V電源引腳供電。

3.6 智能防盜報警

智能防盜報警模塊使用ATK-ESP8266WFI模塊。該模塊采用串口（LVTTL）與STM32F407單片機通信，內置TCP/IP協議棧，能夠實現串口與WIFI之間的轉換。選擇串口無線STA（COM-STA）模式，模塊作為無線WIFI-STA，用于連接到無線網絡，實現串口與其他設備之間的無線（WIFI）數據轉換互傳。在該模式下，根據應用場景的不同，可以設置3個子模式，即TCP服務器、TCP客戶端、UDP。選擇TCP服務器，此時，程序會配置模塊為WIFI-AP模式，待配置好后，進入TCP服務器測試界面。此時，模塊的TCP服務器已經開啟，但是，由于沒有TCPClient來連接，所以狀態顯示“連接失敗”。

打開智能手機的WIFI功能，設置無線網絡，即可在WLAN網絡里面看到有ATK-ESP8266的網絡SSID。點擊該網絡，輸入密碼，再點擊連接，即可連接到WIFI模塊。稍等片刻，手機便會連接到ATK-ESP8266模塊，然后在手機上安裝相應的配套軟件，之后在手機上運行該程序，依次設置。連接成功建立后，可以看到相互的連接狀態，當兩者相距太遠，則在手機上會顯示disconnect，蜂鳴器響起，從而達到防盜報警功能。WIFI模塊連接情況如圖6所示。

圖5 LD3320電路原理圖

圖6 WIFI模塊連接示意圖

4 軟件部分

軟件部分主要實現機器人的避障、柵格法遍歷算法、路徑優化和移動機構的PID控制。程序采用STM32F407的固件函數庫在Keil5環境下編寫，主要包括以下內容。

4.1 單片機資源配置

先完成單片機的資源分配，配置GPIO口的模式，初始化相應的GPIO口。單片機資源分配如表1所示。

表1 STM32F407單片機資源分配

4.2 避障部分

本設計采用紅外傳感器避障，5個紅外線傳感器均布在機器人前端180°的范圍內。當紅外傳感器未檢測到障礙物時，單片機對應引腳獲取高電平；當紅外傳感器探測到障礙物時，單片機對應引腳獲取低電平。避障規則如表2所示。其中，0代表無障礙物，1代表有障礙物，電機部分1代表電機正轉，－1代表電機反轉。運用PID算法能夠保證機器人準確旋轉 90°。

表2 模糊規則避障表格

4.3 柵格法

柵格法是目前應用最廣泛、最可靠的一種局部區域規劃算法。該方法將機器人的工作區域劃分成為與機器人大小相同的一系列網格，并將網格進行二值化，即有障礙物的區域記錄為1，無障礙物的區域記錄為0.在機器人運動的過程中，障礙物的大小和位置不發生變化。機器人通過內置的算法在無障礙物區域中計算出1條可以遍歷的路徑，從而完成清掃工作。

4.3.1 環境建模

機器人采用2種方法熟悉當前環境：①將已知的環境平面圖和障礙物信息進行網格劃分，并以環境的某個指定角落為原點，形成二維坐標，將二值化后的信息以二維數組的方式導入到機器人中。②讓機器人從原點開始對環境進行遍歷運動，通過自身移動路徑來記錄環境信息，如圖7（a）所示。這種方法的具體操作過程是，機器人從（0，0）開始，沿y軸方向移動，根據光電編碼器記錄的車輪移動距離信息計算出當前所在的柵格位置，并且在已通過區域的二維數組的對應位置記錄下0.當機器人遇到障礙物時，繞過障礙物繼續沿y軸方向移動，并在有障礙物的位置記錄下1.當y值無法增大后，機器人沿x方向移動一個車身，并向y軸負方向移動。由此往復運動，記錄下當前地圖的信息，最終當機器人遍歷當前地圖后，完成環境建模，信息存儲在二維數組當中，如圖7（b）所示。

4.3.2 矩形搜索算法

對機器人獲取的二維數組進行劃分處理，利用矩形搜索算法將可清掃區域劃分成若干個矩形。具體過程是，從原點開始在y＝0行沿x軸方向依次尋找二維數組中值為0的柵格，并記錄下來，直到遇到值為1的柵格后，開始搜尋y＝1行，搜索到上一行值為1的柵格的x值位置便停止，之后y值再次加1，如此循環。

如果過程中遇到值為1的柵格，便停止搜索，把此時y值行記錄下來的柵格記錄取消，之前記錄下的柵格便是一個可清掃矩形區域，記錄為A1，并將該區域的柵格值全部替換成1，形成新的環境二維數組。之后對新的環境二維數組進行矩形區域搜索，直到所有柵格的值均為1.如此便可劃分出若干個可清掃區域的數組Ai，具體算法流程如圖8所示。隨后機器人按照數組的命名順序依次清掃各區域，區域劃分如圖7（c）所示。

4.4 車輪PID控制

由本次采集的光電編碼器數據與設定值進行比較得出偏差e（n），對偏差進行PID運算，最終利用運算結果控制PWM脈沖的占空比來實現對加在電機兩端電壓的調節，進而控制電機轉速。機器人的移動由2個獨立直流電機負責，這2個電機的PID控制系統結構是一樣的，如圖9所示。

圖7 環境信息獲取及處理示意圖

圖8 矩形搜索算法軟件流程圖

圖9 機器人的PID控制系統結構

圖9中，Vin為給定信號，Vout為實際信號。PID控制系統參數整定采用經驗湊試法，因系統采用PI調節規律，即先確定一個調節器的參數值PB和Ti，通過改變給定值對控制系統施加一個擾動，現場觀察判斷控制曲線形狀。如果曲線不夠理想，可以改變PB或Ti，再記錄控制過程曲線，反復湊試，直到出現4∶1衰減曲線為止，這時的PB和Ti就是最佳值。

該算法有2個優點：①控制系統的測量精度在PI整定參數合適的情況下，控制精度非常高，控制量很快就能穩定在設定值上；②控制系統應采用PI控制規律，系統稍有誤差就會立刻調節，可消除周圍環境對控制系統的影響[9-10]。

5 結束語

本文設計了一款適用于智能樓宇的公共場所清潔機器人。其核心控制器采用STM32F407單片機，通過移動機構、清潔機構、電源系統、智能防盜報警系統等硬件部分與PID控制、避障算法等軟件程序的結合可以實現清潔機器人對公共場所環境的規劃以及自動清掃，并且能通過語音識別系統對非特定人的語音指令做出相應的動作。在機器人離開樓宇，WIFI連接斷開后，還會啟動蜂鳴器報警，實現智能防盜報警功能。這個設計為清潔機器人向智能化邁進做了一些工作，也填補了目前市場上沒有公共場所清潔機器人的空白。

參考文獻：

［1］周盛榮.智能家庭清掃機器人的研究［D］.哈爾濱：哈爾濱工業大學，2006.

［2］曾岑，陳進，蔣玉杰.智能型室內清潔機器人的研究和發展探析［J］.機械制造，2008（10）：63-67.

［3］石為人，周學益.室內清潔機器人避障路徑規劃研究［J］.計算機應用，2007（S1）：378-379.

［4］譚定忠，王啟明，李金山，等.清潔機器人研究發展現狀［J］.機械工程師，2004（06）：9-11.

［5］林旭斌.樓宇智能化技術在智能建筑中的應用研究［J］.江西建材，2017（13）：67-68.

［6］張洋.精通STM32F4［M］.北京：北京航空航天大學出版社，2015.

［7］金鑫，田犇，闕大順.基于LD3320的語音控制系統設計實現［J］.電腦與信息技術，2011，19（06）：22-25.

［8］劉天順，丁騰騰，毛強.基于LD3320語音控制智能車的設計［J］.數字技術與應用，2015（10）：5-7.

［9］余莎麗，劉小龍，周健民.基于模糊PID與算法控制智能小車速度［J］.自動化與儀器儀表，2012（02）：76-77.

［10］孫揚智.基于雙層模糊邏輯控制的智能小車研究［D］.成都：西南交通大學，2016.