渦輪排煙消防機器人避障系統設計

2020-05-08 09:37:04李龍宋崇智張長平伍德林姚小軍

機械工程師 2020年4期

李龍，宋崇智，張長平, 伍德林, 姚小軍

（1.安徽工業大學工程研究院，安徽馬鞍山243032；2.馬鞍山經緯回轉支承有限公司，安徽馬鞍山243032）

0 引言

消防機器人由原來單一功能滅火機器人到如今的具有感知功能的機器人，在技術上取得了卓越的進步[1-2]，其中包括仿生技術、控制技術、傳感技術、機電液一體化技術等機器人特定領域技術。消防機器人的避障問題正成為控制技術領域研究熱點，目前已經取得顯著的成果。Saygin等[3-4]設計制造了一種配備早期的火災探測單元機器人平臺，通過對運動單元路徑的規劃及虛擬環境進行跟蹤，實現機器人簡單避障。Li等[5]采用多傳感器優化設計的方法，對消防機器人的避障系統進行設計。機器人采用光電傳感器進行避障，并將粒子優化算法應用于避障系統軟件設計中，提高消防機器人的靈敏度。王軍華等[6]根據消防機器人在工作時對于障礙物的如何快速檢測問題，提出了一種基于隨機采樣的雙目障礙檢測算法，通過兩個處于同一基準線上的兩個攝像頭，提取火場環境的平面模型，采用預檢驗法和內點閾值限定法采樣估計，能快速、準確地檢驗障礙，實現機器人對障礙的規避。上述采取的避障方案優點是能夠在短時間內規劃出機器人最佳避障路徑，可以解決特殊火災現場機器人的避障問題。缺點是隨著環境量的變化，需要不斷地計算規劃路徑，難以適應復雜的實際火場環境。實際的火場是處于動態的未知環境，目前應用于未知環境的避障算法主要有神經網絡算法、仿生算法、遺傳算法等[7]。上述算法優點是能夠很好解決機器人在未知動態環境下的避障問題，缺點是所需要考慮的參數較多，計算量過大，占據較大的運算時間和儲存空間，而且對環境的要求苛刻，造成消防機器人的實時性很差。

本文采用超聲波傳感器疊加方案對消防機器人在環境中的障礙信息進行采集，然后直接反饋給車載中心，經過信息比對后控制機器人的運動方式的避障方案。有效避免控制器對路徑進行重復規劃，減小控制器的計算量，在實現準確避障要求的同時，提高消防機器人避障系統實時性和實用性。消防機器人避障系統主要由控制器模塊、電源模塊、超聲波模塊、行走模塊及報警模塊5個主要模塊組成，控制模型如圖1所示。

圖1 避障控制模型

主要的工作流程為：消防機器人在復雜的滅火環境中觸發局部自治功能時，此時超聲波傳感器開始啟動，向機器人的周圍發射超聲波，并將所探測的超聲波信號傳送給PLC可編輯控制器，控制器根據傳送過來的信號，規劃消防機器人運動方式，對障礙進行有效規避。

1 消防機器人運動和避障分析

1.1 運動分析

消防機器人采用履帶底盤結構，由兩個液壓馬達進行驅動，為履帶的轉動提供牽引力。消防機器人的運動模型如圖2所示。

假設機器人處于理想的運動狀態，機器人的中心點為O點，經過一段時間后，機器人的運動偏轉角度為θ，左履帶的速度為vL，右履帶的速度為vR，r為中心的曲率半徑，b為消防機器人的寬度，此時左履帶的曲率半徑為r-b/2；右履帶的曲率半徑為r+b/2，設履帶的角速度為ω，因此機器人的左右履帶的速度表達式為：

圖2 機器人運動模型

式中，ω為機器人履帶的角速度。

由式(1)、式(2)可得機器人的履帶角速度為

由式(3)可得機器人中心的速度為

中心速度又為

根據式(4)、式(5)可得r為

