引言

煤礦井通常具有作業(yè)環(huán)境惡劣、危險系數(shù)高的特點,礦井災(zāi)難事故時有發(fā)生。由于礦井事故現(xiàn)場環(huán)境復(fù)雜,人工救援存在效率低、危險性高等問題,因此煤礦救援機器人成為近年來煤礦機械研究領(lǐng)域的熱點。中國礦業(yè)大學(xué)研制了履帶式救援機器人,通過擺臂的攀爬機理,能夠跨越壕溝、臺階等障礙,但履帶行走速度低,一定程度上會降低礦井救援作業(yè)的效率。中南大學(xué)提出了具有仿生機理的輪式機器人,具有速度快、機動性強的特點,但其控制策略較為復(fù)雜。為此,本文設(shè)計了一種具有多單縱臂機構(gòu)的輪式救援機器人,其速度快,控制策略簡單,適合礦井非結(jié)構(gòu)化環(huán)境的機動作業(yè)。

1救援機器人結(jié)構(gòu)設(shè)計

四腿式動物(如犬)通過抬離前腿和伸長后腿來調(diào)整身體質(zhì)心和姿態(tài),使身體適應(yīng)障礙高度,當(dāng)越障行為即將完成時,伸長前腿并抬離后腿,避免觸碰障礙。本文根據(jù)這種行為,設(shè)計了一種具有越障能力的多輪腿型救援機器人。

礦井救援機器人的總體結(jié)構(gòu)示意圖如圖1所示,機器人由機體、擺臂腿機構(gòu)和行走輪構(gòu)成,行走輪由直流電機驅(qū)動,擺臂腿通過電推桿驅(qū)動,整車采用基于輪邊電機的分布式驅(qū)動方式,控制靈活,可實現(xiàn)原地轉(zhuǎn)向,便于在狹窄的礦井環(huán)境中執(zhí)行生命探測等搜救任務(wù)。

整車基本性能參數(shù)如表1所示。為確定機器人關(guān)鍵結(jié)構(gòu)的設(shè)計參數(shù),針對其通過臺階的越障幾何約束機理進(jìn)行分析。

機器人前輪越障時,前擺臂抬起至最高位,如圖2所示,根據(jù)幾何關(guān)系可得:

代入上述參數(shù)值可得H=210mm>160mm,滿足越障性能指標(biāo)要求。

機器人后輪垂直越障過程如圖3所示,根據(jù)幾何約束關(guān)系可得:

式中,9為中間后輪接觸過程中底盤與臺階水平夾角,θ為底盤后側(cè)斜邊與水平方向夾角,B為底盤后側(cè)斜邊與機體垂向夾角。

對式(2)、式(3)代入上述相關(guān)參數(shù)值,可得9=23.6o,B=74.1o,所以:

此時L+R=220mm>160mm,滿足救援機器人越障性能需求。

綜合以上分析,初選尺寸滿足救援機器人設(shè)計需求。

2救援機器人機構(gòu)參數(shù)優(yōu)化

在煤礦救援機器人初始結(jié)構(gòu)設(shè)計參數(shù)確定的基礎(chǔ)上,為了提高越障效率,需要對擺臂腿機構(gòu)參數(shù)進(jìn)行優(yōu)化,根據(jù)上述越障分析結(jié)論可以得到優(yōu)化設(shè)計目標(biāo)函數(shù)為:

輪式機器人的越障能力主要由前擺臂確定,初始擺臂姿態(tài)約束如圖4所示,則有:

式(5)即為約束條件。由機器人結(jié)構(gòu)可知,決策變量主要是行走輪心之間的距離L1、擺臂長度L、車輪的半徑R以及車體傾角91。利用GA遺傳算法設(shè)置相關(guān)參數(shù)變化范圍,選擇最優(yōu)適應(yīng)度和個體,基于MATLAB的選擇過程如圖5所示,經(jīng)過約70代優(yōu)化迭代,可確定擺臂腿的最優(yōu)參數(shù)為141.9mm。

圖5MATLABGA算法選擇過程

3救援機器人運動學(xué)仿真

為了驗證機器人的越障性能,在ADAMs中建立了臺階虛擬障礙,并根據(jù)結(jié)構(gòu)設(shè)計與優(yōu)化的參數(shù)建立了機器人虛擬樣機模型,進(jìn)行運動學(xué)仿真。機器人跨越臺階的過程如圖6所示,從仿真可知,機器人可通過調(diào)整前后擺臂姿態(tài)實現(xiàn)質(zhì)心調(diào)節(jié),并適應(yīng)障礙高度,驗證了多輪腿機構(gòu)的可行性。

圖6跨越臺階仿真

越障過程中前后擺臂腿擺動角度的運動曲線如圖7所示,曲線說明,擺臂運動規(guī)劃過程為典型階躍過程,擺動角度范圍為[-759,259],說明所設(shè)計的擺動角度閾值合理。

越障過程中質(zhì)心變化曲線如圖8所示,從圖中可知,機器人越障高度約為162mm,滿足設(shè)計指標(biāo)需求。

4結(jié)語

本文針對煤礦井復(fù)雜環(huán)境搜救難的問題,設(shè)計了一種仿四足輪式救援機器人,利用幾何運動學(xué)約束的方法設(shè)計了機器人結(jié)構(gòu)參數(shù),利用ADAMs對機器人越障運動學(xué)性能進(jìn)行了仿真分析,驗證了所設(shè)計的多輪腿機構(gòu)的可行性。此研究為煤礦機器人設(shè)計提出了一種新的思路。