基于超聲波避障的倉庫安防機器人設計
來源:用戶上傳
作者:周大明
摘 要:倉庫巡檢的傳統手段是結合攝像頭與人員巡邏,在這種應用背景情況下,本文設計了基于超聲波避障的倉庫安防機器人,通過超聲波模塊進行避障,利用各種環境傳感器采集倉庫內的溫度、濕度、光照、煙霧、可燃氣體等信息以監測倉庫內是否發生火情、是否發現可疑人員等事故,通過無線傳輸模塊將相關數據發送到上位機和手機APP上,實現巡檢與遠程監測相結合,實現倉庫內的智能化巡檢功能。該系統可一定程度上提升倉庫內的監測效率、節省人力資源,提升倉庫智能化監測水平。
關鍵詞:STM32F103單片機;超聲波避障;手機APP;LabVIEW上位機
0 引言
安防機器人作為現在最熱門的服務型移動機器人之一,具有智能化巡邏、高效靈活的特點[1],可以代替保安進行智能巡邏、移動監控作用,而且也節省了小區內多處安裝攝像頭的成本[2]。輪式安防機器人能實現原地轉彎,非常適合小區內小道路上的行走[3]。安防機器人可作為移動監控攝像頭代替保安巡邏工作,在高檔小區、醫院、學校等場合都適合使用[4]。安防機器人具有智能巡邏、移動監控等功能,因此對它的運動控制、視覺導航、路徑規劃等方面的研究具有非常重要的學術意義[5]。
本文基于相關研究現狀,設計了一種基于超聲波避障的倉庫安防機器人移動監測系統,該系統可實現在既定的室內環境下進行全天24 h不間斷的巡邏,通過超聲波模塊進行避障,并且在巡邏的同時利用車載的各種環境傳感器采集倉庫內的溫度、濕度、光照、煙霧可燃氣體等信息以及監測倉庫內是否發生火情、是否發現可疑人員以及監視機器人的運動狀態,然后通過2.4 G無線通信傳輸給遠程電腦端的倉庫監測系統進行相應監測信息的顯示與意外事件提醒,此外管理人員還可以在手機端的倉庫監測APP上用藍牙連接巡邏機器人,在倉庫監測APP中可以接收并顯示各種倉庫內的環境信息數據以及機器人的運行狀態,并且還可以向機器人下達停止運動或啟動運動的指令。
1 總體方案設計
本文設計一種應用環境背景為倉庫、車間等室內場場所,可自動循跡導航運動的移動機器人監測平臺,機器人在循跡導航過程中可以實現對室內環境信息(溫度、濕度、光照值、易燃氣體)的采集并通過無線通信上報給監測端,同時監測是否發現火情、是否發現可疑人員、機器人是否運動正常;管理員一方面可在PC端即電腦端的倉庫監測系統顯示界面中查看相關的環境信息及機器人運動狀態,也可以在手機端的倉庫監測APP界面中查看相關信息,并且在手機端可以實現對機器人運動的控制(停止運動、啟動運動)。
機器人系統總體設計包括三大部分:機器人運動、信息采集、上下位機通信及顯示。機器人運動部分負責控制機器人的運動,包含電機CAN總線通信、PID閉環控制、循跡運動;信息采集部分負責采集機器人周圍的環境信息數據,包含火焰傳感器、人體紅外傳感器等相關信息采集傳感器;上下位機通信及顯示部分負責對環境信息的發送與接收并對數據信息進行解析顯示,包含2.4 G無線通信、藍牙通信、電腦端的LabVIEW顯示、手機APP端顯示。系統的總體設計框架如圖1所示。
2 系統硬件設計
2.1 STM32最小系統模塊
主控器件是系統中最為關鍵的模塊,需要較小的體積、較低的功耗和較強的性能。綜合考慮本次設計基于超聲波避障的倉庫安防機器人選用STM32F103RCT6處理器,其主要功能是將傳感器測得的數據進行處理、分析,并將相關參數數據打包通過串口無線透傳通信發送給上位機。
2.2 循跡導航模塊
本文運用的AGV機器人大多采用磁導航模式,通過車身前端的AGV磁導航傳感器,使機器人沿著鋪設在路面上的磁條導線進行循跡運動,磁導航傳感器如圖2所示。
2.3 超聲波避障模塊
本次設計選用的是HC-SR04超聲波測距傳感器,用于實現機器人在巡邏過程中的避障功能。目前市場上的超聲波測距傳感器模塊品種繁多,其中HC-SR04超聲波模塊所測量的范圍比較寬,測量時準確率也比較高,是一種屬于不同接觸式的測量傳感器。超聲波的穿透能力強,具溆帕嫉拇┩改芰Γ被廣泛應用在測距技術領域。超聲波測距傳感器由超聲波發射器、超聲波接收器以及控制電路組成,該模塊的實際有效測距距離為(2~400)cm,測距精度可達3 mm,測量角度為15°,滿足現實使用需求。
2.4 環境傳感器
機器人在進行循跡巡邏的過程中,通過搭載的火焰傳感器、人體紅外傳感器、MQ-2煙霧可燃氣體傳感器、DHT11溫濕度傳感器以及GY-30光照傳感器來采集倉庫內的溫度、濕度以及光照值信息,同時監測是否發生了火情、是否發現有可疑人員存在、倉庫內是否存在可燃氣體超標情況。這些信息通過無線傳輸,上傳到上位機監測平臺,供管理員使用,以及為其預警。環境信息采集如圖4所示。
3 軟件設計
3.1 底層運動系統軟件設計
底層運動系統的軟件設計如圖5所示,控制核心是STM32單片機,其上連接激光雷達用于避障運動,連接7個循跡模塊用于循跡運動,連接CAN模塊用于控制電調,進而控制電機運動。進入程序后先進行各個子程序的初始化,然后進行循跡信息及避障信息的采集,信息采集完成后進行數據處理,控制電機相應轉動,達到循跡避障的目的,同時將電機的運轉狀態發送給發送端單片機,發送端單片機進而通過無線通信將運動狀態上傳給電腦端和手機端;STM32單片機同時通過I/O口檢測發送單片機是否發送來對機器人運動的控制指令,若收到控制指令,則執行對應的停止或開始命令,若為收到控制指令,則返回執行循跡避障程序。
3.2 PC端上位機設計
巡邏機器人通過車載的2.4 G通訊模塊NRF24L01與遠程的另一塊單片機通信,而接收到相關信息的此單片機再通過串口與電腦端即PC端進行數據上報,PC端通過串口通訊接收到數據后,通過LabVIEW軟件進行數據的顯示以及相應的警示功能。下位機與PC端上位機設計如圖6所示。
設計的LabVIEW程序框圖如圖7所示,系統分為初始化、等待、接收數據、數據處理、退出五大模塊,通過不同的條件標志來切換不同模塊。程序開始時先進性初始化(默認值的設置、顯示控件的清除、指示燈的關閉等);然后進入等待模式,等待接收數據(串口開關觸發)或閾值設置;觸發事件后進入到數據處理模塊,進行解析數據以及數據的顯示或設置閾值,事件處理完后返回到等待模塊;當觸發停止標志(停止開關)時進入到退出模塊,在此模塊中關閉所有指示燈、清除顯示,退出While循環,結束程序。
當程序運行開始運行時,首先進行初始化操作,即配置一些默認的參數(如閾值、波特率等);然后打開串口資源接收數據,數據包為22位1包,當接收到數據包后進行數據的解析,將6個環境信息以及機器人的運動狀態信息拆解出來;而后對各個傳感器的數據進行數值顯示、波形圖顯示及機器人運動狀態的顯示;同時還可以對溫濕度進行閾值的設置,當溫濕度超過閾值時進行燈光的警示。設計好的PC端界面如圖8所示。
3.3 手機端APP設計
組件設計包含8個靜態顯示標簽(“歡迎使用”、“火焰監測”、“人員監測”、“煙霧監測”、“濕度(%)”、“溫度(℃)”、“光照(lx)”、“運動狀態”),8個動態顯示標簽(藍牙連接狀態、火情顯示、人員顯示、煙霧值、濕度值、溫度值、光照值、機器人運行狀態),3個按鍵(斷開連接、停止、啟動),1個列表選擇框(藍牙選擇),組件設計如圖9所示。
4 系統測試
本系統可基本實現機器人基于AGV的導航運動、基于超聲波模塊的避障,各種環境信息的采集、數據的無線通信傳輸、PC端LabVIEW監測頁面的信息顯示以及下位機與手機端上位機的藍牙通信、手機端APP的數據信息。
最終完成后的機器人如圖10、圖11為C器人所示,圖12為正在循跡中的機器人,圖13為電腦端與手機端的監測實況圖。
在實際測試中,PC端上位機可以穩定接收數據并進行顯示、提示等功能,如圖14所示為PC端上位機的運行效果。
將APP安裝包下載到手機上并進行安裝,藍牙設備連接成功后接收并顯示從下位機發送的傳感器數據。火焰傳感器探測到火源后進行紅色文字警示“發現火情”,人體紅外傳感器發現倉庫有人時進行紅色文字警示“發現可疑人員”,機器人運行監測模塊在機器人運行停止時進行紅色文字提示“運動已停止”。并且在手機端上用戶可向下位機發送停止或啟動的運動指令。
5 結束語
本文對基于超聲波避障的倉庫安防機器人的設計和實現進行了相關的研究和分析。進行了基于超聲波避障的倉庫安防機器人的總體方案設計。將系統硬件部分分解成多個硬件模塊組合,有STM32F103RCT6最小系統、AGV導航模塊、超聲波避障模塊、環境檢測模塊、無線傳輸模塊。完成硬件搭建后,設計了電腦端的上位機和手機APP,經過系統測試驗證了該安防機器人監測系統的有效性以及終端數據的成功傳輸。實現了倉庫內的智能化巡檢,提升了倉庫智能化監測水平。
參考文獻:
[1] 吳緒輝,黎鏡林,郭銳坤,等.電機PID閉環系統在智能小車上的應用[J].物理通報,2019(11):123-125.
[2] 祝相泉,黃海龍,田昊.無刷直流電機模糊PID控制[J].遼寧工業大學學報(自然科學版),2020,40(1):22-24.
[3] 劉長文.倉庫安防巡檢機器人關鍵技術研究[D].沈陽:沈陽大學, 2018.
[4] 王威,陳巍,路琴心.基于GPS+激光雷達的變電站巡檢車混合導航研究[J].自動化應用,2019(4):95-99.
[5]唐飛龍,張娜,黎安慶.基于STM32控制系統的輪式移動機器人設計與實現[J].2020,16(25):47-49.
轉載注明來源:http://www.hailuomaifang.com/8/view-15446092.htm