由式(6)可知，當機器人的左右履帶的速度相同時，r為無窮大，此時機器人作直線運動，當左右履帶速度都為正值時，機器人前進；反之，后退。當兩履帶的速度相等而方向不同時，機器人此時原地旋轉，當兩履帶的速度大小不等時，機器人繞中心點作曲線運動，實現左轉、右轉、左退、右退。當機器人在運動時，設機器人的運動時間非常小，此時機器人的線速度和角速度則為常數，具體為：

由式(7）～式（9)可知，機器人的瞬時速度與車體的方向相同，根據左右履帶的速度差就可以改變機器人的運動狀態，通過合理規劃左右履帶的速度就可以使機器人行走不同曲率的曲線。

1.2 避障分析

當機器人的傳感器探測到前方有障礙物時，其控制器會首先判斷其是否在安全距離以內，從而選擇是否進行避障。若此時的距離在安全距離之外，機器人會保持原有的指令工作。若此時的距離在安全距離之內，此時機器人就會減慢速度，通過主控制器規劃前進的方向，對障礙物進行避障。設機器人的運動速度為v，安全距離為d，當障礙物的距離小于d時，機器人會向左轉向，從而對障礙物進行避障，如圖3所示。由圖可知，避障安全的距離與消防機器人運動軌跡的半徑是相等的。

一般情況下，消防機器人對周圍障礙物的檢測來源于消防機器人周圍的超聲波傳感器傳送回來的電信號。實際工作環境中的障礙物的出現情況多種多樣，一般情況可分為8種[8]，如圖4所示。

圖3 前方避障示意圖

圖4 遇障情況示意圖

當消防機器人的正對的兩側有障礙物時，不會影響消防機器人的正常前進。當消防機器人與障礙物之間的夾角越小時，發生碰撞的概率就會越大。所以只需要考慮消防機器人的正前方及兩側前方之間的組合的幾種情況。將所采集的d1、d2、d3、d4、d5、d6等6個超聲波數據與所測得的dr1、dr2、dr3等3個數據分別組成3個數組，代表機器人3個方向的障礙物的信息，用dL、dF、dR表示，其中dL=(d1，dr1，d2)，dF=(d3，dr2，d4)，dR=(d5，dr3，d6)。

當消防機器人的正前方無障礙、兩側有障礙物時，此時消防機器人會執行原有的動作指令。如圖4（a）、圖4（f）所示。

2 硬件和軟件設計

2.1 硬件設計

控制模塊選用C201可編輯控制器作為避障系統的控制中心，也是整個消防機器人電控系統的核心。相對于其他控制方式，PLC控制器抗干擾能力強，故障率低，便于維護，其開發的周期相對較短，在特種機器人控制方面的硬、軟件設備與實際應用的匹配最好。而且編輯控制器上有大量的開關量和模擬量輸入端口及開關輸出端口。在CAN的通訊系統下與其他的傳感器和執行器等元件的配合下，可作為多功能的控制器使用。

測距模塊選用超聲波測距。超聲波是一種機械波，它的振動頻率在20 kHz以上，具有很強的穿透性及很好的方位特性，在傳輸信號的過程中有很好的信號反射能力和抗衰減能力。所以其是應用在測距、定位避障等工程方面首選傳感器。超聲波傳感器主要由超聲波發射器、接收器和信號處理裝置3個部分構成。其測距原理為：發射器不斷地發射一定功率的超聲波信號，當其傳播遇到障礙物時就會被反射，此時接收器可以接收到被反射的信號。通過時間間隔Δt 與在空氣中傳播的速度，就可以判斷與障礙的距離D，公式如下：

式中：D為障礙物與機器人之間的距離；Δt 為時間間隔；T為機器人工作環境中的溫度。其測距原理如圖5所示。

