摘要：本文首先探討了機器人進行救援或輔助救援的應用策略與應具備的功能，對需克服的非結構化地形環境進行研究，對其特征進行并提取與和簡化地形特征，提出了煤礦救災機器人機械系統的性能要求與指標，采用分形插值與三次樣條插值運算的方法模擬了三維真實地形，有利于其機械系統的動力學仿真與優化。采用四履帶雙擺臂式行走機構設計了煤礦救災機器人，并對其實際應用分析。

關鍵字：礦井救災機器人；特征提取；非結構地形；四履帶雙擺臂式

1 引言doubleswingarmtype

我國的煤炭資源十分豐富，是世界上最大的煤炭生產國和消費國。在我國的能源工業中，煤炭占我國一次能源生產和消費結構中的70％左右，當前，我國經濟的快速增長，對煤炭工業發展提出了更高的要求。

近年來，我國煤礦事故頻發。事故中，火災和爆炸相關的事故又占了相當大的比例，而礦井下引起火災和爆炸的主要物質是瓦斯和粉塵。煤層地質條件復雜，影響煤礦安全生產的因素多，是造成事故的客觀因素。我國煤礦開采的煤層大多瓦斯含量大、透氣性低且地質構造復雜，不易在開采前抽放瓦斯，大中型煤礦中，高瓦斯礦井占20.34%，瓦斯突出礦井占19.77%。小型煤礦中，高瓦斯礦井占15%左右[4]。礦井一旦發生瓦斯爆炸事故，井下人員及財產處于極度危險境地，必須盡快組織搶救，在煤礦救護過程中，由于指揮不當、違章作業、設備局限以及二次爆炸等原因造成救護人員傷亡的事故也時常發生。

綜上所述，由于我國煤礦的地質特點和一些管理因素，礦難頻發。礦難發生后，救護隊員需冒險深入災區進行探險、救護遇險人員等災害處理工作。而發生災害后，進行井下救護與災害處理的危險性很高。迫切需要研發替代或部分替代救險隊員進入礦井災害現場進行環境探測和完成搜救任務的煤礦救災機器人。所以，開展煤礦救災機器人的研究對煤礦安全生產、災害救護具有重大的現實意義與社會意義，并建立特種危險環境下的工業救災體系具有十分重要的意義。

2 井下非結構地形建模

2.1煤礦救災機器人的救援策略

瓦斯爆炸波及范圍廣、破壞程度大，造成人員傷亡多，而且災害處理具有很大的難度和危險性，在搶險救災的初期，受災區域具體范圍、爆源位置、瓦斯與CO濃度、巷道破壞情況均幾乎一無所知，搶險救護人員面臨著二次爆炸、CO中毒、頂板隨時冒落的危險，以及高溫的威脅。機器人可以在救護人員之前進入災區，探測并傳回災區環境信息。煤礦救災機器人參與救援的救援策略進行如下：

(1)切斷災區電源，通知礦山救護隊，迅速成立救災指揮部，嚴格按照災害預防處理計劃的要求，設立若干搶救組各行其責。

(2)體確定災區范圍，在盡量靠近災區的安全位置建立井下救災指揮中心，并保證井上、井下指揮中心的通訊通暢。井下救災指揮中心的位置應該滿足通風正常、瓦斯與CO濃度在安全范圍之內，又可以阻擋瓦斯二次爆炸的沖擊波。

(3)搶險救護人員攜帶必備的救護設備及救災機器人以井下救災指揮中心為基地，向災區推進。救災機器人可以作為搶險救災人員的先行軍進入災區巷道，檢測巷道內的瓦斯與CO濃度、溫度等環境信息。

(4)利用多臺煤礦救災機器人對災區核心區域的可疑巷道和工作面同時進行探測。

2.2煤礦井下非結構地形環境特征提取與簡化

煤礦井下地形環境為一種特殊的非結構地形環境，井下巷道布局、軌道與人行道建造、設備布置是根據煤礦地質特點與煤炭生產的需要，按照一定標準設計、建設與安裝的。因此，煤礦井下存在著一些固定形狀與結構的特定地形，如道床與鋼軌等。移動機器人活動的地形環境及活動長度是機器人機械系統設計的初始條件，決定了煤礦救災機器人機械性能指標，也進一步決定了機器人行走機構形式的選擇、尺寸的確定。建立符合煤礦井下特征的實際模型用于機器人仿真；并根據煤礦災區的調研情況，確立井下一定程度的非結構的地形環境，并進行計算機模擬。

