楊坤全,黃惠
(1.漳州職業(yè)技術(shù)學(xué)院汽車工程系,福建 漳州 363000;2.福州大學(xué)機(jī)械工程及自動化學(xué)院,福建 福州 350108)
機(jī)器人是多學(xué)科交叉和技術(shù)綜合的結(jié)晶[1],目前在生產(chǎn)、運(yùn)輸、軍事等領(lǐng)域都發(fā)揮著重大作用.其中足式機(jī)器人因具有更接近生物的行動方式、較強(qiáng)的環(huán)境適應(yīng)能力、可代替人類開展復(fù)雜且危險的工作、節(jié)約人力成本[2]等特征,而擁有廣闊的應(yīng)用前景.但實際使用過程中,機(jī)械腿在高速、重載、跳躍、崎嶇道路等情況下,會發(fā)生很大的振動,影響到工作的穩(wěn)定性.如何消除或抑制振動以保證機(jī)器人的穩(wěn)定性是足式機(jī)器人研究的關(guān)鍵問題之一[3].目前使用的減振控制方法主要有被動減振控制、主動減振控制和半主動減振控制.
被動減振控制的原理是在系統(tǒng)中加入阻尼元件來吸收振動能量并轉(zhuǎn)化為其他形式,或者改變結(jié)構(gòu)使得系統(tǒng)質(zhì)量得到優(yōu)化分布而實現(xiàn)減振效果[4].常采用的方法有:在機(jī)器人腳底安裝橡膠、泡沫[5-6]一類的軟質(zhì)材料或彈簧緩沖裝置[7-8]來減小地面沖擊,又或者模仿人腳的生理結(jié)構(gòu),在腳的側(cè)面和后部擴(kuò)大穩(wěn)定支撐區(qū)域[9].雖然被動減振系統(tǒng)性能穩(wěn)定、易于維護(hù)、針對高頻振動減振效果較好,但其結(jié)構(gòu)一旦確定,只對固定頻率的振動起作用[6],難以適應(yīng)某些足式機(jī)器人的復(fù)雜工作場所.主動減振控制需要外部能源輸入提供控制力,控制過程依賴于結(jié)構(gòu)反應(yīng)和外界干擾信息,具有適應(yīng)范圍廣、控制效果好等特點(diǎn),但其控制系統(tǒng)結(jié)構(gòu)復(fù)雜,造價昂貴.而半主動控制綜合了前兩者的優(yōu)點(diǎn)[10],其中,磁流變阻尼器具有響應(yīng)速度快、阻尼可調(diào)范圍大、能耗較低等優(yōu)勢,是當(dāng)前振動控制領(lǐng)域的研究熱點(diǎn)[11].戴金橋等[12]使用磁流變阻尼器實現(xiàn)對柔性機(jī)器人關(guān)節(jié)振動的半主動控制,蔣楠[13]設(shè)計了一種旋轉(zhuǎn)型磁流變液阻尼并將其應(yīng)用于機(jī)器人腿中,通過不同的電流控制策略調(diào)整機(jī)器人腿與地面的相互作用,實現(xiàn)運(yùn)動過程中的半主動控制.然而這些磁流變阻尼器的出力效果仍無法滿足機(jī)械腿在特殊工況下的減振需求.
因此,本研究提出一種剪切閥-擠壓混合模式磁流變阻尼器對機(jī)械腿進(jìn)行減振控制的方法.該新型阻尼器相較傳統(tǒng)磁流變阻尼器而言具有更大的出力,在阻尼通道處具有更為均勻的磁場分布以及更高的磁感應(yīng)強(qiáng)度.在剛性地面與柔性地面之間,依靠模式切換可快速提供連續(xù)可調(diào)的阻尼力,滿足足式機(jī)器人對復(fù)雜工作場所的減振需求.對該阻尼器進(jìn)行動力學(xué)臺架試驗獲取其動力學(xué)數(shù)據(jù),建立其 Bouc-Wen 模型,基于遺傳算法對模型參數(shù)進(jìn)行辨識,建立機(jī)械腿的Simulink仿真模型,并采用天棚控制的方法進(jìn)行減振控制,為足式機(jī)器人的機(jī)械腿減振提供了一種方法.
將現(xiàn)有的一種新型剪切閥-擠壓混合模式磁流變阻尼器應(yīng)用于機(jī)械腿減振控制,其結(jié)構(gòu)如圖 1所示,主要結(jié)構(gòu)的尺寸參數(shù),如圖2所示.

