基于ADMAS串聯(lián)機器人運動學(xué)仿真與分析評價

周 欣

(西安航空學(xué)院 機械工程學(xué)院， 陜西 西安 710077)

0 引言

在數(shù)字工業(yè)化快速發(fā)展的時代，機器人作為典型的機電一體化裝備的代表，支撐和引領(lǐng)著信息化社會的新興產(chǎn)業(yè).工業(yè)機器人發(fā)展成熟，應(yīng)用范圍廣，技術(shù)不斷創(chuàng)新發(fā)展，使得機器人在各個行業(yè)領(lǐng)域迅速發(fā)展.其中串聯(lián)機器人不但在傳統(tǒng)機加工作業(yè)中廣泛應(yīng)用，而且在精密，裝配，檢驗等作業(yè)中快速發(fā)展[1,2].

針對串聯(lián)機器人的運動學(xué)求解，牛頓-歐拉法、拉格朗日法、凱恩法等是研究機器人動力學(xué)的經(jīng)典方法.很多學(xué)者進行過深入研究，樓健人，馬文建等[3,4]重點分析了解析解法、趙靈宣等[5]分析了幾何解法、Mitchell M．Tseng等[6]分析了迭代法、符號求解法及數(shù)值方法.但析解法對科研設(shè)計人員要求較高，計算量巨大，耗時費力，并且求解條件較理想化，在實際生產(chǎn)中均較難實現(xiàn).另外，在機器人編程和軌跡規(guī)劃中，由于應(yīng)用解析解都會求出多組解，還要再從中求出最優(yōu)解.針對上述問題，科研人員也逐步使用動力學(xué)仿真分析技術(shù)進行分析研究，比如應(yīng)用ADAMS軟件在機器人最大載荷的附近仿真空間的跟蹤軌跡[5]；應(yīng)用MATLAB軟件對簡化后的模型進行動力學(xué)分析與仿真[6].

本文以PUMA560串聯(lián)機器人為例，建立空間坐標系，對串聯(lián)機器人進行關(guān)節(jié)結(jié)構(gòu)分析，使用拉格朗日分析法進行運動學(xué)分析.根據(jù)影響系數(shù)理論，建立了一種運動評價方法，引入速度及加速度性能指標，用范數(shù)評價位姿精度，為運動性能評價提供一種理論基礎(chǔ).根據(jù)ADAMS求解串聯(lián)機器人運動軌跡與運動物理參量，分析討論機器人執(zhí)行機構(gòu)的運動特性.為機器人運動精度、噪聲振動分析及故障診斷等進一步深入研究打下理論基礎(chǔ).

1 串聯(lián)機器人結(jié)構(gòu)與坐標系

PUMA560是美國Unimation公司早期生產(chǎn)的6自由度串聯(lián)結(jié)構(gòu)的機器人，是一種經(jīng)典的、常用的、串聯(lián)式的工業(yè)機器人，屬于多關(guān)節(jié)旋轉(zhuǎn)式的機器人，以此為模型，常用在焊接、裝配、搬運等工業(yè)生產(chǎn)中.以PUMA560為研究對象，分析工業(yè)用串聯(lián)機器人，整體結(jié)構(gòu)包括基座、腰部、大臂、小臂、腕部等.機器人的腰部和大臂通過腰關(guān)節(jié)連接，大臂繞著肩關(guān)節(jié)實現(xiàn)旋轉(zhuǎn)，大臂和小臂通過肘關(guān)節(jié)連接，帶動小臂旋轉(zhuǎn)，通過腕關(guān)節(jié)，將運動傳遞給最終的執(zhí)行機構(gòu)，從而實現(xiàn)末端機械手的靈活操作，完成裝配、搬運等.

分析研究六自由度串聯(lián)機器人運動特性，串聯(lián)機器人由6個轉(zhuǎn)動關(guān)節(jié)帶動6個連桿組成，其中3個關(guān)節(jié)用來確定空間位置，另外3個關(guān)節(jié)用來確定空間姿態(tài)[7].根據(jù)D-H法則，指定各個連桿坐標系，其中旋轉(zhuǎn)關(guān)節(jié)zi軸沿各關(guān)節(jié)軸向，旋轉(zhuǎn)方向依據(jù)右手定則確定，xi指向下一個關(guān)節(jié)的方向，建立串聯(lián)機器人連桿坐標系[8]如圖1所示.