巷道斷面包括機巷道的斷面形狀、寬度尺寸與高度尺寸。決定機器人的寬度尺寸的選擇。拱形雙軌巷道凈寬度按下式計算。

B=a+2A1+C+t≥2.4m(2-1)

式中，B為巷道凈寬度，指直端內側的水平距離，a為《煤礦安全規程》規定的非行人側的寬度，a≥0.3m；當巷道內安設輸送機時，輸送機距支護或碹墻最突出部分之間的距離，a≥0.5m。A1為輸送設備的最大寬度。C為《煤礦安全規程》規定，人行道的寬度，從巷道道碴面起1.6m的高度內，C≥0.8m，在人行停車地點C≥1.0m，在1.6m至1.8m之間不得架設管、線和電纜。

圖1軌道斷面

2.3三維特征地形與真實地形的計算機建模

對煤礦井下的地形環境的尺寸參數的調研與地形特征的提取與簡化，采用三維制圖軟件，對其三維特征地形進行建模。煤礦井下獨立臺階的高度多在250mm以下，人連續臺階的高度h一般取值150~180mm，臺階跨度b一般取值220~350mm，臺階寬度B一般取值

600~1200mm，連續臺階的坡度與巷道坡度常常一致，一般在8~15°之間。根據簡化的特征地形與煤礦井下參見地形的尺寸，對三維特征地形進行了建模。如圖2為其中的一個三維特征地形，此三維模型包括四大部分，包括凸臺區、臺階區、溝道區和斜坡區。

圖2 三維特征地形

2.3三維真實地形的計算機模擬與仿真

對煤礦井下非結構地形進行特征提取與簡化，有利于對機器人虛擬樣機進行特征障礙地形的越障運動的模擬與仿真。

2.3.1復雜地面的樣條插值仿真

數字高程模型DEM是對地面環境的地形地貌的一種離散的數字表示形式，用格網點的高斯坐標（x，y）及其相對應的高程Z來表示的[5][7]。地形的三維顯示首先要獲取DEM數據，對于小面積的地面，可采用三維激光掃描儀獲取其DEM數據。由于客觀條件的限制，往往不能取得足夠的采樣點來滿足顯示和模擬的需要，因此，需要進行內插以生成更多的點。常用的插值方法有反距離權重插值（Inverse Distance Weighted）、雙線性插值（Bilinear Interpolation）、趨勢面插值（Trend Surface Interpolation）、樣條插值（Spline Interpolation）等。MATLAB里提供了二維插值指令，其函數格式為：Z=interp2(x,y,z,X,Y,’method’)。樣條插值的精度要高于線性插值和立方插值，在實際應用中最為廣泛。因此，在二維插值運算選擇了三次樣條插值法。

選擇一段3500×3600mm面積的起伏地形，采用一組單格為250×300mm的垂直正交的網格，測量每一網格交點上的高度，獲得該地形的一組規則的二維矩陣高程值。數據進行三次樣條插值運輸，插值點構成的新的網絡參數X、Y的間隔分別為30mm、60mm。插值運算后，生成的三維曲面圖如圖3所示。

圖3 采用原始數據樣條插值后生成的曲面

3礦井救災機器人的機械系統與行走機構構型研究

3.1行走機構構型研究

履帶式行走機構是輪式行走機構的拓展，履帶本身起著給車輪連續鋪路的作用。常見的履帶式行走機構為方形履帶，其結構簡圖如圖4所示，該行走機構由懸架、驅動輪、導向輪、承重輪、托帶輪與履帶等部分組成，其驅動輪及導向輪兼作支撐輪（承重輪），支撐地面的面積大，穩定性好。

圖4 方形履帶式行走機構

四履帶雙擺臂履帶機器人的越障機理

圖5 機器人的質心軌跡