圖1 新型混合模式磁流變阻尼器結(jié)構(gòu)Fig.1 New hybrid mode magnetorheological damper

圖2 新型混合模式磁流變阻尼器主要結(jié)構(gòu)尺寸(單位:mm) Fig.2 Main structural dimensions of new hybrid mode magnetorheological damper(uint:mm)
該阻尼器具體性能可參考前期研究[14].該阻尼器的重點(diǎn)創(chuàng)新設(shè)計在于:活塞和缸筒處都安裝了兩組勵磁線圈,實現(xiàn)磁流變阻尼器在兩種工作模式的轉(zhuǎn)換.當(dāng)在一般較輕負(fù)載的情況下,只給活塞線圈通入電流,不給套筒線圈通入電流,該閥處于剪切閥式的工作模式.在特定的極端負(fù)載的情況下,給活塞處和套筒處的線圈同時通入電流,此時該閥處于剪切閥-擠壓式的工作模式,活塞桿向外輸出較大的阻尼力.此款新型混合式磁流變阻尼器,可根據(jù)不同的場景,通過控制輸入電流的大小,控制阻尼器的最大輸出力,符合足式機(jī)器人對復(fù)雜工作情況的需求.
為獲取該混合模式磁流變阻尼器的力學(xué)數(shù)據(jù),利用萬能材料試驗機(jī)進(jìn)行測試,對活塞線圈和缸筒線圈分別提供不同的電流激勵,測試阻尼器在不同工作模式下的力學(xué)性能,萬能材料試驗機(jī)測試現(xiàn)場如圖3所示.

圖3 阻尼器力學(xué)性能測試Fig.3 Mechanical performance test of damper
設(shè)置激勵信號為正弦輸入信號,當(dāng)測試線圈分別通入 0.1,0.3,0.6,1.0 A電流時,剪切閥式下力與位移的關(guān)系如圖4所示.實驗結(jié)果表明,混合式阻尼器在剪切閥式下,對活塞兩線圈施加1.0 A電流時阻尼器的最大出力可達(dá)1.065 kN;當(dāng)測試線圈分別通入 0.1,0.3,0.6,1.0 A電流時,剪切閥-擠壓模式下阻尼器力與位移的關(guān)系如圖5所示.從圖5中可見,剪切閥-擠壓式阻尼力位移滯回曲線與剪切閥式阻尼力位移滯回曲線有所不同,剪切閥-擠壓式在兩端有尖角現(xiàn)象.主要原因是在剪切閥-擠壓式下,磁流變液與活塞相互作用時會出現(xiàn)拉伸和壓縮狀態(tài),從而導(dǎo)致尖角現(xiàn)象的發(fā)生.試驗測試結(jié)果表明,當(dāng)只給兩線圈施加1.0 A電流時,混合式阻尼器在剪切閥-擠壓式下最大出力可達(dá)4.939 kN.相比單一形式的磁流變阻尼器,混合式阻尼器可以使阻尼力的最大出力增加364%.

圖4 剪切閥式下阻尼器力與位移曲線Fig.4 Force and displacement curves of damper under shear valve type

圖5 剪切閥-擠壓模式下阻尼器力與位移曲線Fig.5 Damper force and displacement curves in shear valve-squeeze mode
由于磁流變液體的非線性,選用Bouc-Wen模型作為磁流變力學(xué)模型,它是目前應(yīng)用最為廣泛的非線性滯回模型,通過改變模型參數(shù)就可以模擬眾多的滯回特性.該模型由滯回系統(tǒng)、彈簧和阻尼器并聯(lián)而成,如圖6所示.其模型方程可表示為:

圖6 阻尼器力學(xué)性能測試Fig.6 Schematic diagram of Bouc-Wen model

