模塊化協(xié)作機器人運動特性分析及動力學(xué)仿真研究

馬國慶，劉麗，于正林，曹國華

（長春理工大學(xué) 機電工程學(xué)院，長春 130022）

模塊化協(xié)作機器人運動特性分析及動力學(xué)仿真研究

馬國慶，劉麗，于正林，曹國華

（長春理工大學(xué) 機電工程學(xué)院，長春 130022）

針對UR10模塊化協(xié)作機器人的構(gòu)型特點，采用D-H坐標變換法建立其運動學(xué)坐標系，采用逆變換法對機器人進行逆運動學(xué)求解，求得各個關(guān)節(jié)轉(zhuǎn)角。運用拉格朗日法對UR機器人進行動力學(xué)分析，利用ADAMS多體動力學(xué)仿真軟件對其進行動力學(xué)仿真。結(jié)果證明，該模塊化協(xié)作機器人具有良好的靜態(tài)平衡性能、運動穩(wěn)定性和動態(tài)響應(yīng)特性。

模塊化協(xié)作機器人；運動特性分析；動力學(xué)仿真

隨著科技的進步，人機協(xié)作機器人技術(shù)得到了飛速的發(fā)展，特別是機器人十三五產(chǎn)業(yè)規(guī)劃的出臺，已將模塊化協(xié)作機器人作為一個重點發(fā)展領(lǐng)域。模塊化機器人的研究可追溯到1988年卡納基梅隆大學(xué)推出的模塊化機械手系統(tǒng)（RMMS），RMMS不僅實現(xiàn)了機械結(jié)構(gòu)的可重構(gòu)，而且實現(xiàn)了控制算法、電子軟硬件的可重構(gòu)［1］。德宇航中心（DLR）為了增強機器人的空間操作的靈活性，采用完全模塊化的設(shè)計思想設(shè)計了具有7個自由度的第三代輕型臂，它的驅(qū)動部分采用了經(jīng)過DLR優(yōu)化設(shè)計的高性能ROBO Drive電機，該電機的重量和功耗只有商業(yè)電機的一半，最大關(guān)節(jié)速度約10deg/sec［2］。丹麥UR機器人公司采用直流電機帶動諧波減速器的傳動方式進行運動，關(guān)節(jié)外殼采用鋁質(zhì)材料大大減輕了機器人的重量，并且每個關(guān)節(jié)采用中空軸布線的方式，避免了由于關(guān)節(jié)的高速運轉(zhuǎn)而產(chǎn)生的電纜纏繞。UR機器人具有力反饋功能，通過測量關(guān)節(jié)中的電流來控制力量和動作，一旦發(fā)生碰撞，機器人就自動停止工作。因此在大多數(shù)應(yīng)用中都無需安全圍欄，是協(xié)作機器人的典范［3］。國內(nèi)方面哈爾濱工業(yè)大學(xué)推出的模塊化5自由度服務(wù)型機器人手臂，可實現(xiàn)大臂的擺動和回轉(zhuǎn)、小臂回轉(zhuǎn)、肘關(guān)節(jié)的擺動和末端手爪的張合［4］。北京遨博智能作為國內(nèi)協(xié)作機器人的黑馬，研制的i5人機安全協(xié)作機器人，具有先進的力控功能，能與操作者近距離協(xié)同作業(yè)，目前已進入批量化生產(chǎn)階段［5］。

本文以UR10機器人為研究對象，首先采用DH坐標變換法建立機器人的連桿坐標系，進而采用逆變換法對機器人進行逆運動學(xué)求解，求得各個關(guān)鍵轉(zhuǎn)角。運用拉格朗日法對UR機器人進行動力學(xué)分析，利用ADAMS多體動力學(xué)仿真軟件對其進行動力學(xué)仿真，驗證所推導(dǎo)動力學(xué)模型的正確性。

1 運動學(xué)求解

