一種六自由度工業(yè)機(jī)器人運(yùn)動(dòng)學(xué)分析及三維可視化仿真

高　藝　馬國(guó)慶　于正林　曹?chē)?guó)華

長(zhǎng)春理工大學(xué)，長(zhǎng)春，130022

?

一種六自由度工業(yè)機(jī)器人運(yùn)動(dòng)學(xué)分析及三維可視化仿真

高藝馬國(guó)慶于正林曹?chē)?guó)華

長(zhǎng)春理工大學(xué)，長(zhǎng)春，130022

摘要：針對(duì)Motoman-HP20機(jī)器人的構(gòu)型特點(diǎn)，采用D-H坐標(biāo)變換法建立其運(yùn)動(dòng)學(xué)坐標(biāo)系，將機(jī)器人分解為位置結(jié)構(gòu)和姿態(tài)結(jié)構(gòu)，得到以位置矢量和歐拉角表示的完備廣義坐標(biāo)，利用位姿分離法對(duì)機(jī)器人進(jìn)行逆運(yùn)動(dòng)學(xué)求解，求得各個(gè)關(guān)鍵轉(zhuǎn)角。構(gòu)建了三維可視化仿真環(huán)境，驗(yàn)證所提出的運(yùn)動(dòng)學(xué)算法的正確性。該仿真環(huán)境可以直觀地觀察機(jī)器人各部分的運(yùn)動(dòng)情況。

關(guān)鍵詞：工業(yè)機(jī)器人；運(yùn)動(dòng)學(xué)分析；可視化仿真；軌跡規(guī)劃

0引言

從第一臺(tái)機(jī)器人Unimate誕生至今，經(jīng)過(guò)半個(gè)世紀(jì)的發(fā)展，工業(yè)機(jī)器人技術(shù)已相當(dāng)成熟，重復(fù)定位精度高、運(yùn)動(dòng)速度快、程序柔性好等優(yōu)點(diǎn)使其得到廣泛應(yīng)用[1]。但是市場(chǎng)上的商用工業(yè)機(jī)器人控制系統(tǒng)大都是對(duì)外封閉的，很少提供二次開(kāi)發(fā)的接口，這給具有特殊作業(yè)要求的機(jī)器人系統(tǒng)開(kāi)發(fā)和系統(tǒng)集成帶來(lái)了困難。對(duì)工業(yè)機(jī)器人運(yùn)動(dòng)學(xué)的研究可以有效地了解機(jī)器人的奇異點(diǎn)的存在情況以及運(yùn)動(dòng)過(guò)程中的干涉情況，為軌跡規(guī)劃提供技術(shù)基礎(chǔ)，因此研究工業(yè)機(jī)器人的運(yùn)動(dòng)學(xué)問(wèn)題非常必要[2-3]。

機(jī)器人的運(yùn)動(dòng)分析是實(shí)現(xiàn)機(jī)器人運(yùn)動(dòng)控制和軌跡規(guī)劃的基礎(chǔ)，它包括正運(yùn)動(dòng)學(xué)和逆運(yùn)動(dòng)學(xué)兩部分。目前，機(jī)器人正運(yùn)動(dòng)學(xué)的求解方法主要有D-H坐標(biāo)變換法和四元數(shù)法[4]；機(jī)器人逆運(yùn)動(dòng)學(xué)的求解方法主要有解析式法、幾何法以及智能算法[5]。隨著可視化技術(shù)的發(fā)展，越來(lái)越多的人將可視化仿真的方法應(yīng)用于機(jī)器人的運(yùn)動(dòng)學(xué)求解，從而直觀地監(jiān)控機(jī)器人各關(guān)節(jié)的運(yùn)動(dòng)情況。Corke[6]開(kāi)發(fā)了Robotics Toolbox機(jī)器人工具箱，該工具箱可實(shí)現(xiàn)機(jī)器人的運(yùn)動(dòng)仿真和軌跡規(guī)劃，但其連桿不能表達(dá)真實(shí)機(jī)器人的三維尺寸，在碰撞檢測(cè)方面的效果并不理想。李憲華等[7]以川崎FS03N機(jī)器人為研究對(duì)象，利用三維軟件完成該機(jī)器人的實(shí)體建模，編寫(xiě) SolidWorks軟件和MATLAB的接口函數(shù)，構(gòu)建基于MATLAB的3D仿真平臺(tái)，通過(guò)運(yùn)動(dòng)仿真的方式驗(yàn)證了運(yùn)動(dòng)學(xué)的正確性。