(1)
由于Bouc-Wen力學(xué)模型具有多個未知參數(shù)、運(yùn)算較為復(fù)雜,本研究采用遺傳算法進(jìn)行模型參數(shù)的識別工作.具體分為如下6個步驟:
1) 通過分析具體問題采用不同的編碼方式獲得初始種群;
2) 利用適應(yīng)度函數(shù)計算出個體的適應(yīng)度值;
3) 通過對個體適應(yīng)度值進(jìn)行評估將滿足條件的個體遺傳到下一代;
4) 在計算過程中設(shè)置一定比例作為種群的交叉概率遺傳到下一代;
5) 設(shè)定種群中一定的變異概率,將新得到的種群再次進(jìn)行適應(yīng)度計算;
6) 對種群適應(yīng)度值進(jìn)行評估滿足條件計算結(jié)束,否則繼續(xù)對種群執(zhí)行選擇交叉變異直至收斂為止.
首先將混合式磁流變阻尼器試驗數(shù)據(jù)進(jìn)行稀釋得到遺傳算法的初始種群,確定初始種群的個數(shù)為N=40.基于上述實驗位移幅值,對頻率f=5 Hz時0~1 A的試驗數(shù)據(jù)進(jìn)行參數(shù)辨識,將辨識后得到的參數(shù)值代入所選的力學(xué)模型進(jìn)行仿真.通過對比試驗數(shù)據(jù)與仿真結(jié)果的吻合情況,來確定參數(shù)辨識結(jié)果的正確性.采用仿真值與實驗值之差的最小平方值為適應(yīng)度值,得出適應(yīng)度函數(shù)具體的數(shù)學(xué)表達(dá)式為:

(2)
式中:fitness為適應(yīng)度值;Fi,仿真值為第i個點(diǎn)的仿真值;Fi,實驗值為第i個點(diǎn)的實驗值;Fmax為初始種群中試驗數(shù)據(jù)的最大值;Fmin為初始種群中試驗數(shù)據(jù)的最小值;m為初始種群的個數(shù).
滯回力模型:
滯回位移模型:
式中:由于試驗中有具體的激勵信號,因此活塞的相對位移x、相對速度v都能確定;n表示滯回曲線的圓滑程度,根據(jù)前人的研究經(jīng)驗設(shè)n=2;模型中的未知參數(shù)有c、k、α、γ、β、A共6個.
在確定好適應(yīng)度函數(shù)之后,設(shè)置交叉、變異比例分別是75%和25%.在初次參數(shù)辨識求出一組未知參數(shù)值后,找出每個參數(shù)的變化范圍,并將每個參數(shù)的最大值與最小值用來設(shè)置下次參數(shù)辨識的上下限,多次重復(fù)以上步驟直到每個參數(shù)達(dá)到預(yù)期精度.
1) 剪切閥式下的辨識結(jié)果.在對初始種群辨識后得到參數(shù)的最小值作其參數(shù)LB,最大值作為其參數(shù)UB,不斷重復(fù)上述操作.從而縮小模型未知參數(shù)的取值范圍,因此最終參數(shù)識別的精度也不斷提高.經(jīng)過多組運(yùn)算后得到的各參數(shù)值如表1所示.

表1 剪切閥式下各參數(shù)辨識結(jié)果Tab.1 Parameter identification results of shear valve type
2) 剪切閥-擠壓模式下的辨識結(jié)果.混合模式下剪切閥-擠壓模式辨識結(jié)果如表2所示.給活塞和缸筒內(nèi)4個線圈同時通電,當(dāng)活塞運(yùn)動到缸筒中間時,形成剪切閥式;當(dāng)活塞運(yùn)動靠近左右端蓋時,將會形成剪切閥-擠壓式,此時阻尼力將會瞬間增大.因此在這種混合模式下,需要做兩次參數(shù)辨識工作,但活塞運(yùn)動到缸筒中間可近似看成只給兩線圈通電時的普通剪切閥式,因此在混合模式下只需要對剪切閥-擠壓式進(jìn)行參數(shù)辨識,辨識過程和方法與普通剪切閥式類似.

