基金項目：湖北省教育廳科學(xué)技術(shù)研究計劃項目（指導(dǎo)性項目）“基于多傳感器融合技術(shù)的室內(nèi)移動機(jī)器人SLAM算法應(yīng)用研究”（B2018322）。

作者簡介：張勝男（1980-），女，工程師，講師，主要從事自動控制系統(tǒng)研究。

摘 要：隨著人們對家居環(huán)境要求的不斷提高，清潔時間卻不斷減少，自動清潔機(jī)器人的需求尤為廣泛。本文中清潔機(jī)器人通過多傳感器融合的SLAM技術(shù)先對周圍環(huán)境進(jìn)行辨識的同時進(jìn)行地圖構(gòu)建，自動規(guī)劃大概的路徑;后續(xù)在已規(guī)劃的路徑中可自動避障行走，且在工作過程中可自動檢測電量，若電量低于臨界值則終端尋找預(yù)設(shè)好目標(biāo)位置的充電樁進(jìn)行對接充電，電量充滿后繼續(xù)運(yùn)行被中斷的程序。

關(guān)鍵詞：室內(nèi)清潔機(jī)器人;多傳感器融合;SLAM

中圖分類號：TB 文獻(xiàn)標(biāo)識碼：A doi：10.19311/j.cnki.1672-3198.2022.12.089

0 引言

智能機(jī)器人擁有多種傳感器來感知周圍環(huán)境，還需要進(jìn)行環(huán)境建模與目標(biāo)識別、任務(wù)規(guī)劃、運(yùn)動控制等復(fù)雜的功能。因此，高度智能化機(jī)器人需要多模塊相互協(xié)作來完成任務(wù)。

1 機(jī)器人任務(wù)規(guī)劃

室內(nèi)清潔機(jī)器人的任務(wù)主要有三個：路徑規(guī)劃、自動避障和自動充電。其中，路徑規(guī)劃和自動避障都屬于運(yùn)動導(dǎo)航。

路徑規(guī)劃是根據(jù)清掃區(qū)域合理規(guī)劃運(yùn)行路線。完成此任務(wù)必須先通過傳感器獲取周圍環(huán)境信息，分析處理后獲得一個能順利通過并且能全區(qū)域覆蓋運(yùn)行的路線;此外還需要在完成清掃任務(wù)后能夠自動回到起始點(diǎn)或充電樁，或者在任務(wù)過程中因電量低規(guī)劃對接充電樁的路徑，并且在充電完成后駛回中斷位置。自動避障是實(shí)現(xiàn)路徑規(guī)劃、按路徑完成清潔作業(yè)，以及處理作業(yè)過程中一切突發(fā)狀況確保作業(yè)順利的最核心的功能。該功能依賴外設(shè)傳感器獲取環(huán)境信息，系統(tǒng)進(jìn)行處理后修改當(dāng)前路徑方向以達(dá)到避開障礙物的功能。

自動充電功能是清掃機(jī)器人智能化的一個基本體現(xiàn)，是電源技術(shù)、信號對接技術(shù)等功能的結(jié)合運(yùn)用。機(jī)器人作業(yè)過程中，當(dāng)電量低于臨界值時能夠自主尋找充電樁進(jìn)行充電。

2 運(yùn)動導(dǎo)航

室內(nèi)自動清掃機(jī)器人通過傳感器信息來分析環(huán)境特征，確定路標(biāo)，作為運(yùn)動的參照進(jìn)行定位，與此同時完成地圖構(gòu)建;地圖構(gòu)建就是確定路標(biāo)或環(huán)境特征的絕對位置。定位與地圖構(gòu)建互為條件，同步進(jìn)行。SLAM歸納起來就是一個“感知一估計一校正”的過程，主要包括三個迭代步驟：（1）機(jī)器人根據(jù)當(dāng)前的位、姿估計與地圖信息對下一步的位、姿和路標(biāo)（特征）位置進(jìn)行預(yù)測。（2）在下一步中通過傳感器觀測環(huán)境中的路標(biāo)（特征）。（3）利用觀測信息校正上一步預(yù)測的定位與地圖構(gòu)建結(jié)果。