運動學(xué)的求解過程并不考慮各桿件之間的相互作用力，只研究其運動的關(guān)系。正運動學(xué)問題是在已知各關(guān)節(jié)角及桿件尺寸的基礎(chǔ)上，求解末端執(zhí)行器在基坐標系下的位姿，其實質(zhì)是運動學(xué)方程式的建立和求解。逆運動學(xué)問題是在已知桿件的幾何參數(shù)和末端執(zhí)行器相對于基坐標系的期望位姿，求取機器人末端執(zhí)行器達到此位姿時各關(guān)節(jié)角度值。

1.1 連桿坐標系建立

UR10是一款具有6個旋轉(zhuǎn)關(guān)節(jié)的串聯(lián)機器人，為清晰地表明該機器人各連桿之間的位姿關(guān)系，可采用D-H坐標變換法［6］進行建模，步驟如下：（1）建立基坐標系x0y0z0并確定初始位姿；（2）根據(jù)D-H坐標原則建立其余關(guān)節(jié)坐標系；（3）機器人工具坐標系為x6y6z6；機器人D-H坐標系如圖1所示。

圖1 UR10機器人D-H坐標系

1.2 正運動學(xué)求解

建立各關(guān)節(jié)坐標系之后，根據(jù)相鄰關(guān)節(jié)坐標系間的轉(zhuǎn)換關(guān)系，可確定關(guān)節(jié)和連桿的D-H參數(shù)，UR10機器人的各個關(guān)節(jié)均為轉(zhuǎn)動關(guān)節(jié)，所以只有關(guān)節(jié)角θ是變量，關(guān)節(jié)扭角α、連桿長度a、連桿距離d均為固定值，UR機器人的D-H參數(shù)如表1所示。

表1UR10機器人D-H參數(shù)表

機器人相鄰關(guān)節(jié)坐標系間轉(zhuǎn)換矩陣如式（1）示。i-1Ti=Rot(z,θi)×Trans(0,0,di)×Trans(ai,0,0)×Rot(x,αi)

將表1中D-H參數(shù)代入式（1），得到相鄰關(guān)節(jié)坐標系間的轉(zhuǎn)換矩陣，再將得到的變換矩陣依次相乘，即可求得UR機器人的運動學(xué)正解如式（2）所示。（ci=cosθi,si=sinθi,cijk=cos(θi+θj+θk),sijk= sin(θi+θj+θk)i=1…6,j=1…6,k=1…6，下同）。

1.3 逆運動學(xué)求解

根據(jù)UR10機器人的構(gòu)型特點可知，該機器人的第二、三、四關(guān)節(jié)軸平行，滿足三個相鄰關(guān)節(jié)軸平行或者相較于一點這個條件，所以UR機器人運動學(xué)的逆解存在。

（1）求解θ1

取其中第3行的轉(zhuǎn)置

式（3）和式（4）矩陣第3行第4列對應(yīng)相等，得

將上述方程作如下三角代換

（2）求解θ5

式（3）和式（4）矩陣的第3行第3列及第3行第3列分別對應(yīng)相等，得

（3）求解θ6

式（3）和式（4）矩陣的第3行第1列及第3行第1列分別對應(yīng)相等，得

（4）求解θ2

其第2列、第3列和第4列元素分別為：

可得

（5）求解θ3

式（8）和式（9）矩陣的第2行第3列及第2行第4列分別對應(yīng)相等，得

（6）求解θ4

1.4 解的對應(yīng)關(guān)系

在理論上通過逆解可得到機器人的8組關(guān)節(jié)角度值，但在實際的控制系統(tǒng)中，由于桿件間存在物理干涉以及運動連續(xù)性的要求，往往只存在一組最優(yōu)的可行解。采用最短行程原則進行擇優(yōu)，其算法流程如圖2所示，θcm表示機器人當前第m關(guān)節(jié)坐標，θnm表示機器人逆解第n組第m關(guān)節(jié)坐標，其中n=1,2,…8;m=1,2,…6。

圖2 最短行程原則算法流程圖

2 模塊化機器人動力學(xué)方程的建立