表2 剪切閥-擠壓式下各參數(shù)辨識結(jié)果Tab.2 Parameter identification results of shear valve-extrusion type
通過遺傳算法參數(shù)辨識得出的模型可以適用固定電流下,但不能適用于一般情況,因此參數(shù)辨識的結(jié)果只能接近真實值無法等于真實值.為了找出精確的模型通用表達(dá)式,可根據(jù)劉永強(qiáng)等[15]將c、k、α看成與電流的函數(shù)關(guān)系,β、γ、A看成為某常數(shù)對該力學(xué)模型進(jìn)行改進(jìn),將Bouc-Wen模型中的c、k、α表達(dá)成電流的二次函數(shù)關(guān)系,即:

(3)
結(jié)合Bouc-Wen力學(xué)模型將其表達(dá)為:

(4)
將阻尼器在不同電流下的試驗數(shù)據(jù)作為遺傳算法的初始種群,以式(4)力學(xué)模型利用遺傳算法對其進(jìn)行參數(shù)辨識,得出a0、a1、a2、b0、b1、b2、c0、c1、c2、γ、β、A的值.混合式MRF阻尼器通過參數(shù)辨識.
在剪切閥式下辨識結(jié)果為:

(5)
在擠壓模式下辨識結(jié)果為:

(6)
為檢驗采用遺傳算法參數(shù)辨識得出的未知參數(shù)值是否正確,將在不同電流作用下得到的參數(shù)值帶入力學(xué)模型中進(jìn)行仿真,如圖7,圖8所示,并與試驗數(shù)據(jù)進(jìn)行對比.從圖7、圖8中可知,在阻尼力-位移曲線中實驗值(點(diǎn)線)和模型預(yù)測值(實線)沒有完全吻合.因為Bouc-Wen并不是磁流變液真實力學(xué)模型,但基本能夠表達(dá)磁流變液的力學(xué)特性,在圖中具有較高的吻合度,因此得出采用遺傳算法參數(shù)辨識求解出的參數(shù)值是相對準(zhǔn)確的.

圖7 剪切閥式下阻尼器力與位移曲線Fig.7 Force and displacement curves of damper under shear valve type

圖8 剪切閥-擠壓模式下阻尼器力與位移曲線Fig.8 Damper force and displacement curves in shear valve-squeeze mode
為簡化機(jī)器人運(yùn)動學(xué)求解過程,給機(jī)器人加入約束條件,一般是機(jī)器人在行走過程中身軀始終保持正直狀態(tài),而且機(jī)械腿與地面接觸時處于完全接觸狀態(tài),減振理論模型如圖9所示.其中,機(jī)身質(zhì)量為m,其振動位移為u(t) ;地面振動位移為v(t).

圖9 機(jī)械腿簡化模型Fig.9 Simplified model of mechanical leg
假設(shè)地面振動位移為:
v(t)=Asin(ωt)
(7)
式中:A為振動幅值;ω為角頻率.
建立機(jī)械腿減振系統(tǒng)微分方程:

(8)
式中:c為阻尼系數(shù);k為剛度系數(shù);u(t)為機(jī)身位移;v(t)為地面振動位移.
機(jī)身位移為:

(9)

采用Simulink建立機(jī)械腿減振系統(tǒng)的仿真模型,在減振模型仿真過程中,減振數(shù)學(xué)模型為式(9),具體的仿真流程如圖10所示.

圖10 機(jī)械腿仿真流程圖Fig.10 Flow chart of mechanical leg simulation
在機(jī)械腿減振系統(tǒng)仿真過程中,只分析給4個線圈同時通電時,混合式MRF阻尼器的減振性能將地面激勵信號設(shè)置為0~20 Hz的正弦掃頻信號.MRF阻尼器的力學(xué)模型使用自定義模塊完成,在掃頻信號下,對減振系統(tǒng)在固定電流作用下的振動與地面基礎(chǔ)振動進(jìn)行仿真,得出減振系統(tǒng)在地面與機(jī)身的位移幅值仿真曲線如圖11所示.將Simulink仿真結(jié)果進(jìn)行處理并與理論對比,得出在不同頻率下傳遞率的變化曲線如圖12所示,圖中結(jié)果表明理論推導(dǎo)與軟件仿真的結(jié)果較為吻合,說明所建立的Simulink模型具有可靠性.