圖1 PUMA560機器人連桿坐標系

其中串聯(lián)機器人的底座和腰構(gòu)成轉(zhuǎn)動關(guān)節(jié)1(JOINT_1)，腰和大臂構(gòu)成轉(zhuǎn)動關(guān)節(jié)2(JOINT_2)，大臂和小臂構(gòu)成關(guān)節(jié)3(JOINT_3)，小臂和手腕1構(gòu)成轉(zhuǎn)動關(guān)節(jié)4(JOINT_4)，手腕1和手腕2構(gòu)成轉(zhuǎn)動關(guān)節(jié)5(JOINT_5)，手腕2和手腕3構(gòu)成轉(zhuǎn)動關(guān)節(jié)6(JOINT_6).

利用UG三維建模軟件建立串聯(lián)機器人模型時，根據(jù)研究重點，簡化模型，體現(xiàn)串聯(lián)機器人結(jié)構(gòu)特點即可.忽略不影響傳動性能的圓角、倒角等細節(jié)特征，從而提高計算效率.根據(jù)上述串聯(lián)機器人結(jié)構(gòu)尺寸參數(shù)，建立手臂關(guān)節(jié)模型，完成虛擬裝配.在UG環(huán)境下，檢查裝配質(zhì)量，經(jīng)過靜態(tài)干涉檢測，檢驗零部件的功能性需求.經(jīng)過動態(tài)干涉檢測，檢驗各零部件之間裝配干涉以及合理性需求.經(jīng)過虛擬裝配，最終得到串聯(lián)機器人模型如圖2所示.

圖2 PUMA560機器人虛擬樣機模型

2 串聯(lián)機器人動力學(xué)分析

q=[θ1θ2θ3θ4θ5θ6]T

(1)

T=[T1T2T3T4T5T6]T

(2)

(3)

(4)

(5)

(6)

式(6)中：Uij、Uik是變換矩陣關(guān)于關(guān)節(jié)轉(zhuǎn)動角度的導(dǎo)數(shù)；Ji、Ii是偽慣量矩陣和驅(qū)動器轉(zhuǎn)動慣量.

(7)

應(yīng)用拉格朗日方程L=K-P最終得

(8)

i+1ωi+1×(i+1ωi+1×i+1rCi+1)

(11)

(13)

(15)

τi=iniT·izi

(16)

3 串聯(lián)機器人運動性能評價指標

(17)

1≤m≤n≤6

(18)

速度矢量VH，加速度矢量AH如下：

(19)

AH=[εh…ap]T

(20)

速度性能指標分析，υ是各桿件的輸出速度組合矢量，定義串聯(lián)機器人連桿速度性能指標為KG,‖G‖為矩陣G的范數(shù).

(21)

KG=‖G‖‖G-1‖

(22)

加速度性能指標分析，a是各桿件的輸出速度組合矢量， 定義串聯(lián)機器人連桿速度性能指標為KH.

(23)

(24)

4 ADAMS運動仿真分析

根據(jù)實驗要求，將UG建立的三維模型，導(dǎo)入ADMAS軟件，進行動力學(xué)仿真.串聯(lián)機器人大臂a2長度為400 mm，小臂d4長度為420 mm.腕部長度d6為55mm，腰部d2長度為150 mm.

ADAMS軟件設(shè)置仿真設(shè)置持續(xù)時間9 s，步數(shù)為1 000步.定義機器人逐步的進行階躍式運動，調(diào)用ADAMS階躍驅(qū)動函數(shù)STEP(x,Begin At,Initial Function Value,End At,Final Function Value)，對各個關(guān)節(jié)分別定義如表1所示.

表1 串聯(lián)機器人各個關(guān)節(jié)階躍驅(qū)動函數(shù)定義