本文以Motoman-HP20機(jī)器人為研究對(duì)象，采用D-H坐標(biāo)變換法建立機(jī)器人的連桿坐標(biāo)系，得到以位置矢量和歐拉角表示的正運(yùn)動(dòng)學(xué)方程，通過(guò)臂腕位姿分離法對(duì)機(jī)器人進(jìn)行逆運(yùn)動(dòng)學(xué)求解，根據(jù)最短行程原則從多組逆解中選擇出最適合的一組解。最后基于Dmworks軟件構(gòu)建三維可視化仿真環(huán)境，驗(yàn)證運(yùn)動(dòng)學(xué)求解的正確性。

1運(yùn)動(dòng)學(xué)求解

與動(dòng)力學(xué)求解過(guò)程相比，運(yùn)動(dòng)學(xué)的求解過(guò)程并不考慮各桿件之間的相互作用力，只是研究其運(yùn)動(dòng)關(guān)系。正運(yùn)動(dòng)學(xué)問(wèn)題是：在已知各關(guān)節(jié)角及桿件尺寸的基礎(chǔ)上，求解工具坐標(biāo)系在基坐標(biāo)系下的位姿。逆運(yùn)動(dòng)學(xué)問(wèn)題是：在已知工具坐標(biāo)系相對(duì)于基坐標(biāo)系的期望位姿和桿件的幾何尺寸的情況下，求取機(jī)器人工具坐標(biāo)系達(dá)到此位姿時(shí)各個(gè)關(guān)節(jié)的角度值。

1.1連桿坐標(biāo)系的建立

Motoman-HP20是一款具有6個(gè)旋轉(zhuǎn)關(guān)節(jié)的串聯(lián)機(jī)器人，根據(jù)Motoman機(jī)器人的基坐標(biāo)系設(shè)置原則和標(biāo)準(zhǔn)D-H坐標(biāo)系建立準(zhǔn)則，該機(jī)器人基坐標(biāo)系x0y0z0的原點(diǎn)位于關(guān)節(jié)1的軸線上，同時(shí)也位于關(guān)節(jié)1軸線和關(guān)節(jié)2軸線的公垂線上，即二者的交匯處。依次建立各個(gè)關(guān)節(jié)處的坐標(biāo)系，x6y6z6為機(jī)器人工具坐標(biāo)系，其中后三個(gè)關(guān)節(jié)的坐標(biāo)系交匯于一點(diǎn)。機(jī)器人D-H坐標(biāo)系如圖1所示。

圖1　Motoman-HP20機(jī)器人D-H坐標(biāo)系

1.2正運(yùn)動(dòng)學(xué)求解

根據(jù)D-H坐標(biāo)系建立準(zhǔn)則可以確定圖1中相鄰兩個(gè)坐標(biāo)系之間的轉(zhuǎn)換關(guān)系，同時(shí)根據(jù)該機(jī)器人的幾何尺寸可確定機(jī)器人的D-H參數(shù)，如表1所示。對(duì)于關(guān)節(jié)型機(jī)器人而言，只有關(guān)節(jié)角βi為變量，兩關(guān)節(jié)軸扭角αi、連桿長(zhǎng)度ai、兩連桿間偏置距離di均為常量。

表1　HP20機(jī)器人D-H參數(shù)

機(jī)器人相鄰關(guān)節(jié)坐標(biāo)系間的轉(zhuǎn)換矩陣[8]為

