潘胤卓

摘 要：目前環(huán)衛(wèi)工人清潔小區(qū)衛(wèi)生，主要采用手推垃圾車，配合相應(yīng)的清掃工具作業(yè)。操作者需邊推車邊打掃，作業(yè)效率低，勞動強度大。如實現(xiàn)垃圾車跟隨作業(yè)者工作，并具有吸垃圾的功能，可提高環(huán)衛(wèi)工人工作效率。為了提高環(huán)衛(wèi)工人的工作效率，本人設(shè)計了具有跟蹤功能的吸塵器，可實現(xiàn)清潔車邊吸垃圾邊跟隨操作者的功能。本文分別從機械結(jié)構(gòu)設(shè)計、控制系統(tǒng)設(shè)計和動力系統(tǒng)設(shè)計三方面闡述該設(shè)備的設(shè)計原理和方法。

關(guān)鍵詞：吸塵器 UWB定位 跟蹤

一、引言

目前主流的跟隨技術(shù)有兩種，分別是視覺跟隨技術(shù)和UWB跟隨技術(shù)。視覺跟蹤技術(shù)采用CCD攝像頭傳感器，主要依靠圖像特征進行定位，具有價格高、處理復雜、成本高等特點，在光線不足和視線受阻的情況下無法工作，不適應(yīng)夜晚和人流密集的環(huán)境。UWB跟蹤技術(shù)采用無線脈沖波定位，具有定位準確度高，成本低，不受光線和視線遮擋的影響等特點。由于環(huán)衛(wèi)工人作業(yè)環(huán)境人流密集，時而夜晚作業(yè)，跟蹤吸塵器采用UWB定位技術(shù)，可降低環(huán)境的影響，實現(xiàn)實時跟隨的作業(yè)效果。

二、機械結(jié)構(gòu)設(shè)計

（一）跟蹤吸塵器整體結(jié)構(gòu)

跟蹤吸塵器整體結(jié)構(gòu)如圖1所示，由吸塵裝置、行走裝置和架體組成。

圖1 跟蹤吸塵器結(jié)構(gòu)圖

（二）吸塵裝置設(shè)計

吸塵裝置由殼體、風機、濾芯、隨意停支桿、吸塵管和滿倉傳感器組成，如圖2所示。風機在殼體內(nèi)產(chǎn)生負壓，垃圾雜物由吸塵管進入殼體。滿倉傳感器通過檢測垃圾的高度判斷垃圾桶是否滿倉。隨意停支桿可支撐殼體抬起，便于操作者更換垃圾箱。吸塵管由PU軟管、PLA硬管、手持控制器、萬向輪組成，如圖3所示，具有操作簡單靈活的特點。

圖2 吸塵裝置結(jié)構(gòu)圖

圖3 吸塵管結(jié)構(gòu)圖

（三）行走裝置結(jié)構(gòu)

行走裝置由兩個驅(qū)動輪和兩個萬向輪組成，驅(qū)動輪由電機、聯(lián)軸器、支撐架、電磁離合器和輪胎組成。電磁離合器可連接或斷開電機的動力輸入，切換跟隨模式和手動模式。工作時，當遇到復雜路況時，切換到手動模式，清潔車由操作者推動，應(yīng)對不同的工作環(huán)境。

三、控制系統(tǒng)設(shè)計

（一）UWB跟隨技術(shù)原理

該設(shè)備采用的UWB跟隨系統(tǒng)，一共三個UWB模塊，被跟隨者手持一個模塊（標簽0），另外兩個模塊需要安裝在跟蹤式吸塵器的兩側(cè)（基站1和基站2）。此UWB模塊供電使用的是5v電源，當移動模塊開關(guān)打開后，就會發(fā)射出無線信號，安裝在跟蹤式吸塵器上的兩個UWB基站接收到信號后，通過測量跟蹤式吸塵器上兩個模塊（基站1和基站2）與手持模塊（標簽0）之間的距離，根據(jù)余弦定理，可以得出標簽0相對于基站1、基站2的相對角度，并得到清潔車中點到手持模塊的距離，從而實現(xiàn)跟隨功能。系統(tǒng)最大跟隨距離為50m，并具有較強的抗干擾能力。在清潔車基站的安裝過程中，兩個UWB基站盡量遠一點，這樣測距產(chǎn)生的誤差對于角度的誤差會相對較小。

圖4 UWB跟隨技術(shù)原理圖①? 圖5 UWB跟隨技術(shù)原理圖②