圖11 機(jī)械腿仿真結(jié)果圖Fig.11 Simulation results of the mechanical leg
天棚阻尼控制的基本原理是在簧載質(zhì)量與天空慣性系之間模擬連接一個阻尼減振器,能夠有效地抑制目標(biāo)的振動.天棚控制模型是一種具有理想化的模型,本研究建立的天棚控制機(jī)械腿模型如圖13所示.

圖13 機(jī)械腿天棚控制模型Fig.13 Skyhook control model of mechanical leg
理想天棚模型時阻尼力為:

(10)
式中:csky為天棚阻尼系數(shù).它由系統(tǒng)特性決定,其作用主要是調(diào)節(jié)機(jī)械腿工作來改善控制系統(tǒng)的平順性,其原理是將產(chǎn)生的天棚阻尼力與其機(jī)身運(yùn)動方向相反.即:

(11)
式中:m為機(jī)身質(zhì)量;x2為機(jī)身位移;k為剛度系數(shù);c為阻尼器的粘性系數(shù).將上式進(jìn)行拉氏變換得:
ms2X2(s)+k(X2(s)-X1(s))+cs(X2(s)-X1(s))+cskysX2(s)=0
(12)
解上式方程,可得到機(jī)械腿振動的傳遞函數(shù)為:

(13)
其加速度的頻率響應(yīng)函數(shù)為:

(14)
其中,由(13)、(14)式,并利用Matlab計算出機(jī)械腿天棚控制模型的幅頻響應(yīng)曲線,結(jié)合仿真曲線綜合考慮取csky= 2 500 N·s·m-1.
在天棚控制系統(tǒng)中,磁流變阻尼器的輸出力滿足:

(15)

(16)
式中:Fmax為最大庫倫阻尼力.
在機(jī)器人減振領(lǐng)域,一般利用簡諧信號與隨機(jī)信號來測試減振系統(tǒng)的好壞,隨機(jī)信號一般為白噪聲信號,采用Simulink建立天棚控制的機(jī)械腿減振系統(tǒng)程序,如圖14所示.
圖15和圖16是在振幅10 mm、頻率為5 Hz的正弦信號下,混合式磁流變阻尼器機(jī)械腿的減振控制仿真結(jié)果,圖17為隨機(jī)信號激勵下機(jī)械腿的減振仿真結(jié)果.從圖15和圖16可以看出,在正弦信號激勵下,天棚控制相比通入固定電流,其振動幅值從6.8 mm下降到3.3 mm,降低了49%;加速度從7.5 m·s-2下降到4.0 m·s-2,降低了47%,都有較大程度的降低.圖17結(jié)果表明,在隨機(jī)信號激勵下,機(jī)械腿振動位移也有大幅度降低,驗證了該控制算法的控制效果和實用性.
提出一種剪切閥-擠壓混合式磁流變阻尼器對機(jī)械腿進(jìn)行減振,對其力學(xué)性能進(jìn)行試驗研究.基于試驗數(shù)據(jù),選擇合適的磁流變液力學(xué)模型,利用遺傳算法對所選的力學(xué)模型進(jìn)行參數(shù)辨識,并建立機(jī)械腿動力學(xué)模型.最后,在天棚控制策略下對機(jī)械腿進(jìn)行了減振研究,得出如下主要結(jié)論:
1) 在混合式阻尼器實驗中,得出在剪切閥式下阻尼力最大可達(dá)1.065 kN,在剪切閥-擠壓混合模式下最大可達(dá)4.939 kN;
2) 采用遺傳算法對磁流變液的Bouc-Wen模型進(jìn)行參數(shù)辨識,得到新型混合模式磁流變阻尼器的力學(xué)正模型,且模型準(zhǔn)確;
3) 將新型混合模式磁流變阻尼器應(yīng)用于機(jī)械腿減振,配合天棚控制策略,能有效抑制機(jī)械腿振動,振動位移幅值與加速度分別下降了49%和47%.