i-1Ti=Rot(z,βi)·Trans(0,0,di)·

Trans(ai,0,0)·Rot(x,αi)=

(1)

式(1)表示的是相鄰兩個(gè)坐標(biāo)系之間的變換關(guān)系，將其順次相乘可以得到工具坐標(biāo)系在基坐標(biāo)系下的變換矩陣：

(2)

nx=c1[c23(c4c5c6-s4s6)-s23s4c6]+

s1(s4c5c6+c4s6)

ny=s1[c23(c4c5c6-s4s6)-

s23s4c6]-c1(s4c5c6+c4s6)

nz=-s23(c4c5s6-s4s6)+c23s4c6

s1(s4c5c6-c4c6)

c1(s4c5c6-c4c6)

oz=-s23(c4c5s6+s4c6)-c23s5s6

ax=c1(c23c4s5+s23c5)+s1s4s5

ay=s1(c23c4s5+s23c5)-c1s4s5

az=s23c4s5-c23c5

px=c1(a4c23+d4s23+a3c2+a2)

py=s1(a4c23+d4s23+a3c2+a2)

pz=a4s23-d4c23+a3s2

ci=cosβi,si=sinβi

cij=cos(βi+βj)

sij=sin(βi+βj)

i=1,2,…,6;j=1,2,…,6

式(2)即為運(yùn)動(dòng)學(xué)正解，將表1中D-H參數(shù)代入式(2)可求得相應(yīng)元素值。

由式(2)可以看出，該齊次變換矩陣包含了機(jī)器人工具坐標(biāo)系到基坐標(biāo)系的位姿信息，其中[noa]為姿態(tài)矩陣，p=(px,py,pz)為工具坐標(biāo)系的位置矢量。用齊次變換矩陣表示剛體的轉(zhuǎn)動(dòng)雖然簡(jiǎn)化了運(yùn)算，但需要9個(gè)元素來(lái)完全描述剛體的位姿，且它給出的是一組非完備的廣義坐標(biāo)。而在實(shí)際應(yīng)用中工業(yè)機(jī)器人的位姿一般采用一組完備的廣義坐標(biāo)(px,py,pz,φ,θ,ψ)來(lái)表示。歐拉角的轉(zhuǎn)動(dòng)矩陣表達(dá)式為

(3)

s=sin,c=cos

令式(2)中的姿態(tài)矩陣與歐拉角的轉(zhuǎn)動(dòng)矩陣(式(3))的元素對(duì)應(yīng)相等，得到一組完備的廣義坐標(biāo)(φ,θ,ψ)，求得

φ=arctan(ay/ax)

θ=arctan((axcφ+aysφ)/az)

ψ=arctan((nycφ-nxsφ)/(oycφ-oxsφ))

圖1所示的位姿為HP20機(jī)器人的機(jī)械零位，但通過(guò)D-H法建立的坐標(biāo)系關(guān)節(jié)角卻為(90°，90°，0°，0°，0°，0°)，因此在構(gòu)建三維可視化仿真環(huán)境的時(shí)候需要進(jìn)行轉(zhuǎn)換處理。

1.3逆運(yùn)動(dòng)學(xué)求解

根據(jù)HP20機(jī)器人構(gòu)型特點(diǎn)，其后3個(gè)關(guān)節(jié)坐標(biāo)系交匯于一點(diǎn)，故該機(jī)器人的位置僅由前3個(gè)關(guān)節(jié)變量決定，姿態(tài)僅由后3個(gè)關(guān)節(jié)變量決定。因此可采用位姿分離法來(lái)求解該機(jī)器人運(yùn)動(dòng)學(xué)的逆解。

(1)求解β1。將0T6=0T11T22T33T44T55T6左右兩邊各左乘(0T1)-1，則有

(0T1)-10T6=

(4)

令

(5)

取其中第4列

由于式(4)和式(5)矩陣第2行第4列對(duì)應(yīng)相等，所以有

-s1px+c1py=0

