引言
煤礦井通常具有作業(yè)環(huán)境惡劣、危險系數(shù)高的特點,礦井災難事故時有發(fā)生。由于礦井事故現(xiàn)場環(huán)境復雜,人工救援存在效率低、危險性高等問題,因此煤礦救援機器人成為近年來煤礦機械研究領域的熱點。中國礦業(yè)大學研制了履帶式救援機器人,通過擺臂的攀爬機理,能夠跨越壕溝、臺階等障礙,但履帶行走速度低,一定程度上會降低礦井救援作業(yè)的效率。中南大學提出了具有仿生機理的輪式機器人,具有速度快、機動性強的特點,但其控制策略較為復雜。為此,本文設計了一種具有多單縱臂機構的輪式救援機器人,其速度快,控制策略簡單,適合礦井非結構化環(huán)境的機動作業(yè)。
1救援機器人結構設計
四腿式動物(如犬)通過抬離前腿和伸長后腿來調整身體質心和姿態(tài),使身體適應障礙高度,當越障行為即將完成時,伸長前腿并抬離后腿,避免觸碰障礙。本文根據(jù)這種行為,設計了一種具有越障能力的多輪腿型救援機器人。
礦井救援機器人的總體結構示意圖如圖1所示,機器人由機體、擺臂腿機構和行走輪構成,行走輪由直流電機驅動,擺臂腿通過電推桿驅動,整車采用基于輪邊電機的分布式驅動方式,控制靈活,可實現(xiàn)原地轉向,便于在狹窄的礦井環(huán)境中執(zhí)行生命探測等搜救任務。
整車基本性能參數(shù)如表1所示。為確定機器人關鍵結構的設計參數(shù),針對其通過臺階的越障幾何約束機理進行分析。
機器人前輪越障時,前擺臂抬起至最高位,如圖2所示,根據(jù)幾何關系可得:
代入上述參數(shù)值可得H=210mm>160mm,滿足越障性能指標要求。
機器人后輪垂直越障過程如圖3所示,根據(jù)幾何約束關系可得:
式中,9為中間后輪接觸過程中底盤與臺階水平夾角,θ為底盤后側斜邊與水平方向夾角,B為底盤后側斜邊與機體垂向夾角。
對式(2)、式(3)代入上述相關參數(shù)值,可得9=23.6o,B=74.1o,所以:
此時L+R=220mm>160mm,滿足救援機器人越障性能需求。
綜合以上分析,初選尺寸滿足救援機器人設計需求。
2救援機器人機構參數(shù)優(yōu)化
在煤礦救援機器人初始結構設計參數(shù)確定的基礎上,為了提高越障效率,需要對擺臂腿機構參數(shù)進行優(yōu)化,根據(jù)上述越障分析結論可以得到優(yōu)化設計目標函數(shù)為:
輪式機器人的越障能力主要由前擺臂確定,初始擺臂姿態(tài)約束如圖4所示,則有:
式(5)即為約束條件。由機器人結構可知,決策變量主要是行走輪心之間的距離L1、擺臂長度L、車輪的半徑R以及車體傾角91。利用GA遺傳算法設置相關參數(shù)變化范圍,選擇最優(yōu)適應度和個體,基于MATLAB的選擇過程如圖5所示,經(jīng)過約70代優(yōu)化迭代,可確定擺臂腿的最優(yōu)參數(shù)為141.9mm。
圖5MATLABGA算法選擇過程
3救援機器人運動學仿真
為了驗證機器人的越障性能,在ADAMs中建立了臺階虛擬障礙,并根據(jù)結構設計與優(yōu)化的參數(shù)建立了機器人虛擬樣機模型,進行運動學仿真。機器人跨越臺階的過程如圖6所示,從仿真可知,機器人可通過調整前后擺臂姿態(tài)實現(xiàn)質心調節(jié),并適應障礙高度,驗證了多輪腿機構的可行性。
圖6跨越臺階仿真
越障過程中前后擺臂腿擺動角度的運動曲線如圖7所示,曲線說明,擺臂運動規(guī)劃過程為典型階躍過程,擺動角度范圍為[-759,259],說明所設計的擺動角度閾值合理。
越障過程中質心變化曲線如圖8所示,從圖中可知,機器人越障高度約為162mm,滿足設計指標需求。
4結語
本文針對煤礦井復雜環(huán)境搜救難的問題,設計了一種仿四足輪式救援機器人,利用幾何運動學約束的方法設計了機器人結構參數(shù),利用ADAMs對機器人越障運動學性能進行了仿真分析,驗證了所設計的多輪腿機構的可行性。此研究為煤礦機器人設計提出了一種新的思路。