研究機器人動力學(xué)的方法很多，主要有牛頓-歐拉法（Newton-Euler）、拉格朗日法（Lan-grange）、高斯（Gauss）法、凱恩（Kane）法及羅伯遜-魏登堡（Robson-Wittenburg）法等。本文采用常用的拉格朗日方法來建立該機器人的動力學(xué)方程。

隨著掌聲的響起，我們班的總結(jié)會和頒獎結(jié)束了，但興奮和感動卻永遠留在了大家心間，溫暖著彼此的心，激勵著大家不斷前進。

機器人的拉格朗日方程為

式中，qi，是系統(tǒng)的廣義坐標和廣義速度；Qi為對應(yīng)廣義坐標的廣義力。

設(shè)機器人的第i關(guān)節(jié)質(zhì)心在基礎(chǔ)坐標系中的平移速度向量為vci、角速度向量為ωi、質(zhì)量為mi、相對質(zhì)心的慣性張量為Ii，則第i關(guān)節(jié)的動能為

其中，第一項為平移運動時物體的動能，第二項為繞質(zhì)心旋轉(zhuǎn)時物體的動能。

第i關(guān)節(jié)在基礎(chǔ)坐標系中的速度與第i關(guān)節(jié)以及之前各關(guān)節(jié)速度之間的關(guān)系可以表示為

其中，Mij是n階方陣M的元素，

因為關(guān)節(jié)為轉(zhuǎn)動關(guān)節(jié)，所以機器人的總動能為

其中，g為基礎(chǔ)坐標系下的重力加速度向量，OPci為基礎(chǔ)坐標系中由坐標原點到桿i質(zhì)心的向量。

其中，τ和F分別表示關(guān)節(jié)力向量和末端執(zhí)行器與外界環(huán)境的接觸力向量。

將機器人的動能、勢能和廣義力代入拉格朗日方程，可得機器人動力學(xué)方程

通過上式可以看出利用理論推導(dǎo)求解機器人的動力學(xué)方程的計算比較復(fù)雜，所以一般采用多體動力學(xué)仿真的方法來完成機器人各關(guān)節(jié)的力或力矩的求解。

3基于ADAMS機器人動力學(xué)仿真平臺建立

3.1 仿真平臺的前處理

導(dǎo)入模型前，需要設(shè)置工作環(huán)境，首先對單位進行設(shè)置，選擇系統(tǒng)默認狀態(tài)下的坐標系為地面坐標系，其次按照正確的裝配關(guān)系設(shè)置重力的方向。在Solidworks中建立好UR機器人的三維模型后，要將此模型導(dǎo)入到ADAMS的前處理器ADAMS/View中，由于Solidworks直接輸出的格式并不適用于直接使用，所以采取在Solidworks中輸出parasolid格式，然后再將此格式的模型導(dǎo)入到ADAMS/View中。將模型導(dǎo)入后，需要手動加載各關(guān)節(jié)零件的材料屬性，保持質(zhì)量、重心及轉(zhuǎn)動慣量不變，為了物理量加載及后續(xù)約束加載方便，可利用布爾組合命令，將機器人中相互固定的零件設(shè)置為同一零件。

3.2 仿真平臺的構(gòu)建

添加完約束后，為了使機器人能夠按照實際情況進行運動，還需要在各個關(guān)節(jié)處添加驅(qū)動，然后在各個驅(qū)動中寫入位移-時間控制參數(shù)來對各個關(guān)節(jié)的運動進行控制。添加完驅(qū)動后即可對機器人進行仿真。根據(jù)機器人運動的情況，可以將驅(qū)動速度設(shè)定為勻加速-勻速-勻減速的工況，運用STEP函數(shù)即可實現(xiàn)此功能［7］。下面是對各關(guān)節(jié)的STEP函數(shù)設(shè)定。

（1）第一關(guān)節(jié)轉(zhuǎn)動控制函數(shù)

STEP（time，0，0，0.5，72d）+STEP（time，0.5，0，5.5，0）+STEP（time，5.5，0，6，-72d），

（2）第二關(guān)節(jié)轉(zhuǎn)動控制函數(shù)

STEP（time，0，0，1，40d）+STEP（time，1，0，9，0）+STEP（time，9，0，10，-40d）