(6)

則β1=arctan(py/px)。

(2)求解β3。由于式(4)和式(5)矩陣的第1行第4列及第3行第4列分別對(duì)應(yīng)相等，所以有

c1px+s1py=a4c23+d4s23+a3c2+a2

(7)

pz=a4s23-d4c23+a3s2

(8)

對(duì)式(6)～式(8)分別取平方然后相加可得

μ=ρcosηc3+ρsinηs3

(3)求解β2。將0T6=0T11T22T33T44T55T6左右兩邊各左乘(0T11T22T3)-1，得

3T44T55T6=

(9)

令

(10)

其第3列和第4列元素分別為

由于式(9)和式(10)矩陣的第1行第4列及第2行第4列分別對(duì)應(yīng)相等，所以有

a4=c1c23px+s1c23py+s23pz-a3c3-a2c23

-d4=-c1s23px+s1s23py+c23pz+a3s3+a2s23

β23=

可得β2=β23-β3。

(4)求解β4。由于式(9)和式(10)矩陣的第1行第3列及第3行第3列分別對(duì)應(yīng)相等，所以有

c4s5=c1c23ax+s1c23ay+s23az

s4s5=s1ax-c1ay

當(dāng)s5≠0時(shí)

當(dāng)s5=0時(shí)，關(guān)節(jié)4和關(guān)節(jié)6重合，機(jī)器人退化為5自由度，此時(shí)，β4可以為任意值，一般定義為當(dāng)前值。

(5)求解β5。將0T6=0T11T22T33T44T55T6左右兩邊左乘(0T11T22T33T4)-1，得

(11)

令

(12)

由于式(11)和式(12)矩陣的第1行第3列及第3行第3列分別對(duì)應(yīng)相等，所以有

s5=ax(c1c23c4+s1s4)+ay(s1c23c4-c1s4)+azs23c4

c5=c1s23ax+s1s23ay-azc23

β5=arctan(s5/c5)

(6)求解β6。由于式(11)和式(12)矩陣的第2行第1列及第2行第2列分別對(duì)應(yīng)相等，所以有

s6=nx(s1c4-c1c23s4)-ny(s1c23s4+c1c4)-nzs23s4

c6=ox(s1c4-c1c23s4)-oy(s1c23s4+c1c4)-ozs23s4

β6=arctan(s6/c6)

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

通過(guò)位姿分離變量法可得到該機(jī)器人的各關(guān)節(jié)角度值，共有可能的8組解。但是在實(shí)際的控制系統(tǒng)中，由于關(guān)節(jié)角度范圍等因素的限制，實(shí)際只能取其中的一組作為最終的可行解?？尚薪獾暮Y選原則主要有行程最短原則、能量消耗最小原則、運(yùn)動(dòng)最平穩(wěn)原則等，結(jié)合HP20機(jī)器人構(gòu)型特點(diǎn)，本文選取行程最短原則作為逆解篩選原則。最短行程原則算法流程如圖2所示，其中βcm表示機(jī)器人當(dāng)前第m關(guān)節(jié)的角度值，βnm表示機(jī)器人逆解第n組第m關(guān)節(jié)的角度值，n=1,2,…,8;m=1,2,…,6。

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

2三維可視化仿真環(huán)境的建立

機(jī)器人三維可視化仿真是借助于計(jì)算機(jī)技術(shù)和三維建模技術(shù)構(gòu)建起來(lái)的，它既能體現(xiàn)真實(shí)機(jī)器人的尺寸模型又具有真實(shí)機(jī)器人系統(tǒng)的運(yùn)動(dòng)學(xué)關(guān)系，可有效地驗(yàn)證運(yùn)動(dòng)學(xué)算法以及運(yùn)動(dòng)的可視化。

2.1三維模型的建立