超聲波傳感器與紅外傳感器及激光傳感器相比，具有結構簡單、價格低、耐臟耐塵等特點。而且其穿透的能力比較強，能夠在黑夜及其它惡劣的環境中使用。但是超聲波測距存在一定的盲區，會對障礙的檢測造成一定的偏差，通常是與其它傳感器相互配合使用提高對障礙檢測的精確度。紅外傳感器和激光傳感器對于使用環境要求較高，價格昂貴，而且難以適應復雜火場環境。為減少不必要的視覺盲區，本文采用疊加超聲波傳感器設計方案，通過多個超聲波傳感器提高機器人對于障礙物的檢測。此外，該方案在軟件的處理方面也更容易，只需要重復疊加超聲波傳感器的程序，避免了對一些較多子程序進行來回的掃描，減少控制中心的計算時間，有效提高消防機器人的實時性。本文采取了8個超聲波傳感器提高消防機器人對障礙檢測性能。其硬件接線圖如圖6所示。

圖5 測距原理圖

圖6 避障系統電路原理圖

本文選用的是US200-18A高頻型收發一體的鋁殼超聲波傳感器。該傳感器的測量精度和靈敏度比較高，具有一定的光線、火災煙霧及電磁抗干擾能力，而且連接電路比較簡單，便于更換，符合機器人工作的復雜環境要求。超聲波的具體參數如表1所示。

表1 超聲傳感器技術參數

2.2 軟件設計

避障主程序如圖7 所示。首先引用宏文件，然后在對定義的子程序進行初始化，對消防機器人的驅動系統進行啟動，再對超聲波傳感器發送一個持續8 μs的高電平啟動信號，使其開始對周圍的障礙進行檢測。

如果左側控制器給出的是一個高電平，則表明左側無障礙，即向左轉向，反之則右轉。在機器人轉向的過程之中，控制器會對超聲波傳感器發出控制指令，使其每150 μs檢測周圍障礙的距離，在運動方向的距離大于安全距離時，機器人的車身擺正，繼續執行工作任務。如果左側控制器給出的是一個低電平，此時機器人則再判斷右側是否存在障礙，無則右轉。程序如圖8所示。

圖7 避障主程序圖

圖8 超聲波測控程序

當測得前方與障礙的距離在300～500 mm時，機器人保持原有的狀態行駛。當距離小于300 mm時，此時消防機器人就會減速慢行；當小于100 mm時，機器人后退減速；控制器根據傳輸回來的信號控制液壓馬達的轉速和轉向，確定是向哪一側轉向。測距程序圖如圖9所示。

避開障礙后，延時5 s重新判斷與障礙物之間的距離，當小于安全距離時，重復上述指令，直至完全避開障礙。程序的流程圖如圖10所示。

圖9 測距程序圖

圖10 主程序流程圖

3 仿真搭建及結果分析

3.1 仿真系統的搭建

根據對消防機器人運動模型和避障模型的分析，控制器和傳感器的選擇，在Matlab軟件控制平臺搭建消防機器人。其避障系統仿真圖如圖11所示。

圖11 避障系統仿真模型

3.2 結果分析

仿真設定的探測的范圍為0～700 mm，表2給出了消防機器人連續10個時刻的位置、速度、角度值大小。機器人低速行走為0～40 mm/s，中速為40～80 mm/s，高速為80～120 mm/s。根據控制仿真結果，對10個數值時刻的輸出速度和角度的改變量進行繪制，如圖12和圖13所示。從圖表中可得，消防機器人的速度與障礙的距離成正比，距離越大則機器人的速度越高；偏轉角度與障礙的距離成反比，距離越大則偏轉的角度越小，當距離大于設定的安全距離時，機器人的偏轉角度為0°，能夠滿足消防機器人在實際應用中的要求。

消防機器人所面臨的火場環境是復雜未知的，為驗證避障系統的運行情況，采取多種形狀的障礙并隨機放置模擬火災環境，對消防機器人避障進行仿真實驗。機器人最終的避障軌跡如圖14所示。從圖中可以得出，消防機器人的避障軌跡連續，平滑且穩定。