The design and analysis of bionic robot drive system based on hydraulic SEA
杜挺豪1,韓莉莉1,寧 祎1,羅健文2,杜婷婷1
(1.河南工業(yè)大學(xué) 機器人研究所,鄭州 450007;2.哈爾濱工業(yè)大學(xué) 機器人研究所,哈爾濱 150080)
DU Ting-hao1, HAN Li-li1, NING Yi1, LUO Jian-wen2, DU Ting-ting1
?
基于液壓SEA的仿生機器人驅(qū)動器設(shè)計研究
The design and analysis of bionic robot drive system based on hydraulic SEA
杜挺豪1,韓莉莉1,寧祎1,羅健文2,杜婷婷1
(1.河南工業(yè)大學(xué) 機器人研究所,鄭州 450007;2.哈爾濱工業(yè)大學(xué) 機器人研究所,哈爾濱 150080)
DU Ting-hao1,HAN Li-li1,NING Yi1,LUO Jian-wen2,DU Ting-ting1
摘要:根據(jù)液壓串聯(lián)彈性驅(qū)動器(以下簡稱液壓SEA)驅(qū)動仿生機器人關(guān)節(jié)的需要,設(shè)計了一種新型驅(qū)動器,其驅(qū)動電路采用三級控制結(jié)構(gòu)和深度電流負(fù)反饋技術(shù)。闡述了驅(qū)動器的設(shè)計原理和動態(tài)特性分析,并對制作的驅(qū)動器物理系統(tǒng)進行了性能測試。結(jié)果表明,驅(qū)動器輸出負(fù)載電流穩(wěn)定,線性度好,響應(yīng)速度快,滿足設(shè)計要求。
關(guān)鍵詞:仿生機器人;液壓SEA;驅(qū)動器;深度電流負(fù)反饋
重載仿生機器人需要較大的負(fù)載能力和驅(qū)動力矩,其驅(qū)動方式的選擇非常重要。電機驅(qū)動的功率密度低,負(fù)載能力小,滿足不了這類機器人的需要;而液壓驅(qū)動以其功率密度高,響應(yīng)速度快和負(fù)載能力強的優(yōu)越性能受到了工程界的青睞。
研究的驅(qū)動器主要用于液壓SEA驅(qū)動的仿生機器人。該驅(qū)動器作為仿生機器人的重要執(zhí)行部分,除了要求輸出功率大、動、靜態(tài)性能好,還要具有線性度好、響應(yīng)速度快、頻帶寬等特點[1]。特別對于液壓驅(qū)動的仿生機器人來說,要盡量減少液壓管線的分布,減輕仿生機器人的重量。設(shè)計的驅(qū)動器要滿足輕量化、小型化的要求,易于與液壓SEA集成。液壓SEA驅(qū)動器的結(jié)構(gòu)如圖1所示。
液壓SEA驅(qū)動器應(yīng)滿足以下技術(shù)參數(shù):1)輸入的電壓范圍為-10V~+10V;2)輸出的電流范圍為-40mA~+40mA;3)驅(qū)動器的線性度誤差要小于3%;4)驅(qū)動器的頻帶度應(yīng)大于400Hz,以適應(yīng)電液伺服閥的高頻響應(yīng);5)采用24V單電源供電,滿足各個模塊的供電要求。
圖1 液壓SEA驅(qū)動器結(jié)構(gòu)
電液伺服閥在長時間連續(xù)工作后會產(chǎn)生很高的溫升。受溫度變化的影響,線圈的電阻值產(chǎn)生高達(dá)30%的變化[2]。采用深度電流負(fù)反饋技術(shù),可以抑制負(fù)載線圈電阻變化對輸出電流的影響,消除閥線圈阻抗變化引起閥的增益變化和相位滯后。
圖2 驅(qū)動器等效電路
當(dāng)采用深度電流負(fù)反饋時,為了方便分析,可以將驅(qū)動器用圖2所示的等效電路來表示。
其中,u為放大器輸入控制電壓,Au為經(jīng)過放大器放大后的電壓,R、L分別為負(fù)載電阻和電感,r為等效內(nèi)阻,i為負(fù)載電流。
由基爾霍夫定律可得:
取拉式反變換得:
即:
其中,時間常數(shù):
電氣轉(zhuǎn)折頻率:
在實驗中,若采用電壓負(fù)反饋,其等效內(nèi)阻r≈0,此時的轉(zhuǎn)折頻率很低,會使系統(tǒng)的頻率響應(yīng)受到ωa的限制[3]。當(dāng)采用深度電流負(fù)反饋時,可以使等效內(nèi)阻r增大,從而增大系統(tǒng)的電氣轉(zhuǎn)折頻率ωa,提高系統(tǒng)的動態(tài)特性[4]。
驅(qū)動器電路原理圖如圖3所示。
當(dāng)不考慮調(diào)零電路的作用時,根據(jù)運算放大器的虛短和虛斷原理,通過放大器U1可得:
式(6)進行整理可得:
圖3 驅(qū)動器電路原理圖
放大器U2是個電壓跟隨器,輸出電壓緊緊跟隨輸入,可得:
放大器U3是功率輸出級,可得:
將式(8)代入式(9)可得:
求得,流過負(fù)載RL的電流為:
通過式(11)可以看出,當(dāng)電路中的參數(shù)確定時,負(fù)載上的電流和輸入電壓信號成線性關(guān)系,并且與負(fù)載電阻的大小無關(guān),趨于恒流源。
為了有效地提高伺服閥線圈的固有頻率 ,采用深度電流負(fù)反饋方式電路[5,6]。
T=5.7×10-8將式(12)、式(13)、式(14)帶入式(15),伺服放大器的傳遞函數(shù)為:
其中:
由于放大器的開環(huán)增益A很大,所以在深度電流負(fù)反饋中時間常數(shù):
采用FF-102電液伺服閥,其傳遞函數(shù):
驅(qū)動器的傳遞函數(shù)為:
將相關(guān)參數(shù)帶入式(18)后,用MATLAB進行仿真,驅(qū)動器的伯德圖如圖4所示,在階躍信號輸入下的響應(yīng)曲線如圖5所示。
分析圖4、圖5,驅(qū)動器的帶寬為550Hz,上升時間為1.5ms,峰值時間為3ms,調(diào)節(jié)時間為4.7ms,超調(diào)量為9.3%。驅(qū)動器動態(tài)性能好、響應(yīng)迅速,滿足設(shè)計要求。
圖4 驅(qū)動器伯德圖
圖5 驅(qū)動器響應(yīng)曲線
驅(qū)動器輸入-10V~+10V的電壓,測得的實驗數(shù)據(jù)如表1所示。
表1 伺服放大器實驗數(shù)據(jù)
對實驗數(shù)據(jù)進行處理,得到輸入電壓與負(fù)載電流曲線如圖6所示。
圖6 輸入電壓與輸出電流關(guān)系圖
分析圖6的曲線,可以得到,曲線線性度好,誤差小于3%,輸出電流與輸入電壓成線性關(guān)系,符合設(shè)計要求。
參考文獻:
[1] 李玲瓏,等.伺服放大器設(shè)計與仿真分析[J].自動化儀表,2012(12): 83-85.
[2] 郁凱元.電液控制系統(tǒng)中電流負(fù)反饋放大器內(nèi)阻及放大倍數(shù)的計算與測量[J].液壓與啟動,1982(2).
[3] 封元華.電液伺服系統(tǒng)中的電流負(fù)反饋放大器[J].航空計測計術(shù),1993(6).
[4] Changqi Chen,Hongjun Tang. An electro-hydraulic servo control system research for CFETR blanket RH[J].Fusion Engineering and Design,2014,89(11).
[5] 邵華平,董選明.基于LH0041的伺服電流放大器電路設(shè)計[J].電子技術(shù)應(yīng)用,1998(7).
[6] Has,Z.Robust Precision Control for a Class of Electro-Hydraulic Actuator System based on Disturbance Observer[J].international journal of precision engineering and manufacturing,2015,16.
作者簡介:杜挺豪(1990 -),男,河南許昌人,碩士研究生,主要從事機器人控制系統(tǒng)的研究工作。
基金項目:國家863計劃支持項目(2014AA1329)
收稿日期:2015-11-28
中圖分類號:TP273;TP242
文獻標(biāo)識碼:A
文章編號:1009-0134(2016)03-0053-04