久久久91-久久久91精品国产一区二区-久久久91精品国产一区二区三区-久久久999国产精品-久久久999久久久精品

    1　前言

    動(dòng)力學(xué)模型是工業(yè)機(jī)器人系統(tǒng)動(dòng)力學(xué)仿真、分析和控制的基礎(chǔ)，而其應(yīng)用的前提條件是已知機(jī)器人各臂的質(zhì)量、質(zhì)心位置、慣性矩和慣性積以及各關(guān)節(jié)的摩擦阻尼特性等動(dòng)力學(xué)參數(shù)。一般情況下，這一復(fù)雜機(jī)械系統(tǒng)的動(dòng)力學(xué)參數(shù)必須通過一定的方法辨識(shí)獲得。

    目前，機(jī)器人動(dòng)力學(xué)參數(shù)辨識(shí)方法主要有：①解體測量［1］。②不解體CAD辨識(shí)方法［2］。③不解體試驗(yàn)辨識(shí)［3］。④理論辨識(shí)［4］。解體測量不能獲得關(guān)節(jié)特性參數(shù)，且機(jī)器人解體和不解體情況下動(dòng)力學(xué)參數(shù)有較大差異；CAD辨識(shí)方法可在不解體情況下全部辨識(shí)動(dòng)力學(xué)參數(shù)，但CAD模型誤差可造成辨識(shí)參數(shù)的不準(zhǔn)確；不解體試驗(yàn)辨識(shí)可獲得較為準(zhǔn)確的動(dòng)力學(xué)組合值，但很難獲得獨(dú)立的動(dòng)力學(xué)參數(shù)值；理論辨識(shí)需要設(shè)計(jì)特定的試驗(yàn)工況，且多為組合值［5］。

    本文在不解體情況下，采用CAD方法辨識(shí)PUMA760機(jī)器人的大臂、小臂及腰部動(dòng)力學(xué)參數(shù)，并基于試驗(yàn)辨識(shí)和理論辨識(shí)方法進(jìn)行修正，最后通過有負(fù)載和無負(fù)載情況下機(jī)器人各臂聯(lián)動(dòng)試驗(yàn)驗(yàn)證所辨識(shí)參數(shù)的正確性。

    2　動(dòng)力學(xué)參數(shù)辨識(shí)

    2.1　基于CAD方法的參數(shù)辨識(shí)
    根據(jù)PUMA760機(jī)器人的結(jié)構(gòu)圖，并考慮傳動(dòng)系統(tǒng)的影響，將其小臂(包括4、5、6關(guān)節(jié))、大臂、腰部和底座三部分分別離散為由若干規(guī)則形狀的子體。其中，小臂離散為48個(gè)子體，大臂離散為30個(gè)子體，腰部和底座離散為23個(gè)子體。通過計(jì)算各規(guī)則體的質(zhì)量、質(zhì)心位置矢量標(biāo)分量和慣性并矢張量分量分別獲得小臂(包括4、5、6關(guān)節(jié))、大臂、腰部和底座三部分的動(dòng)力學(xué)參數(shù)，如表1所示。

    表1　小臂、大臂、腰部和底座動(dòng)力學(xué)參數(shù) 部件名稱

    注：括號(hào)中為可運(yùn)動(dòng)部分質(zhì)量

    2.2　關(guān)節(jié)特性參數(shù)