三維建模軟件具有強(qiáng)大的建模功能，可解決通用編程語(yǔ)言構(gòu)建模型能力不強(qiáng)的問(wèn)題，根據(jù)HP20機(jī)器人的特點(diǎn)，嚴(yán)格按照真實(shí)機(jī)器人的尺寸進(jìn)行建模，將機(jī)器人模型分為7個(gè)部分，各部分如圖3所示。

圖3　機(jī)器人各部分模型

2.2三維可視化仿真環(huán)境的構(gòu)建

將圖3各部分模型分別導(dǎo)入DMworks軟件，然后創(chuàng)建包含運(yùn)動(dòng)學(xué)關(guān)系的機(jī)器人設(shè)備，根據(jù)連接關(guān)系依次插入從而完成整個(gè)機(jī)器人設(shè)備的創(chuàng)建，然后設(shè)置關(guān)節(jié)類(lèi)型和關(guān)節(jié)驅(qū)動(dòng)、設(shè)置轉(zhuǎn)角范圍和工具中心點(diǎn)(tool center point, TCP)坐標(biāo)，使其具有運(yùn)動(dòng)學(xué)的關(guān)系，三維仿真圖形界面如圖4所示。

圖4　三維可視化仿真界面

3基于三維可視化仿真的運(yùn)動(dòng)學(xué)算法驗(yàn)證

3.1正運(yùn)動(dòng)學(xué)算法驗(yàn)證

可視化仿真環(huán)境中機(jī)器人初始位姿為HP20機(jī)器人的機(jī)械零位，但通過(guò)D-H法建立的坐標(biāo)系關(guān)節(jié)角卻不全為0°，為使兩者統(tǒng)一，在構(gòu)建可視化平臺(tái)時(shí)進(jìn)行轉(zhuǎn)換處理。圖4中坐標(biāo)指示方向與圖1中基坐標(biāo)系方向完全一致。在可視化仿真平臺(tái)中選取5組特殊臂型來(lái)驗(yàn)證所提正運(yùn)動(dòng)學(xué)求解算法的正確性。5組臂型下機(jī)器人工具坐標(biāo)系在基坐標(biāo)系下位置矢量如表2所示，其臂型如圖5所示。

表2　正運(yùn)動(dòng)學(xué)驗(yàn)證數(shù)據(jù)

圖5　機(jī)器人幾種臂型

由表2可看出： ①各關(guān)節(jié)角均為0°，處于機(jī)械零位，此時(shí)工具坐標(biāo)系在基坐標(biāo)系下位置矢量為(0，1050，900)mm;②其他關(guān)節(jié)為0°，第1關(guān)節(jié)為90°，此時(shí)工具坐標(biāo)系在基坐標(biāo)系下位置矢量為(-1050， 0，900)mm;③其他關(guān)節(jié)為0°，第2關(guān)節(jié)為90°，此時(shí)工具坐標(biāo)系在基坐標(biāo)系下位置矢量為(0，1050，-900)mm;④其他關(guān)節(jié)為0°，第3關(guān)節(jié)為90°，此時(shí)工具坐標(biāo)系在基坐標(biāo)系下位置矢量為(0，10，1660)mm;⑤其他關(guān)節(jié)為0°，第5關(guān)節(jié)為90°，此時(shí)工具坐標(biāo)系在基坐標(biāo)系下位置矢量為(0，945，1005)mm。

圖5所示的臂型與表2中的數(shù)據(jù)一一對(duì)應(yīng)，從而驗(yàn)證了所提出的運(yùn)動(dòng)學(xué)正解算法的正確性。

3.2逆運(yùn)動(dòng)學(xué)算法驗(yàn)證

逆運(yùn)動(dòng)學(xué)采用如下驗(yàn)證方法： ①隨機(jī)取關(guān)節(jié)角為(30°，20°，-40°，-60°，50°，10°)的一組值，通過(guò)正運(yùn)動(dòng)學(xué)得到機(jī)器人此刻的位姿為(-438.301，898.477，57.334，-142.192，-62.472，33.366)mm；②將此組位姿值作為逆運(yùn)動(dòng)學(xué)求解的輸入，得到機(jī)器人的可能存在的8組解；③將8組解逐組再用正運(yùn)動(dòng)學(xué)算法進(jìn)行求解，得到每組關(guān)節(jié)角對(duì)應(yīng)的位姿，對(duì)比每組關(guān)節(jié)角的姿態(tài)與原隨機(jī)關(guān)節(jié)角輸入時(shí)的位姿關(guān)系。