運動仿真結(jié)束后，通過ADAMS后處理模塊，通過調(diào)用模塊ADAMS/PostProcessor實現(xiàn)獨立后處理，通過回放仿真結(jié)果，并對結(jié)果進行進一步分析并繪制曲線，完成數(shù)學(xué)和統(tǒng)計計算，真實反映虛擬樣機的特性.對6自由度串聯(lián)機器人進行分析，可得到各個部件位移、速度、加速度圖像如圖3所示；各關(guān)節(jié)力與力矩圖像如圖4所示.

(a)手腕1運動曲線

(b)手腕2運動曲線

(c)手腕3運動曲線

(d)手腕1、2、3加速度曲線

(e)小臂運動曲線

(f)大臂運動曲線圖3 串聯(lián)機器人運動學(xué)仿真圖像

分析手腕仿真曲線(如圖3所示)，可以得到如下結(jié)論：三個手腕的速度、位移和加速度三者(a),(b),(c)圖像基本相同，但有細微差別.由三個手腕的加速度曲線可得如下結(jié)論：在5秒以內(nèi)，三個手腕加速度圖像均產(chǎn)生明顯的大幅度振動，在5秒后迅速趨于穩(wěn)定，8秒后穩(wěn)定在恒值.并且手腕3的振動幅度明顯比手腕2和手腕1大.由此表明，越靠近執(zhí)行機構(gòu)末端，手腕的穩(wěn)定性越差.機器人在執(zhí)行工作命令時，擺動過程中手臂均會產(chǎn)生小范圍抖動，會對執(zhí)行機構(gòu)的位置精度造成誤差.但在5秒后，機器人末端開始工作時，手腕基本穩(wěn)定.表明該機器人工作時具有較好的穩(wěn)定性，同時也驗證了運動仿真合理有效.

(a)關(guān)節(jié)1力與力矩曲線

(b)關(guān)節(jié)2力與力矩曲線

(c)關(guān)節(jié)3力與力矩曲線

(d)關(guān)節(jié)4力與力矩曲線

(e)關(guān)節(jié)5力與力矩曲線

(f)關(guān)節(jié)6力與力矩曲線圖4 串聯(lián)機器人力學(xué)仿真圖像

分析手臂仿真曲線(如圖3所示)，可以得到如下結(jié)論：在1秒內(nèi)，大臂和小臂加速度達到峰值后逐步衰減至0，并且小臂加速度峰值較大.雖然在1秒內(nèi)，只有腰部相對基座產(chǎn)生轉(zhuǎn)動，小臂和大臂均為產(chǎn)生相對轉(zhuǎn)動，但遠離腰部的小臂加速度相對較大，符合實際.1秒到3秒內(nèi)，大臂與小臂均出現(xiàn)相同波形和振動.3秒后大臂穩(wěn)定，表明只有小臂運動時，大臂與基座的穩(wěn)定性較好.由于模型裝配是理想裝配，沒有帶入裝配間隙和制造誤差，曲線平滑過渡，而沒有產(chǎn)生劇烈波動.同時發(fā)現(xiàn)為了降低機器人執(zhí)行機構(gòu)的振動與誤差，提高關(guān)節(jié)的裝配精度與關(guān)節(jié)控制的穩(wěn)定性，顯得尤為重要.

分析關(guān)節(jié)仿真曲線(如圖4所示)，可以得到如下結(jié)論： 6個關(guān)節(jié)均受到類似正弦規(guī)律的力的作用，關(guān)節(jié)作用力在1秒內(nèi)迅速上升，并在0.5秒時達到峰值后開始衰減至0.關(guān)節(jié)在1到3秒，3到5秒均會產(chǎn)生明顯的作用力.并且關(guān)節(jié)1和關(guān)節(jié)2作用力的曲線會產(chǎn)生小幅度鋸齒狀振動，其余關(guān)節(jié)作用力曲線較光滑.另外關(guān)節(jié)1和關(guān)節(jié)2在5秒內(nèi)力矩曲線會產(chǎn)生大幅度振動.表明機器人工作時，與基座連接的關(guān)節(jié)穩(wěn)定性相對較差，遠端執(zhí)行機構(gòu)的穩(wěn)定性相對較好，滿足執(zhí)行機構(gòu)工作時的穩(wěn)定性，符合設(shè)計需要.