上述步驟循環(huán)迭代進(jìn)行，過程中機(jī)器人完成對自身位、姿和路標(biāo)（特征）位置的準(zhǔn)確估計，并以增量的方式完成地圖創(chuàng)建?，F(xiàn)有的SLAM研究方法包括四類，分別是基于擴(kuò)展的卡爾曼濾波器的（EKFF）方法、基于粒子濾波器（Particle Filter-PF）的方法、期望最大化方法（Expectation Maximization.EM）和增量方法。本項目采用基于PF的GMAPPING算法進(jìn)行優(yōu)化。

在機(jī)器人作業(yè)過程中，只采用單一傳感器無法確保信息的準(zhǔn)確性和可靠性，需要采用多個傳感器實(shí)現(xiàn)機(jī)器人與環(huán)境信息的盡可能充分匹配，便于機(jī)器人做出正確的決策。算法上采用多傳感器信息融合技術(shù)將分布在不同位置、不同種類的傳感器所提供的局部環(huán)境的不完整信息加以分析，利用冗余性和互補(bǔ)性將數(shù)據(jù)合成，實(shí)現(xiàn)多傳感器數(shù)據(jù)關(guān)聯(lián)，消除多傳感器之間可能存在的冗余和矛盾，降低定位和地圖構(gòu)建的不確定性，獲得機(jī)器人在工作空間中的位置、方向和環(huán)境信息，從而提高建立環(huán)境模型的魯棒性，以及系統(tǒng)的可靠性。

在通常的SLAM算法中，觀測量要與系統(tǒng)狀態(tài)變量匹配，以確定不斷更新的目標(biāo)。成功的數(shù)據(jù)關(guān)聯(lián)涉及正確的觀測與相應(yīng)的狀態(tài)變量匹配，探測和排除虛假觀測以及初始化新的軌跡。項目采用基于更新序列和預(yù)測協(xié)方差矩陣的并行集中式多傳感器數(shù)據(jù)關(guān)聯(lián)結(jié)構(gòu)實(shí)現(xiàn)。

項目應(yīng)用IMU初始化系統(tǒng)的位姿，采用EKF對非線性系統(tǒng)的動態(tài)模型進(jìn)行線性濾波;并結(jié)合對激光雷達(dá)掃描點(diǎn)區(qū)域的合理劃分進(jìn)行構(gòu)圖，可以很好地解決地標(biāo)的深度特征和回環(huán)檢測的問題，有效提高地圖構(gòu)建質(zhì)量和速度。

激光雷達(dá)采用HC-SR04系列，3cm到90cm的測量范圍基本上可以滿足在室內(nèi)機(jī)器人的需求。遠(yuǎn)距離誤差較大（1cm-2cm），近距離誤差較小，而且可以根據(jù)不同的模塊不同的需求在一定范圍內(nèi)作一定的修正。HC-SR04主要參數(shù)：工作電壓：+5V;靜態(tài)電流：<2mA;感應(yīng)角度：<15°;探測距離：2cm-450cm;分辨率：0.3cm。超聲波模塊在本設(shè)計中作為避障和路徑規(guī)劃的主要傳感器模塊，工作環(huán)境在室內(nèi)，對遠(yuǎn)距離沒有太大要求。

3 自動充電

電源模塊由充電樁和車載電池組構(gòu)成，基于系統(tǒng)的簡潔性選用接觸式充電。充電樁電源電路先將220V交流電整流成12V直流電，通過線性穩(wěn)壓和濾波過后，由開關(guān)電源芯片進(jìn)行降壓，從而可以恒壓恒流為車載電池組充電。車載電池組由電池組、降壓電路和電量監(jiān)測電路組成。電池組選用3節(jié)18650鋰電池串聯(lián)，其配套保護(hù)板可以在過欠等狀況下很好地保護(hù)電池。

模塊中經(jīng)LM7812穩(wěn)壓過后的+12V電源提供給步進(jìn)電機(jī)工作用電，LM7805穩(wěn)壓得到+5V電源提供給單片機(jī)、OLED、超聲波等模塊的工作電源。