（3）第三關(guān)節(jié)轉(zhuǎn)動控制函數(shù)

STEP（time，0，0，1，40d）+STEP（time，1，0，9，0）+STEP（time，9，0，10，-40d）

（4）第四關(guān)節(jié)轉(zhuǎn)動控制函數(shù)

STEP（time，0，0，1，50d）+STEP（time，1，0，7，0）+STEP（time，7，0，8，-50d）

（5）第五關(guān)節(jié)轉(zhuǎn)動控制函數(shù)

STEP（time，0，0，1，60d）+STEP（time，1，0，6，0）+STEP（time，6，0，7，-60d）

（6）第六關(guān)節(jié)轉(zhuǎn)動控制函數(shù)

STEP（time，0，0，1，80d）+STEP（time，1，0，5，0）+STEP（time，5，0，6，-80d）

由于機器人在運動時會產(chǎn)生摩擦，所以在六個轉(zhuǎn)動副處添加摩擦，在第六關(guān)節(jié)處添加負載，將時間設(shè)定為5s，步數(shù)設(shè)定為500，之后開始進行動力學(xué)仿真工作，其運動狀態(tài)如圖3所示。

圖3 機器人動力學(xué)仿真參數(shù)

通過對整個機器人動力學(xué)仿真過程的分析，可以看出機器人在運動過程沒有出現(xiàn)運動干涉的現(xiàn)象，證明該協(xié)作機器人結(jié)構(gòu)設(shè)計合理，各關(guān)節(jié)及連桿的布置對機器人的運動沒有影響。

4 基于ADAMS的機器人動力學(xué)仿真分析

4.1 機器人各關(guān)節(jié)角速度的測量

機器人各關(guān)節(jié)角速度是動力學(xué)中的重要參數(shù)，對機器人的整體結(jié)構(gòu)設(shè)計有著十分重要的作用，因此在仿真過程中需要測量各個關(guān)節(jié)的角速度變化情況。根據(jù)3.2節(jié)確定的各關(guān)節(jié)角速度數(shù)值，利用STEP函數(shù)設(shè)定后，得到各關(guān)節(jié)角速度曲線如圖4所示。

圖4 機器人各關(guān)節(jié)的角速度曲線

從各關(guān)節(jié)角速度曲線圖中可以看出，機器人在整個動力學(xué)仿真過程中，各關(guān)節(jié)的角速度變化情況符合設(shè)定的勻加速啟動-勻速運行-勻減速制動的工作狀況，并且在加速階段和減速階段的過渡比較平穩(wěn)，沒有突變的現(xiàn)象，機器人各關(guān)節(jié)的運行比較符合實際情況，不會對機器人的整體性能造成影響。

4.2 機器人各關(guān)節(jié)動能的測量

由于機器人各關(guān)節(jié)的運動慣性大，運行平穩(wěn)性較差，實現(xiàn)低速啟動，高速運轉(zhuǎn)，低速停止的狀態(tài)比較困難，所以需要研究各關(guān)節(jié)在動力學(xué)仿真中動能的變化情況。根據(jù)3.2中的參數(shù)設(shè)定后，仿真得到各關(guān)節(jié)動能曲線如圖5所示。

圖5 機器人各關(guān)節(jié)動能

由圖5可以看出，各關(guān)節(jié)的動能曲線可以看出大約在1.5s左右各關(guān)節(jié)的動能達到最大值，此時各關(guān)節(jié)都已經(jīng)進入勻速運動狀態(tài)，并且關(guān)節(jié)速度都達到了最大值，各關(guān)節(jié)的運動比較平穩(wěn)，沒有產(chǎn)生大的震動，符合運動的需求。

4.3 機器人各關(guān)節(jié)力和力矩的測量

各關(guān)節(jié)所受的力和力矩也是機器人動力學(xué)仿真中的重要參數(shù)。通過測量各關(guān)節(jié)所受的力矩可以驗證選擇的驅(qū)動電機扭矩是否符合要求，同時也可以驗證選擇的諧波減速器的減速比和力矩是否符合設(shè)計要求，所以動力學(xué)仿真在機器人的設(shè)計中有著非常重要的作用，UR10機器人各關(guān)節(jié)受力和所受力矩情況如圖6所示，UR10機器人各關(guān)節(jié)可承受的力矩值如表2所示。