根據(jù)三維模型，利用ADMAS進行運動仿真分析，清晰精確的得到構(gòu)件的運動規(guī)律，符合階躍驅(qū)動函數(shù)STEP對于各個關(guān)節(jié)的驅(qū)動函數(shù)定義，仿真圖像與理論和實際運動狀態(tài)吻合.有效證明了ADMAS運動仿真是保證結(jié)果重要有效步驟.借助仿真軟件求解可以大大簡化求解過程，方便研究人員進行開發(fā)設(shè)計，同時也可以輔助高校教師對機器人相關(guān)專業(yè)進行理論教學(xué)工作.

4 結(jié)論

本文對六自由度工業(yè)串聯(lián)機器人進行運動學(xué)研究和運動性能評價.本文以PUMA560串聯(lián)機器人為例，進行運動學(xué)分析.運用空間坐標系，采用拉格朗日法對串聯(lián)機器人進行動力學(xué)研究.利用影響系數(shù)理論分析運動性能評價指標，推導(dǎo)出速度和加速度性能評價指標，為運動性能評價提供一種理論基礎(chǔ).利用UG建立機器人三維模型，裝配虛擬樣機，利用ADMAS動力學(xué)軟件，求解串聯(lián)機器人運動軌跡與運動物理參量，簡化運算過程，提高工作效率.

[1] 李增剛.ADAMS入門詳解與實例[M].北京：國防工業(yè)出版社,2010.

[2] 劉義翔,李瑞峰,李東婉.應(yīng)用ADAMS軟件對點焊機器人大臂機構(gòu)進行動力學(xué)仿真研究[J].哈爾濱商業(yè)大學(xué)學(xué)報(自然科學(xué)版),2001,17(3)：63-66.

[3] 樓健人,張樹有,譚建榮,等．面向 DFMC 的產(chǎn)品配置設(shè)計技術(shù)研究[J].中國機械工程, 2004,15(1)：42-44,49.

[4] 馬文建,劉 偉,李傳昭.并行產(chǎn)品開發(fā)中設(shè)計活動間重疊與信息交流[J].計算機集成制造系統(tǒng),2008,14(4)：630-636.

[5] 趙靈宣,檀潤華,張換高,等.基于產(chǎn)品平臺的產(chǎn)品配置方法研究[J].機械設(shè)計與制造, 2008(6)：213-215.

[6] Jianxin Jiao,Mitchell M.Tseng.Customizability analysis indesign for mass customization[J].Computer-Aided Design,2004(36)： 745-757.

[7] 邢葆軼.基于 QNX 的七自由度機械臂控制系統(tǒng)設(shè)計[D].沈陽: 沈陽理工大學(xué),2013.

[8] 孫志禮,姬廣振.機構(gòu)運動可靠性設(shè)計與分析技術(shù)[M].北京：國防工業(yè)出版社,2015：80-125.

[9] 王殿君,關(guān)似玉,陳 亞,等.六自由度搬運機器人動力學(xué)分析及仿真[J].機械設(shè)計與制造,2017(1):25-29.

[10] 崔敏其.SCARA 機器人的拉格朗日動力學(xué)建模[J].機械設(shè)計與制造,2013(12)：76-78.

[11] 蔡自興.機器人學(xué)[M].北京:清華大學(xué)出版社,2009:122-125.

[12] 羅建國,何茂艷,陸 震,等.基于UG的串并聯(lián)機器人ADAMS運動學(xué)仿真[J].機械設(shè)計,2007,24(4):5- 8.

[13] Herman P.On using generalized velocity components for manipulator dynamics and control[J].Mechanics Research Communications，2006,33(3):281-291.

[14] 李慶齡,趙永生.六自由度工業(yè)機器人動力學(xué)分析與仿真[J].上海電機學(xué)院學(xué)報,2008,11(4):275-278.

[15] 魏 武,袁銀龍,王新梅. 基于影響系數(shù)原理的六足機器人運動狀態(tài)分析[J].系統(tǒng)工程與電子技術(shù),2016,38(2):375-381.

[16] 朱鑫翔,許德章.基于運動學(xué)性能的串聯(lián)機器人評價矩陣的建立及分析[J].蚌埠學(xué)院學(xué)報,2017,6(4):21-30.