消防滅火機器人控制系統(tǒng)的設計與研究*
*基金項目: 1.西安市科技計劃項目,2019年度高校人才服務企業(yè)項目計劃,GXYD17.12;2.火災科學國家重點實驗室開放課題(HZ2019-KF12)
本文引用地址:http://www.ex-cimer.com/article/202112/430570.htm作者簡介:李曉賢(1992—),女,漢族,助理工程師,主要從事火災探測、報警控制和智慧消防技術的研究,E-mail: 2358053655@qq.com。
摘要:針對諸如石油化工、油罐區(qū)、大型倉庫、公路隧道、高層建筑等特殊場所滅火困難的問題,設計了一款消防滅火機器人,其控制系統(tǒng)包括Android手機客戶端和基于PIC的控制器,兩者通過帶路由器的WiFi模塊通信,控制器選用PIC18F46K22單片機作為主控芯片,采用安裝在機器人的視頻攝像頭、姿態(tài)檢測的陀螺儀和紅外避障傳感器,實現(xiàn)對左右行走輪驅動電機和滅火劑噴灑方向控制電機等執(zhí)行機構的控制,行走自動糾偏采用PID控制算法,從而實現(xiàn)對消防滅火機器人的遠程控制,達到精準及時滅火的目的,對提高消防機器人的機電一體化、自動化及智能化具有重要意義。
0 引言
眾所周知,火災不僅危及財產安全,還會給人們的生命安全帶來巨大的損失,因此如何預防火災及快速有效滅火顯得極為重要。對于一些特殊場合[1],如石油化工、油罐區(qū)、大型倉庫、建筑物等在火災發(fā)生時會產生大量熱量、煙霧和有毒有害氣體,且頂部建筑結構易坍塌,造成消防裝備及人員無法靠近;呈圓筒狀結構的公路隧道、高層建筑、地鐵場所,易產生“煙囪”效應,加劇火災蔓延;大跨度鋼結構建筑的冷庫,因其隔熱防潮性能好,見光率大,出入口少且空間密閉,這些都是滅火救援的難題[2]。
針對以上危險區(qū)域,若火災發(fā)生時沒有有效的消防應急預案、合適的滅火救援設施及裝備,消防員強行進入火災現(xiàn)場采取滅火行動,不僅達不到預期效果,而且還會給救援人員的生命安全帶來嚴重威脅[3]。近年來,隨著新工藝、新材料和新技術的發(fā)展,消防滅火機器人應運而生。消防機器人能到達充滿濃煙、有毒、缺氧等復雜環(huán)境的火災現(xiàn)場,根據設定好的程序采取合理的滅火措施,最大限度地減少消防人員的傷亡,提高滅火救援的效率,降低火災事故的經濟損失[4]。
1 總體結構
消防滅火機器人為自走輪式結構[5],供電采用12V蓄電池;為了便于轉向,前輪采用萬向輪,后輪采用直流電機驅動[6];表面涂覆防高溫涂層可深入最危險的位置,如高溫、爆炸、中毒、輻射危險的“火海”中偵查火情;其前方裝有視頻攝像頭,用來識別尋找周圍環(huán)境中的火焰、煙霧;機殼內部配備滅火裝置,如冷氣溶膠滅火裝置,發(fā)生火災時,可通過噴灑口滅火;若噴灑口未正對火焰,通過噴灑方向控制電機的旋轉使噴灑口正對火焰,從而近距離準確地對準著火點執(zhí)行滅火任務,防止火勢蔓延,使滅火劑的利用率有了大幅度提高;紅外避障傳感器可以避免機器人在前進過程中撞到障礙物。此外,配備的視頻系統(tǒng)能將火場的高清圖像傳送到操作平臺。[1]
圖1消防滅火機器人總體結構
消防滅火機器人的控制系統(tǒng)包括Android 手機客戶端程序和基于PIC 單片機的控制器[7],兩者之間的通信通過高度集成、低成本的WiFi 模塊Atheros AR9331 實現(xiàn)。AR9331 采用MIPS 24Kc 內核,裝有OpenWrt 操作系統(tǒng)及相關應用軟件的路由器,集成了1 個5 端口百兆以太網交換機、1 個DDR/DDR2 控制器,單片即可實現(xiàn)完整的無線路由。該WiFi 模塊主要功能是實現(xiàn)Android手機客戶端與控制器之間的通信:將攝像頭的視頻信號發(fā)送至手機客戶端,并將手機客戶端發(fā)送的控制命令傳輸至消防滅火機器人控制器。WiFi 模塊系統(tǒng)框圖如圖2所示。
消防滅火機器人開機后自啟動,初始默認的是自動模式,可以自動搜尋火源,主動避障,精確滅火。當檢測到進入無線模式的命令時,進入無線模式,此時可以通過Android 客戶端主控界面上的觸摸按鍵發(fā)送相應控制命令至WiFi 模塊[8],通過按鍵直接控制消防滅火機器人的前進、后退、左轉、右轉等,并解碼WiFi 模塊傳輸來的視頻攝像頭的圖像信號,將其顯示在手機屏幕上。
2 硬件設計
在硬件設計方面,消防滅火機器人控制器選用Microchip 的PIC18F46K22 單片機為主控芯片[9]。該單片機屬于高性能RISC(reduced instruction set computer),精簡了指令數(shù)目和尋址方式,提高了編譯器的效率,且具有在線串行編程功能,方便開發(fā)者調試程序。該芯片有35 個I/O 引腳[10],最大工作電壓5.5 V,引腳既可以3.3 V 供電,也可以兼容5 V。它采用nano Watt XLP 的超低功耗管理,空閑、休眠和備用時鐘模式等多種功耗管理模式可以有效降低消防滅火機器人的功耗,提高蓄電池的使用時間。其具有1 024 字節(jié)數(shù)據的EEPROM、64 k 字節(jié)的ROM,最高工作速度16 MIPS,數(shù)據總線為16 位寬指令與8 位;另有2 個標準脈寬調制(PWM)模塊、3 個增強型CCP(ECCP)模塊,可輸出2 路PWM??刂破鞯恼麄€電路采用模塊化設計,由電源轉換、程序燒寫、WiFi 模塊通信、指示燈和晶振、陀螺儀姿態(tài)檢測、電池電壓檢測、行走電機驅動控制、紅外避障控制、滅火劑噴灑電磁閥控制、噴灑方向電機控制等10 部分電路組成。
電源轉換電路采用具有很好線性的降壓型開關電源管理集成電路LM2596,固定輸出直流5 V,且可輸出3 A 驅動電流,為WiFi 通信模塊和紅外避障傳感器等供電;因單片機、指示燈和陀螺儀需要3.3 V 供電,故選用正向低壓降穩(wěn)壓器AMS1117,其內部集成過熱保護和限流電路,可有效保護整個電路。程序燒寫電路可以通過PGD、PGC 等引腳將程序燒錄進單片機;D2、D3 指示燈可以通過編寫相應程序指示相應狀態(tài),外部晶振為單片機提供時鐘周期;WiFi模塊通信電路可以使控制器通過串口接收傳輸來自手機客戶端的控制指令,從而控制各執(zhí)行電機,亦可將攝像頭視頻信號傳輸給手機客戶端。
陀螺儀姿態(tài)檢測電路通過MPU6050 陀螺儀對機器人狀態(tài)進行實時檢測[11],單片機結合讀取的數(shù)據對雙側行走電機進行獨立PWM 控制,在機器人前進跑偏時進行自動糾偏;電池電壓檢測電路采用串聯(lián)電阻分壓方式對蓄電池端電壓進行檢測,當蓄電池欠壓時發(fā)出報警聲,實現(xiàn)蓄電池的欠壓保護;兩側的行走電機可通過脈寬調制(PWM)技術控制電機電樞電壓,實現(xiàn)調速[12];行走電機驅動控制電路通過雙H 橋PWM 集成電機驅動器DRV8412 控制行走電機,2 路PWM輸出獨立驅動左右輪的電機,從而完成前進、后退和轉彎運動,且集成在驅動器內部的保護電路還可監(jiān)測行走電機是否過流;紅外避障控制電路采用集收發(fā)于一體的光電傳感器E18-D80NK-N 檢測障礙物距離[13],通過電位器旋鈕可以感應3~80 cm 距離內的障礙物,從而實現(xiàn)機器人自動避障。
滅火劑噴灑電磁閥控制電路采用開關電流方式驅動電磁閥,選用N 溝道MOS 管Q1 和與電磁閥并聯(lián)的電流再循環(huán)二極管D5,當單片機RB1 引腳為高電平時,Q1 導通,此時電磁閥打開,滅火劑噴灑;利用MAX14871 全橋驅動芯片控制滅火劑噴灑口方向控制電機,發(fā)生火災時,若單片機檢測到噴灑口未正對火源,則控制噴灑口方向電機旋轉,使其正對火焰噴灑,從而精準及時滅火,提高滅火劑的使用效率。
消防滅火機器人控制器電路如圖3 所示。
圖3 消防滅火機器人控制器電路
3 PID算法參數(shù)設置調整試驗
在控制系統(tǒng)中,由于PID 控制算法結合比例、積分和微分3 個環(huán)節(jié)于一體,成為連續(xù)系統(tǒng)中最為成熟、應用最為廣泛的一種控制算法,且PID 控制方法結構簡單,各參數(shù)易于設置。因此,消防滅火機器人的行走電機糾偏算法采用PID 控制。在實際對消防滅火機器人行走電機控制的過程中,通過選用不同的P、I、D 控制組合,由主控芯片輸出給DRV8412 的PWM_A 和PWM_C 引腳不同占空比的PWM 驅動信號,實現(xiàn)消防滅火機器人行駛方向的自動糾偏。當PWM 驅動信號的占空比減小時,則行走電機兩端的平均電壓降低,電機轉速降低,該側行走輪速度減慢。PID 控制算法框圖如圖4 所示。
圖4 PID控制算法框圖
PID 控制算法的表達式為:
式中,P(t) 為輸出信號,e(t) 為偏差信號,即實際測量值與目標值間的差值,KP 為比例系數(shù),TI 為積分時間,TD 為微分時間。
將上式簡化成離散化PID 控制算法的表達式為:
在消防滅火機器人的PID 控制算法中,航向角偏差E(t) 是時間的函數(shù),消防滅火機器人的陀螺儀每300 ms檢測 1 次偏航角,即Δt = T采樣周期,E(k)為第 k 次采樣時的偏差值;E(k ?1)為第 k ?1 次采樣時的偏差值;k為采樣序號;P(k)是第 k 次采樣時的輸出值。
在消防滅火機器人行駛過程中,定義向右偏為正角度,若陀螺儀檢測到偏航角為負(機器人左偏將會左轉),則PID 控制算法會通過降低右側行走輪轉速的方法,即單片機輸出的PWM_C 和PWM_D 兩腳的占空比降低,降低驅動電機的轉速來糾正行駛方向,因此只需要知道該采樣周期內需要調整的增量信號即可,若要計算第 k 次的輸出量ΔP(k),需要知道 E(k),E(k ?1),E(k ? 2),所以可以采用以下增量型 PID 控制算法:
式中,為積分系數(shù);為微分系數(shù)。
對于不同系統(tǒng)中的PID 控制算法,只需人工調整KP、KI 和KD。為了找到這3 個參數(shù)的最佳值,需要通過試驗進行統(tǒng)計分析。試驗采用長為10 m 的筆直柏油路(中間不設置障礙),等分為10個檢測區(qū)間,測量出每個區(qū)間中車輪痕跡與目標軌跡線之間存在的最大偏移距離,實驗數(shù)據采集示意圖如圖5 所示。
圖5 行駛試驗數(shù)據采集示意圖
根據PID 控制參數(shù)調整原則:
先調整比例系數(shù),當曲線振蕩非常頻繁時,加大KP,超調大則減小KP;積分項可以消除系統(tǒng)中周期性的波動,及時糾偏,系統(tǒng)糾正周期長減小KI。由于該系統(tǒng)中左右行走輪采用的直流電機慣性和滯后性較小,速度改變迅速,因此微分系數(shù)KD 的改變對直線行駛糾偏性能的影響不是很大。經過試驗場地多次運行調試,得到當給定參數(shù)KP = 8 、KI = 5 、KD =1 時,消防滅火機器人直線行駛性能最佳。
采用最優(yōu)參數(shù)KP = 8 、KI = 5 、KD =1 時,消防滅火機器人行走3 次,即每個行走區(qū)間測取3 次試驗數(shù)據,并求出每個測試區(qū)間的最大偏移距離的平均值,以減小隨機誤差帶來的干擾,將統(tǒng)計出的最大偏移距離作為試驗的結果。試驗數(shù)據如表1 所示。
表1 消防滅火機器人直線行走糾偏試驗數(shù)據
由表1 中的試驗數(shù)據可知,在全程10 m 的試驗中,每1 m 的測試區(qū)間中最大偏移距離的平均值在8.3~12.5 cm 之間,偏移率使用最大偏移距離的平均值除以測試區(qū)間長度1 m,在8.33%~12.53% 之間,30組數(shù)據中最大偏移距離為14.4 cm,最小為6.2 cm,可以滿足消防機器人直線行走的需求,因此PID 控制設置參數(shù)合理。
4 結論和討論
消防滅火機器人基于PIC18F46K22 單片機的控制器可以接收Android 手機客戶端的命令,通過PID 算法進行自動糾偏,通過帶路由器的WiFi 模塊將攝像頭拍攝到的滅火現(xiàn)場視頻傳輸在手機屏幕和消防控制臺顯示,機器人行走過程中可以主動避障,且可實現(xiàn)噴灑口對準著火點后自動滅火劑噴灑,在實現(xiàn)精準及時滅火的同時提高滅火劑的使用效率。
消防機器人可以代替人類進行高危滅火作業(yè),隨著機器人智能控制技術、計算機技術的極大進步,相信實現(xiàn)自主決策、自主行動、自我防護的高級智能化消防機器人的誕生指日可待,其未來將朝著以下幾個方向發(fā)展:自主智能化;功能多元化,集合偵察、破拆、堵漏、搬運、滅火、冷卻等功能;高效節(jié)能化和空間立體化。
參考文獻:
[1] 張建中,郝允梁,劉海洋,等.基于STM32單片機的智能消防機器人的設計與應用[J].電子技術應用,2017,43(11):120-123.
[2] 張晉.消防機器人結構設計及其控制系統(tǒng)研究[D].天津:河北工業(yè)大學,2015.
[3] 張偉,阮鵬程,徐岳,等.變電站消防機器人系統(tǒng)設計[J].消防科學與技術,2020,39(9):1301-1303.
[4] 林凡強,張陽,楊文旭,等.基于紅外火焰?zhèn)鞲衅骱妥钚《朔ǖ臏缁饳C器人[J].傳感器與微系統(tǒng),2015,34(1):110-112,123.
[5] 徐連偉,魏崇毓.消防機器人行走控制系統(tǒng)的設計與實現(xiàn)[J].計算機測量與控制,2017,25(1):66-69.
[6] 陳曉鵬,李成榮,李功燕,等.基于動力學模型的輪式移動機器人電機控制[J].機器人,2008,30(4):326-332.
[7] 林向南.基于Android智能手機的輪椅控制系統(tǒng)設計[D].武漢:華中科技大學,2014.
[8] 張文亮.基于Wi-Fi的輪機模擬器測試系統(tǒng)設計和實現(xiàn)[D].大連:大連海事大學,2016.
[9] PIC18F46K22 datasheet [Z].Microchip Technology Inc.,2007.
[10] 劉和平,劉林,余紅欣,等.PIC18Fxxx單片機原理及接口程序設計[M].北京:北京航空航天大學出版社,2004.
[11] 高仲鍇,劉盛鵬.消防機器人三維姿態(tài)監(jiān)測系統(tǒng)的設計與實現(xiàn)[J].消防科學與技術,2014(7):795-797,827.
[12] 李曉賢.磁力輪式塑料溫室棚頂清洗機的設計與研究[D].重慶:西南大學,2019.
[13] 蔣林,金祖飛,程文凱,等.一種分層模糊控制的滅火機器人火源尋蹤[J].機械設計與制造,2017(9):49-53.
(本文來源于《電子產品世界》雜志2021年12月期)
評論