圖6 各關(guān)節(jié)受力和所受力矩情況

表2 UR10機器人各關(guān)節(jié)可承受的力矩值

由圖6可以看出，機器人在運動過程中各關(guān)節(jié)的受力和所受力矩情況均在表2所示的UR10機器人各關(guān)節(jié)能承受的力矩范圍內(nèi)，符合運動的需求。

5 結(jié)論

針對UR10模塊化協(xié)作機器人的構(gòu)型特點，采用D-H坐標變換法建立其運動學(xué)坐標系，采用逆變換法對機器人進行逆運動學(xué)求解，求得各個關(guān)節(jié)轉(zhuǎn)角。運用拉格朗日法對UR機器人進行動力學(xué)分析，利用ADAMS多體動力學(xué)仿真軟件對其進行動力學(xué)仿真。結(jié)果證明，該模塊化協(xié)作機器人具有良好的靜態(tài)平衡性能、運動穩(wěn)定性和動態(tài)響應(yīng)特性。

［1]Chen L M，Yang G，Kang In-Gyu.Numerical inverse kinematics for modular reconfigurable robots［J］.Journal of robotic Systems，1999，16（4）：213-225.

［2]Hirzinger G，Sporer N，Albu-Schaffer，et al.DLR’s torque-controlled light weight robot II-Are we reach?ing the technological limits now［C］.Proceedings of the IEEE International Conference on Robotics and Auto?mation，Washington，2002（2）：1710-1716.

［3]劉昆，李世中，王寶祥.基于UR機器人的直接示教系統(tǒng)研究［J］.科學(xué)技術(shù)與工程，2015，15（28）：22-26.

［4]付大鵬.服務(wù)機器人手臂模塊化關(guān)節(jié)的研制［D］.哈爾濱：哈爾濱工業(yè)大學(xué)，2008.

［5]于慧.布局高端裝備-盾安環(huán)境發(fā)布新型人機協(xié)作機器人［N］.中國工業(yè)報，2015-11-30B04.

［6]何慶稀，游震洲，孔向東.一種基于位姿反饋的工業(yè)機器人定位補償方法［J］.中國機械工程，2016，27（7）：872-876.

［7]陳正水，鄧益民.基于UG的STEP運動仿真函數(shù)對運動時間的控制分析［J］.寧波大學(xué)學(xué)報：理工版，2012，25（4）：103-106.

Movement Characteristics Analysis and
Dynamic Simulation of Modular Collaborative Robot

MA Guoqing，LIU Li，YU Zhenglin，CAO Guohua
（School of Mechatronical Engineering，Changchun University of Science and Technology，Changchun 130022）

For configurational characteristics of UR10 robot，the D-H coordinate transformation method is adopted to establish the kinematics coordinate system，the inverse transform method was used to solve the inverse kinematics of the robot，each joint angle is obtained.Lagrange method was used to analysis the dynamics of UR robot，multibody dynamics simulation software AD?AMS was used to its dynamic simulation.The results show that the modular Collaborative robot has good static balance of perfor?mance，stability and dynamic response of the motion.

modular collaborative robot；movement characteristics analysis；dynamic simulation

TP242

A

1672-9870（2017）02-0064-06

2016-09-13

國家高技術(shù)研究發(fā)展計劃（863計劃）資助項目（2015AA7060112）；吉林省科技發(fā)展計劃資助項目（20160204016GX）；吉林省省級產(chǎn)業(yè)創(chuàng)新專項資金資助項目（2016C088）；長春理工大學(xué)青年科學(xué)基金（XQNJJ-2016-04）

馬國慶（1988-），男，博士研究生，講師，E-mail：magq@cust.edu.cn

于正林（1971-），男，教授，博士生導(dǎo)師，E-mail：contribute_yu@126.com