如圖4所示，X為基站1到基站2的距離，Y、Z分別為基站1、基站2到標簽0的距離。程序會完成標簽0與基站1和基站2之間距離測量，三角形的三個邊確定后，則通過余弦定理即可算出G的角度。

對于跟蹤式吸塵器來說，只需要知道一個距離和產(chǎn)生的角度即可，當跟蹤式吸塵器與標簽0之間的距離大于所設(shè)定距離時，就會啟動跟蹤，當跟蹤式吸塵器與標簽0之間的距離小于設(shè)定距離時，清潔車則停止不動。如圖5所示，當位置關(guān)系滿足A情況，清潔車需要右轉(zhuǎn)，滿足B情況則直行，而C情況則左轉(zhuǎn)。

（二）控制系統(tǒng)設(shè)計

該設(shè)備控制器選用STM32F103C8T6單片機，是一款嵌入式32位的微控制器。它的工作溫度在-40℃～85℃之間，工作電壓2V～3.6V。其MCU具有高性能、實時性好、數(shù)字信號處理能力強、低功耗等特點，同時保持高集成度和開發(fā)簡易的特點。并且具有易于集成，體積小等優(yōu)勢。

（三）DWM1000模塊

定位模塊采用的是DW1000無線收發(fā)芯片，支持同步數(shù)據(jù)傳輸和精準定位，它的最遠傳輸距離可以達到450m。芯片所耗功率也是非常的低。最小誤差可以控制在10cm之內(nèi)，可實現(xiàn)定位和雙向測距，其效果顯著。該模塊由模式變換器、收發(fā)器，SPI接口，電路以及狀態(tài)控制器組成。通過控制寄存器來實現(xiàn)切換不同的工作狀態(tài)?？垢蓴_能力強，且適合復雜環(huán)境的定位應(yīng)用。所采用的是主控制芯片接口與SPI總線。最高速率可達到20MHZ。

系統(tǒng)以STM32F103C8為主設(shè)備，DWM1000模塊為從設(shè)備。SI、CS、SCLK、SO引腳為DWM1000模塊核心控制引腳。

四、動力系統(tǒng)設(shè)計

該設(shè)備的動力系統(tǒng)由行走動力和吸塵動力兩部分組成。相比較于鉛酸蓄電池，鋰電池具有能量密度高、質(zhì)量輕、環(huán)保、充電次數(shù)多的優(yōu)點?？紤]到該設(shè)備在特殊路況需要操作者推動的特點，需要選用質(zhì)量輕高能量密度的電池。該設(shè)備選用24V的磷酸鐵鋰電池，容量為102AH，最大放電電流為140A，在額定電流下可工作2小時。

兩臺行走電機分別裝于兩個驅(qū)動輪，由電機驅(qū)動器控制電機的啟動、停止、反轉(zhuǎn)和調(diào)速，從而控制設(shè)備的前進、后退和轉(zhuǎn)向。

吸塵風機的工作電壓為AC220V，功率1.1KW。由于電機啟動電流是額定電流3倍以上，選用24V，5000W的逆變器，將直流24V轉(zhuǎn)化為交流220V，為吸塵風機提供動力。

五、小結(jié)

本文設(shè)計了一種具有跟蹤功能的吸塵器，采用了基于UWB技術(shù)的定位跟蹤系統(tǒng)，該系統(tǒng)運用TDOA算法，具有精度高、成本低、工程易實現(xiàn)的特點。該設(shè)備可提高環(huán)衛(wèi)工人的作業(yè)效率，保障群眾生活環(huán)境清潔衛(wèi)生。

參考文獻

[1]張豐，李順霖，陳仁，謝印忠.基于跟蹤系統(tǒng)的智能行李箱[J].智能計算機與應(yīng)用，2019，9（3）：156—158.

[2]周馳東.磁導航自動導向小車（AGV）關(guān)鍵技術(shù)與應(yīng)用研究[D].南京航空航天大學，2012.

[3]李世光.基于STM32的超市智能跟隨購物機器人設(shè)計[C].中國自動化學會、濟南市人民政府.2017中國自動化大會（CAC2017）暨國際智能制造創(chuàng)新大會（CIMIC2017）論文集.中國自動化學會、濟南市人民政府：中國自動化學會，2017：319—323.

[4]景建斌，張云龍.基于DW1000的跟蹤購物車系統(tǒng)[J].中國科技信息，2019（07）：90—91，93.