建立圖5所示的以機器人后履帶輪軸心為坐標原點的坐標系xo₁y，設機器人主履帶部分前后兩履帶O₁O₂的間距為l₀，主體部分質量為m₁，質心G₁的坐標為 (l₁ ,h₁)，在攀越典型障礙時，需兩擺臂同步擺動，因此設兩擺臂的質量為m₂，質心為G₂，處于擺臂中心線O₂O₃上，距離前履帶輪軸心O₂的長度為l₂，設擺臂兩履帶輪軸心的間距為l₃，擺臂的擺角為θ，且θ∈[0,2π]，設主體履帶輪半徑為R，擺臂前履帶輪半徑為r，均含履帶厚度，機器人寬度為b，則機器人的質心(x_G, y_G)的坐標為擺臂履帶機器人的質心滿足以下關系

擺臂履帶機器人的質心滿足以下關系：

機器人的質心隨著擺臂擺角θ的變化的軌跡是以

為圓心O，以

 為半徑的圓。

四履帶雙擺臂機器人正向攀越臺階的過程如圖6所示，機器人借助擺臂的初始擺角，在履帶機構的驅動下，使其主履帶前端搭靠在臺階的外角線上，機器人繼續移動，驅動擺臂順時針擺動，當機器人重心線越過臺階外角線時，機器人以該外角線為支線向臺階上平面翻轉，則機器人成功的攀越臺階。

圖6 機器人正向攀爬臺階的過程

一旦機器人主履帶搭靠在臺階外角線上，根據臺階高度，將有3種攀爬方法：

其一，主履帶與擺臂履帶成一條線，采用類似固定履帶的攀爬方式，靠機器人的重心線越過外角線，翻轉至臺階上部平臺，此過程如圖4-18A所示。此時機器人履帶總長度為

其二，當臺階的高度小于或等于擺臂的長度（H ≤l₃ +r-R）時，轉動擺臂，可保證機器人擺臂不離地的情況下，機器人主車體平穩地放平在臺階的上部平臺。當機器人主車體平放在臺階的上部平臺后，機器人運動保證機器人質心移動過臺階外角線，機器人攀越臺階成功，如圖

所示。這種攀越方式，機器人越障平穩，不會受到跌落沖擊。 其三，當臺階的高度大于擺臂的長度（3H >l +r -R）時，可借助擺臂轉動，使機器人質心向臺階外角線靠近并越過臺階外角線，完成攀越臺階的動作。 機器人跨越臺階的高度H與θ、β具有以下關系：

H的最大值H_max即為機器人反向攀爬臺階是的臺階高度的最大值。H對θ求偏導等于0，

在攀爬臺階的時候，當擺臂的擺角θ與機器人主體的傾角β取上面關系式時，H存在最大值。當機器人擺臂的質量較小，對機器人的質心位置影響較小，可忽略時，擺臂處于豎直位置，即時，H有最大值。

4結論

本文根據煤礦井下尤其是發生瓦斯、煤塵爆炸事故后的非結構化的地形環境和爆炸性氣體環境，災難發生后，現場環境非常復雜危險，決策者和救援人員由于缺少信息無法及時做出決策和判斷，導致許多被困人員因救援不及時而喪生。因此，為順利開展救援工作，減少人員傷亡，研究替代或部分替代救援人員進入災難現場進行環境探測的搜索機器人具有重要的現實意義。本文以災難救援為研究背景，研制了一種多節履帶式搜索機器人機械系統，并開展了搜索機器人動力學分析跨越障策略等關鍵技術的研究。

參考文獻

1.林柏泉我國煤礦安全現狀分析[N]中國礦業報，2006.3.3．

2.宋元明，任錦彪煤礦井下災害調查與研究[J]礦山安全，2005.3．

3.謝穎非結構化道路導航圖像的特征提取與分類[D]南京：南京理工大學，2008.6

4.黃永安，李文成，高小可．Matlab7.0/Simulink6.0應用實例仿真與高效算法開發[M]．北

京：清華大學出版社，2008．

5.柯正誼，何建邦，池天河數字地面模型[M]北京：中國科學技術出版社1993．

6.李允旺，葛世榮，朱華，劉建．四履帶雙擺臂機器人越障機理及越障能力研究[J]機器人，2010，32（2）：157-165．

7.謝順平,都金康,羅維佳,鄧敏基于DEM的復雜地形流域特征提取[J]地理研究，2006.1

8.孫斌．便攜式地面移動機器人運動分析及控制[D]長沙：國防科學技術大學2006．

9.許世范．工業機器人在礦山應用前景展望[J]煤礦自動化，1993(1)：28-31．