充電樁模塊主要實(shí)現(xiàn)一個DC220V的市電轉(zhuǎn)換為可以提供車載電池充電的恒壓恒流電源。電路中使用為安規(guī)電容。安規(guī)電容的特點(diǎn)是在斷電以后，電荷不會保留一段時間再消失。所以系統(tǒng)斷電時不會對接觸的人造成電擊，保證室內(nèi)使用者和維修人員的安全。采用全橋整流器和線性穩(wěn)壓芯片LM7815保持輸出電壓恒定為15V，防止輸入電壓、負(fù)載、環(huán)境溫度、電路參數(shù)等發(fā)生變化時，不會對DC-DC電源芯片造成沖擊導(dǎo)致其損壞。15V的直流電壓通過DC-DC電路給3節(jié)18650鋰電池（+12V）充電提供恒流恒壓電源。

這是一個基于MC34063電源芯片的經(jīng)典運(yùn)用電路，應(yīng)用比較廣泛極性反轉(zhuǎn)效率最高65%，升壓效率最高90%，降壓效率最高80%，變換效率和工作頻率濾波電容等成正比。其中R1為限流電阻，決定輸出點(diǎn)電流。U2為電源芯片。C4為定時電容，決定內(nèi)部工作頻率。D2為快速開關(guān)二極管。D3作為輸出電壓指示燈指示工作狀態(tài)。主要外圍元件標(biāo)稱含義和它們?nèi)≈档挠嬎愎饺缦拢?/p>

Vout（輸出電壓）=1.25V（1+R4/R2）

C4=0.000004*工作頻率

R1=0.33/IPK

此外，在充電樁中本文設(shè)計了一個紅外調(diào)制模塊，其中使用了STC15F104W單片機(jī)，需要提供+5V的電壓。采用LM7805穩(wěn)壓芯片，使單片機(jī)能獲得一個穩(wěn)定的工作電壓。

4 電量檢測

為了滿足系統(tǒng)的供電要求，選用了3節(jié)18650鋰電池作為電源。本模塊電路為AD采樣電路，目的為了檢測電池電量。單節(jié)18650的充電截至電壓為4.2V，放電終止電壓為2.75V。因此，本模塊充電截至電壓設(shè)置為12.6V以及放電中止電壓為8.25V。內(nèi)部算法處理電壓與電池電量關(guān)系后將電量百分比顯示在屏幕上。在獲取到機(jī)器自身或外界信息時，通過對主單片機(jī)的編程利用單片機(jī)的中斷功能，來執(zhí)行尋找充電樁或自動路徑規(guī)劃的運(yùn)行軌跡。因此，本設(shè)計中有兩個重要的中斷。

電量低中斷流程圖如圖4。在該中斷程序中觸發(fā)條件為AD功能采集的電壓信號低于臨界值。在主程序中一直有監(jiān)測電量，當(dāng)電量低于預(yù)設(shè)臨界值時，程序跳出原執(zhí)行程序，即清掃路徑規(guī)劃程序，然后紅外接收模塊開始工作，與此同時車身開始原地旋轉(zhuǎn)，當(dāng)接收模塊接收到可靠的來自充電樁紅外信號時，停止旋轉(zhuǎn)，直行駛向充電樁。充電完成后，重新回到清掃路徑規(guī)劃的程序中運(yùn)行。

5 實(shí)驗(yàn)與分析

項目實(shí)驗(yàn)依托HUSKY的輪式移動小車，在開源ROS平臺進(jìn)行多傳感器融合SLAM算法測試并改進(jìn)，實(shí)現(xiàn)了提高移動機(jī)器人SLAM算法的實(shí)時性和魯棒性。并結(jié)合自動充電技術(shù)，完成自動清掃機(jī)器人的作業(yè)模擬，驗(yàn)證了設(shè)計的合理性。

參考文獻(xiàn)

[1]袁茂鴻，王姝，林心如，等.基于超聲波傳感器的掃地機(jī)器人避障技術(shù)研究[J].南方農(nóng)機(jī)，2021，52（10）：100-101.

[2]徐勝華.基于STM32的智能掃地機(jī)器人研究與設(shè)計[D].南寧：廣西師范大學(xué)，2016.

[3]汪洋.掃地機(jī)器人定位算法設(shè)計與嵌入式系統(tǒng)實(shí)現(xiàn)[D].合肥：中國科學(xué)技術(shù)大學(xué)，2016.