按照上述步驟得到8組關(guān)節(jié)角如表3所示，各組關(guān)節(jié)角對(duì)應(yīng)的位姿如圖6所示。每組關(guān)節(jié)角的姿態(tài)與原隨機(jī)關(guān)節(jié)角輸入時(shí)的位姿均相同，從而驗(yàn)證了逆運(yùn)動(dòng)學(xué)算法的正確性。

表3中給出了通過(guò)逆運(yùn)動(dòng)學(xué)求解得到的8組關(guān)節(jié)角，其中第3組關(guān)節(jié)5的角度、第5組關(guān)節(jié)2和關(guān)節(jié)5的角度以及第6組關(guān)節(jié)2的角度超出了表1中所給的對(duì)應(yīng)關(guān)節(jié)運(yùn)動(dòng)范圍，這說(shuō)明雖然在理論上HP20機(jī)器人的運(yùn)動(dòng)學(xué)存在8組解，這是由于解反三角函數(shù)產(chǎn)生多解造成的，但是在實(shí)際系統(tǒng)中會(huì)因?yàn)殡姍C(jī)轉(zhuǎn)角限制、線纜纏繞、桿件干涉等因素導(dǎo)致表3中第3、5、6組關(guān)節(jié)角形成的位姿雖然在可視化仿真過(guò)程中可以顯示，但現(xiàn)實(shí)中不能實(shí)現(xiàn)，這也恰恰說(shuō)明了1.4節(jié)運(yùn)用行程最短原則確定逆運(yùn)動(dòng)學(xué)的一組最優(yōu)解的重要性。

表3　HP20機(jī)器人逆運(yùn)動(dòng)學(xué)驗(yàn)證表

圖6　運(yùn)動(dòng)學(xué)逆解8組位姿

4結(jié)束語(yǔ)

本文以Motoman-HP20機(jī)器人為研究對(duì)象，采用D-H坐標(biāo)變換法建立機(jī)器人的連桿坐標(biāo)系，得到了以位置矢量和歐拉角表示的正運(yùn)動(dòng)學(xué)方程，通過(guò)臂腕位姿分離法對(duì)機(jī)器人進(jìn)行逆運(yùn)動(dòng)學(xué)求解，最后構(gòu)建三維可視化仿真環(huán)境，驗(yàn)證所提出的運(yùn)動(dòng)學(xué)算法的正確性。該仿真平臺(tái)可以直觀地觀察機(jī)器人各部分的運(yùn)動(dòng)情況，從而為后續(xù)可視化的軌跡規(guī)劃奠定基礎(chǔ)。

參考文獻(xiàn)：

[1]王田苗,陶永. 我國(guó)工業(yè)機(jī)器人技術(shù)現(xiàn)狀與產(chǎn)業(yè)化發(fā)展戰(zhàn)略[J]. 機(jī)械工程學(xué)報(bào)，2014,50(9)：1-13.

Wang Tianmiao,Tao Yong. Research Status and Industrialization Development Strategy of Chinese Industrial Robot[J]. Journal of Mechanical Engineering, 2014,50(9)：1-13.

[2]Albu-Schaffe A，Haddadin S，Ott C H．The DLR Lightweight Robot: Design and Control Concepts for Robots in Human Environments[J]．Industial Robot，2007，34(5)：376-385．

[3]倪受東,張敏,盛志剛. 基于開(kāi)放式平臺(tái)的視覺(jué)工業(yè)機(jī)器人研究[J].制造業(yè)自動(dòng)化，2014，36(2)：44-48.