機(jī)器人關(guān)節(jié)特性包括各關(guān)節(jié)的當(dāng)量剛度和當(dāng)量阻尼，由于腰部剛度相對(duì)較大，僅考慮2、3關(guān)節(jié)特性。運(yùn)用試驗(yàn)?zāi)B(tài)分析方法及物理參數(shù)識(shí)別程序，獲得關(guān)節(jié)的當(dāng)量剛度和當(dāng)量阻尼，如表2所示。

    表2　關(guān)節(jié)的當(dāng)量剛度和當(dāng)量阻尼 關(guān)節(jié)

 
    3　辨識(shí)參數(shù)的修正與試驗(yàn)驗(yàn)證

    3.1　辨識(shí)參數(shù)的理論與試驗(yàn)驗(yàn)證
    分別進(jìn)行如下單關(guān)節(jié)運(yùn)動(dòng)試驗(yàn)：①3關(guān)節(jié)沿逆時(shí)針方向旋轉(zhuǎn)100°。②2關(guān)節(jié)沿逆時(shí)針方向旋轉(zhuǎn)90°。③1關(guān)節(jié)沿逆時(shí)針方向旋轉(zhuǎn)80°。關(guān)節(jié)運(yùn)動(dòng)過程為加速―勻速―減速。通過實(shí)測電動(dòng)機(jī)電樞電流和關(guān)節(jié)碼盤值，經(jīng)過轉(zhuǎn)換和數(shù)據(jù)處理分別獲得關(guān)節(jié)驅(qū)動(dòng)力矩、轉(zhuǎn)角、角速度和角加速度。

    以實(shí)測的關(guān)節(jié)力矩、CAD辨識(shí)結(jié)果為輸入，依據(jù)式(1)至(2)計(jì)算獲得運(yùn)動(dòng)特性曲線。比較計(jì)算結(jié)果與實(shí)測結(jié)果可知：①二者趨勢相同，但幅值相差較大，且計(jì)算值大于實(shí)測值。②計(jì)及關(guān)節(jié)特性后，計(jì)算運(yùn)動(dòng)特性曲線與實(shí)測運(yùn)動(dòng)特性曲線的幅值差明顯減小，但仍有較大誤差。因此，對(duì)于CAD辨識(shí)結(jié)果需要進(jìn)行適當(dāng)修正。

    3.2　參數(shù)修正

    3.2.1　質(zhì)心位置修正
    小臂水平放置。將3關(guān)節(jié)松開(形成純機(jī)械鉸鏈聯(lián)接)，其余關(guān)節(jié)鎖緊，末端以精密測力環(huán)支撐。根據(jù)末端力及小臂質(zhì)量可獲得其沿y3軸的質(zhì)心位置，參見表3。同理，機(jī)器人大臂、小臂水平放置，將2關(guān)節(jié)松開(形成純機(jī)械鉸鏈聯(lián)接)，其余關(guān)節(jié)鎖緊，根據(jù)末端力及小臂質(zhì)量、大臂質(zhì)量、小臂質(zhì)心位置可獲得大臂沿x2軸的質(zhì)心位置，參見表3。

    3.2.2　慣性關(guān)矢張量修正
    采用修正后的質(zhì)心位置數(shù)值重新進(jìn)行動(dòng)力學(xué)計(jì)算，根據(jù)試驗(yàn)結(jié)果，應(yīng)用曲線擬合方法修正慣性并矢張量值，最終辨識(shí)結(jié)果見表3。

    表3　最終辨識(shí)結(jié)果 部件

    注：括號(hào)中為可運(yùn)動(dòng)部分質(zhì)量；為修改值。

    3.3　辨識(shí)參數(shù)的綜合驗(yàn)證
    為驗(yàn)證最終辨識(shí)結(jié)果，設(shè)計(jì)如下試驗(yàn)：①機(jī)器人末端無負(fù)載，大臂與水平面呈30°、小臂與大臂呈120°，2、3關(guān)節(jié)聯(lián)動(dòng)使末端點(diǎn)行走直線軌跡，測量2、3關(guān)節(jié)的關(guān)節(jié)力矩和關(guān)節(jié)運(yùn)動(dòng)參量。②機(jī)器人末端夾持3 kg物體，大臂與水平面呈30°、小臂與大臂呈120°，2、3關(guān)節(jié)聯(lián)動(dòng)使末端點(diǎn)行走直線軌跡，測量2、3關(guān)節(jié)的關(guān)節(jié)力矩和關(guān)節(jié)運(yùn)動(dòng)參量。

    以實(shí)測關(guān)節(jié)力矩和最終辨識(shí)結(jié)果為輸入，計(jì)算關(guān)節(jié)運(yùn)動(dòng)值。比較測量結(jié)果和計(jì)算結(jié)果可知，兩者吻合很好。

    4　結(jié)論

    (1)基于多體系統(tǒng)理論建立機(jī)器人動(dòng)力學(xué)模型及動(dòng)力學(xué)參數(shù)辨識(shí)方程，該方法具有一般性。

    (2)采用CAD、理論、試驗(yàn)相結(jié)合方法獲得PUMA760機(jī)器人的動(dòng)力學(xué)參數(shù)，既利用了CAD方法可獲得每一單個(gè)動(dòng)力學(xué)參數(shù)的優(yōu)點(diǎn)，又通過理論和試驗(yàn)方法彌補(bǔ)了CAD方法的不足。

    (3)本文未能辨識(shí)4、5、6體的動(dòng)力學(xué)參數(shù)，也未能通過試驗(yàn)修正慣性積。

    參考文獻(xiàn)
    [1]Armstrong S,et al.The explicit dynamic model and inertial parameters of the PUMA 560 arm.In∶IEEE International Conference on Robotics and Automation,California,1986∶510～518
    [2]Lee K W.Shape optimiz ation of asscmblies using ge-ometric properties∶［Ph.D Dissertation］.Massachusetts∶MIT,1983.
    [3]Lim G,et al.Parameter identification mcthod for robot dynamic models using a balancing mechanism.Robotica,1989,7∶327～337
    [4]Ha I，et al.An efficient stimulation algorithm for the model parameters of robotic manipulators.IEEE Trans.on Robotics and Automation,1989,5∶384～394
    [5]黃鐵球.不解體機(jī)器人動(dòng)力學(xué)參數(shù)辨識(shí)方法的研究∶［碩士學(xué)位論文］，天津∶天津大學(xué)，1996.
    [6]王樹新等.PUMA 760工業(yè)機(jī)器人結(jié)構(gòu)動(dòng)態(tài)特性的實(shí)驗(yàn)研究.動(dòng)態(tài)測試技術(shù)與信號(hào)分析，1994，12(4)∶36～41
    [7]劉又午，多體系統(tǒng)動(dòng)力學(xué)(下冊(cè)).天津∶天津大學(xué)出版社，1991.
    [8]蔡金獅.動(dòng)力學(xué)系統(tǒng)辨識(shí)與建模.北京∶國防工業(yè)出版社，1991.