Ni Shoudong, Zhang Min, Sheng Zhigang. The Research on Visual Industrial Robot Based on Open Platform[J]. Manufacturing Automation，2014，36(2)：44-48.

[4]何慶稀,游震洲,孔向東．一種基于位姿反饋的工業(yè)機(jī)器人定位補(bǔ)償方法[J]．中國(guó)機(jī)械工程，2016，27(7)：872-876．

He Qingxi, You Zhenzhou,Kong Xiangdong. Positioning Error Compensation Method of Industrial Robot Based on Closed-loop Feed Back of Position and Orientation[J]. China Mechanical Engineering, 2016，27(7)：872-876．

[5]李瑞峰,馬國(guó)慶. 基于MATLAB仿人機(jī)器人雙臂運(yùn)動(dòng)特性分析[J].華中科技大學(xué)學(xué)報(bào)(自然科學(xué)版),2013,41(增刊1)：343-347．

Li Ruifeng,Ma Guoqing. Dual-arm Kinematic Characteristics Analysis of Humanoid Robot Based on Matlab[M]. J. Huazhong Univ. of Sci. & Tech. (Natural science Edition),2013,41(S1)：343-347．

[6]Corke P．Robotics，Vision and Control[M]．Berlin: Springer-Verlag，2011．

[7]李憲華,郭永存,宋韜．六自由度工業(yè)機(jī)器人手臂正運(yùn)動(dòng)學(xué)分析與仿真[J]．安徽理工大學(xué)學(xué)報(bào)(自然科學(xué)版)，2013，33(2)：34-38.

Li Xianhua, Guo Yongcun, Song Tao. Forward Kinematics Analysis and Motion Simulation Platform of a Six DOF Industrial Manipulator[J]. Journal of Anhui University of Science and Technology( Natural Science),2013，33(2)：34-38.

[8]蔡自興.機(jī)器人學(xué)基礎(chǔ)[M].北京:機(jī)械工業(yè)出版社，2009.

(編輯蘇衛(wèi)國(guó))

收稿日期：2015-12-28

基金項(xiàng)目：國(guó)家高技術(shù)研究發(fā)展計(jì)劃(863計(jì)劃)資助項(xiàng)目(2013AA2400 )；吉林省科技發(fā)展計(jì)劃資助項(xiàng)目(20100365 )；吉林省省級(jí)產(chǎn)業(yè)創(chuàng)新專(zhuān)項(xiàng)資金資助項(xiàng)目(2016C088)

中圖分類(lèi)號(hào)：TP242

DOI：10.3969/j.issn.1004-132X.2016.13.005

作者簡(jiǎn)介：高藝，女，1968年生。長(zhǎng)春理工大學(xué)機(jī)電工程學(xué)院副教授。主要研究方向?yàn)闄C(jī)電系統(tǒng)控制理論與控制技術(shù)。馬國(guó)慶，男，1988年生。長(zhǎng)春理工大學(xué)機(jī)電工程學(xué)院助教、博士研究生。于正林，男，1971年生。長(zhǎng)春理工大學(xué)機(jī)電工程學(xué)院教授。曹?chē)?guó)華，男，1965年生。長(zhǎng)春理工大學(xué)機(jī)電工程學(xué)院教授。

Kinematics Analysis of an 6-DOF Industrial Robot and Its 3D Visualization Simulation

Gao YiMa GuoqingYu ZhenglinCao Guohua

Changchun University of Science and Technology,Changchun,130022

Abstract:For configurational characteristics of Motoman-HP20 robot, the D-H coordinate transformation method was adopted to establish the kinematics coordinate system, the robot was decomposed into position structure and pose structure, complete generalized coordinates of position vector and Euler angle were obtained. Pose separation method was used to analyse the robot inverse kinematics solution for critical angle. The 3D visual simulation environment was built, and the kinematics of the proposed algorithm was proved to be correct. The simulation platform of robot movement of each part could be observed visually.

Key words:industrial robot; kinematics analysis; visualization simulation;trajectory planning