關(guān)節(jié)型機(jī)器人腰部結(jié)構(gòu)設(shè)計(jì)(含11張CAD圖紙)
關(guān)節(jié)型機(jī)器人腰部結(jié)構(gòu)設(shè)計(jì)(含11張CAD圖紙),關(guān)節(jié),機(jī)器人,腰部,結(jié)構(gòu)設(shè)計(jì),11,CAD,圖紙
設(shè)計(jì)任務(wù)
題目: 關(guān)節(jié)型機(jī)器人腰部結(jié)構(gòu)設(shè)計(jì)
一、設(shè)計(jì)內(nèi)容
題目來(lái)源于生產(chǎn)實(shí)際。設(shè)計(jì)一個(gè)用于焊接的關(guān)節(jié)型機(jī)器人,進(jìn)行機(jī)器人的總體
方案設(shè)計(jì)、腰部結(jié)構(gòu)設(shè)計(jì)以及其零件設(shè)計(jì)。
二、設(shè)計(jì)依據(jù)
焊接機(jī)器人具有六個(gè)自由度,腰關(guān)節(jié)回轉(zhuǎn),臂關(guān)節(jié)俯仰,肘關(guān)節(jié)俯仰,
腕關(guān)節(jié)仰腕、擺腕和旋腕,腕部最大負(fù)荷6kg,最大速度2m/s,最大工作空間半徑
1500mm。
三、技術(shù)要求
1、機(jī)器人應(yīng)能滿足工作要求,保證焊接精度;
2、工作可靠,結(jié)構(gòu)簡(jiǎn)單;
3、裝卸方便,便于維修、調(diào)整;
4、盡量使用通用件,以便降低制造成本。
四.設(shè)計(jì)物化成果的具體內(nèi)容及要求
1、圖紙工作量及要求
設(shè)計(jì)圖樣全部用AutoCAD繪制,總的繪圖量達(dá)3張A0以上,具體要求:
(1)機(jī)器人外形尺寸圖一張;
(2)腰部及底座裝配圖一張;
(3)設(shè)計(jì)的所有零件的零件圖。
主要參考文獻(xiàn):
1、殷際英.何廣平.關(guān)節(jié)型機(jī)器人:北京:化學(xué)工業(yè)出版社,2003.
2、馬香峰.工業(yè)機(jī)器人的操作機(jī)設(shè)計(jì).北京:冶金工業(yè)出版社,1996.
3、費(fèi)仁元.張慧慧.機(jī)器人機(jī)械設(shè)計(jì)和分析.北京:北京工業(yè)大學(xué)出版社,1998.
4、周伯英.工業(yè)機(jī)器人設(shè)計(jì).北京:機(jī)械工業(yè)出版社,1995.
5、蔡自興.機(jī)器人學(xué).北京:清華大學(xué)出版社,2000.
6、宗光華,劉海波譯.機(jī)器人技術(shù)手冊(cè). 北京:科學(xué)出版社,1996.
7、徐衛(wèi)良,錢瑞明譯.機(jī)器人操作的數(shù)學(xué)導(dǎo)論. 北京:機(jī)械工業(yè)出版社,1998.
8、孫迪生,王炎.機(jī)器人控制技術(shù).北京:機(jī)械工業(yè)出版社,1998.
9、徐灝.機(jī)械設(shè)計(jì)手冊(cè).第二版.北京:機(jī)械工業(yè)出版社,2000.
10、成大先.機(jī)械設(shè)計(jì)手冊(cè).第4版. 北京:化學(xué)工業(yè)出版社,2002.
2
文 獻(xiàn) 資 料
[1] 薛安克,汪新中,蔡宗耀.HDJ003平面關(guān)節(jié)型裝配機(jī)器人微機(jī)實(shí)時(shí)控制系統(tǒng)[J] .機(jī)械工業(yè)自動(dòng)化,1997,19(2):30-32,40
[2] 熊臘森,彭振國(guó),陳一堅(jiān),曹東杰.IR761/125型點(diǎn)焊機(jī)器人在平頭駕駛室總裝生產(chǎn)線上的應(yīng)用[M].武漢:華中理工大學(xué),1998(5):10—12,35
[3] 楊宜明,章云,林漢榮,柯燕嬌.MR—2型微機(jī)器人的研究[M].廣州:廣東工學(xué)院機(jī)器人研究室, 1994,13-14
[4] 湯祥州,謝存禧,于江.SMA微型機(jī)器人的結(jié)構(gòu)設(shè)計(jì)與分析[J].機(jī)械科學(xué)與技術(shù), 1997, 16(6):992-996
[5] 徐錦康,群濤,劉啟芬. XZ—I型弧焊機(jī)器人[J].機(jī)械工業(yè)自動(dòng)化,1994, 16(3):24-27
[6] 劉啟芬,黃虎.弧焊機(jī)器人控制功能的實(shí)現(xiàn)[J].南京氣象學(xué)院學(xué)報(bào),1995,18(3):410-415
[7] 張勇德,劉廷榮,李華敏.機(jī)器人多指靈巧手的結(jié)構(gòu)型式的優(yōu)化分析[M].黑龍江: 哈爾濱工業(yè)大學(xué),1999(7):9-13,48
[8] 李樹(shù)軍,李德錫,權(quán)太國(guó).一種3自由度串并聯(lián)平臺(tái)型機(jī)器人結(jié)構(gòu)[J].東北大學(xué)學(xué)報(bào)(自然科學(xué)版) , 1996,17(6):641-644
[9] 鐘春敏.異形石材加工雙臂機(jī)器人結(jié)構(gòu)設(shè)計(jì)[J].陜西工學(xué)院學(xué)報(bào), 2000,16(4):12-14
[10] 陳炯.便攜式關(guān)節(jié)型弧焊機(jī)器人的研制[M].四川油氣田建設(shè)工程總公司,
2001(10):23-26
[11] 崔文旭.機(jī)器人在汽車焊接生產(chǎn)線柔性化中的應(yīng)用[J].焊接技術(shù),2003,32(5):36-37
開(kāi)題論證報(bào)告
題目名稱:關(guān)節(jié)型機(jī)器人腰部結(jié)構(gòu)設(shè)計(jì)
一、題目來(lái)源、題目研究的主要內(nèi)容及國(guó)內(nèi)外現(xiàn)狀綜述
(一)題目來(lái)源:
本題目來(lái)源于生產(chǎn)實(shí)際,手工電弧焊接效率低,操作環(huán)境差,而且對(duì)操作員技術(shù)熟練程度要求較高,因此采用機(jī)器人技術(shù),實(shí)現(xiàn)焊接生產(chǎn)操作的柔性自動(dòng)化,以提高生產(chǎn)效率。而且,現(xiàn)在對(duì)許多構(gòu)件的焊接精度和速度等提出越來(lái)越高的要求,一般工人已難以勝任這一工作;此外,焊接時(shí)的火花及煙霧等,對(duì)人體造成危害,因此,焊接過(guò)程的完全自動(dòng)化已成為重要的研究課題。其中,十分重要的就是要應(yīng)用焊接機(jī)器人。
(二)題目研究的主要內(nèi)容:
設(shè)計(jì)一個(gè)用于焊接的關(guān)節(jié)型機(jī)器人,進(jìn)行機(jī)器人的總體方案設(shè)計(jì)、腰結(jié)構(gòu)設(shè)計(jì)及其零件設(shè)計(jì)。
關(guān)節(jié)型機(jī)器人的機(jī)械本體部分一般為由各種關(guān)節(jié)串接起若干連桿組成的開(kāi)鏈?zhǔn)綑C(jī)構(gòu)。由于結(jié)構(gòu)上的原因,其關(guān)節(jié)通常只有轉(zhuǎn)動(dòng)型和移動(dòng)型。關(guān)節(jié)型機(jī)器人主要特點(diǎn)是模仿人類腰部到手臂的基本結(jié)構(gòu),因此本體結(jié)構(gòu)通常包括關(guān)節(jié)型機(jī)器人的機(jī)座結(jié)構(gòu)及腰部關(guān)節(jié)轉(zhuǎn)動(dòng)裝置、手腕結(jié)構(gòu)及手腕關(guān)節(jié)轉(zhuǎn)動(dòng)裝置和末端執(zhí)行器。我所做的課題偏重與機(jī)座和腰部的結(jié)構(gòu)設(shè)計(jì)。
弧焊機(jī)器人多采用占地面積小,動(dòng)作范圍較大的關(guān)節(jié)型操作機(jī),其靈活性大,能以最佳狀態(tài)決定焊槍的位置。
(三)國(guó)內(nèi)外現(xiàn)狀綜述:
目前,對(duì)機(jī)器人技術(shù)的發(fā)展有最重要影響的國(guó)家是日本和美國(guó)。美國(guó)在機(jī)器人技術(shù)的綜合性水平上仍處于領(lǐng)先地位,日本生產(chǎn)的機(jī)器人數(shù)量和種類則居世界首位。我國(guó)發(fā)展機(jī)器人技術(shù)起步于20世紀(jì)70年代末。1995年9月,6000m水下機(jī)器人試驗(yàn)成功.近年來(lái),在步行機(jī)器人、精密裝配機(jī)器人及多自由度關(guān)節(jié)型機(jī)器人研制等前沿領(lǐng)域內(nèi)逐步縮短與世界水平的差距。
自從第一臺(tái)工業(yè)機(jī)器人問(wèn)世以來(lái),機(jī)器人的應(yīng)用領(lǐng)域從汽車工業(yè)逐漸向其他行業(yè)滲透,機(jī)器人的種類也從操作手逐漸衍生出各種各樣的機(jī)器人,如今機(jī)器人已經(jīng)深入到人類生活的方方面面。人類科技的進(jìn)步、文明的發(fā)展已經(jīng)和機(jī)器人產(chǎn)生了密切的關(guān)系。人類社會(huì)的發(fā)展已經(jīng)離不開(kāi)機(jī)器人技術(shù),而機(jī)器人技術(shù)的進(jìn)步必然對(duì)推動(dòng)科技發(fā)展產(chǎn)生不可忽視的作用。當(dāng)前和今后的機(jī)器人技術(shù)正逐漸向著具有行走能力、對(duì)環(huán)境的自主性強(qiáng)、具有多種感覺(jué)能力的方向發(fā)展。機(jī)器人也正在逐漸具有智能。美國(guó)貝爾科爾公司已成功地將神經(jīng)網(wǎng)絡(luò)裝配在芯片上,其智能分析速度比普通計(jì)算機(jī)要快數(shù)千倍,能更好地完成識(shí)別語(yǔ)言和圖像處理等工作。
華中理工大學(xué)的熊臘森、彭振國(guó)、陳一堅(jiān)和曹東杰教授合著的一篇論文,題為《IR761/125型點(diǎn)焊機(jī)器人在平頭駕駛室總裝生產(chǎn)線上的應(yīng)用》,它主要介紹了IR761/125型點(diǎn)焊機(jī)器人的機(jī)械結(jié)構(gòu)和控制系統(tǒng);重點(diǎn)討論了該機(jī)器人的焊接生產(chǎn)應(yīng)用;提出了機(jī)器人的使用維護(hù)和故障處理建議。
南京機(jī)械??茖W(xué)校的徐錦康、邵群濤和劉啟芬合著的論文《XZ-I型弧焊機(jī)器人》主要介紹了XZ-I型機(jī)器人操作機(jī)結(jié)構(gòu)和機(jī)構(gòu)設(shè)計(jì),位置交流伺服控制系統(tǒng)及計(jì)算機(jī)控制軟件特點(diǎn),給出了主要算法。
二、本題目擬解決的問(wèn)題
焊接機(jī)器人具有6個(gè)自由度:① 腰關(guān)節(jié)回轉(zhuǎn);② 臂關(guān)節(jié)俯仰;③ 肘關(guān)節(jié)俯仰;④ 腕關(guān)節(jié)仰腕;⑤ 擺腕;⑥旋腕。其中要詳細(xì)地設(shè)計(jì)機(jī)器人基座和腰部的結(jié)構(gòu)。整體機(jī)器人要實(shí)現(xiàn)腕部最大負(fù)荷6kg,最大速度2m/s,最大工作空間半徑1500mm 。
在設(shè)計(jì)過(guò)程中要考慮到很多問(wèn)題:① 機(jī)器人的六個(gè)關(guān)節(jié)采用何種驅(qū)動(dòng)器;② 傳動(dòng)比的選擇要合理;③ 同一軸上的軸承要保證很好的同軸度;④基座采用何種材料如何制造;⑤ 立柱與大臂如何聯(lián)接;⑥ 要有足夠大的安裝基面,以保證機(jī)器人工作時(shí)的穩(wěn)定性;⑦ 腰座承受機(jī)器人全部重量和工作載荷,應(yīng)保證足夠的強(qiáng)度、剛度和承載能力;⑧ 腰座軸系及傳動(dòng)鏈的精度對(duì)末端執(zhí)行器的運(yùn)行精度影響最大。因此腰座與手臂的聯(lián)接要有可靠的定位基準(zhǔn)面。
三、 解決方案及預(yù)期效果
(一)解決方案:
機(jī)器人大體采用PUMA型
1. 操作機(jī)的驅(qū)動(dòng)系統(tǒng)設(shè)計(jì);
關(guān)節(jié)型機(jī)器人本體驅(qū)動(dòng)系統(tǒng)包括驅(qū)動(dòng)器和傳動(dòng)機(jī)構(gòu),它們常和執(zhí)行機(jī)構(gòu)聯(lián)成一體,驅(qū)動(dòng)臂桿和載荷完成指定的運(yùn)動(dòng)。常用的驅(qū)動(dòng)器有電機(jī)和液壓、氣動(dòng)驅(qū)動(dòng)裝置等。其中采用電機(jī)驅(qū)動(dòng)是最常用的驅(qū)動(dòng)方式。電極驅(qū)動(dòng)具有精度高,可靠性好,能以較大的變速范圍滿足機(jī)器人應(yīng)用要求等特點(diǎn)。所以在這次設(shè)計(jì)中我選擇了直流電機(jī)作為驅(qū)動(dòng)器。
2. 速度和位置檢測(cè);
3. 伺服控制系統(tǒng)選擇;
4. 工作空間的確定;
5. 機(jī)器人本體結(jié)構(gòu)設(shè)計(jì);
①內(nèi)部鋁鑄件形狀復(fù)雜,既用作內(nèi)部齒輪安裝殼體與軸的支承座,又兼作承力骨架,傳遞集中載荷。這樣不僅節(jié)省材料,減少加工量,又使整體質(zhì)量減輕。手臂外壁與鑄件骨架采用膠接,使連接件減少,工藝簡(jiǎn)單,減輕了質(zhì)量。
② 軸承外形環(huán)定位簡(jiǎn)單。一般在無(wú)軸向載荷處,載荷外環(huán)采用端面打沖定位的方法。
③ 采用薄壁軸承與滑動(dòng)銅襯套,以減少結(jié)構(gòu)尺寸,減輕質(zhì)量。
④ 有些小尺寸齒輪與軸加工成一體,減少連接件,增加了傳遞剛度。
⑤ 大、小臂,手腕部結(jié)構(gòu)密度大,很少有多余空隙。如電機(jī)與臂的外壁僅有0.5mm間隙,手腕內(nèi)部齒輪傳動(dòng)安排亦是緊密無(wú)間。這樣使總的尺寸減少,質(zhì)量減少。
⑥ 工作范圍大,適應(yīng)性廣。PUMA除了自身立柱所占空間以外,它的工作空間幾乎是他的長(zhǎng)臂所能達(dá)到的全球空間。再加之其手腕軸的活動(dòng)角度大,因此使它工作時(shí)位姿的適應(yīng)性強(qiáng)。譬如用手腕擰螺釘,手腕關(guān)節(jié)4,6配合,一次就能轉(zhuǎn)1112°。
⑦ 由于結(jié)構(gòu)上采用了剛性齒輪傳動(dòng),調(diào)整齒輪間隙機(jī)構(gòu),彈性萬(wàn)向聯(lián)軸器,工藝上加工精密,多用整體鑄件,使得重復(fù)定位精度高。
⑧ 機(jī)器人手臂材料的選擇:
機(jī)器人手臂的材料應(yīng)根據(jù)手臂的工作狀況來(lái)選擇。根據(jù)設(shè)計(jì)要求,機(jī)器人手臂要完成各種運(yùn)動(dòng)。因此,對(duì)材料的一個(gè)要求是作為運(yùn)動(dòng)的部件,它應(yīng)是輕型材料。而另一方面,手臂在運(yùn)動(dòng)過(guò)程中往往會(huì)產(chǎn)生振動(dòng),這將大大降低它的運(yùn)動(dòng)精度。因此,在選擇材料時(shí),需要對(duì)質(zhì)量、剛度、阻尼進(jìn)行綜合考慮,以便有效地提高手臂的動(dòng)態(tài)性能。
機(jī)器人手臂材料首先應(yīng)是結(jié)構(gòu)材料。手臂承受載荷時(shí),不應(yīng)有變形和斷裂。從力學(xué)角度看,即要具有一定的強(qiáng)度。手臂材料應(yīng)選擇高強(qiáng)度材料,如鋼、鑄鐵、合金鋼等。機(jī)器人手臂是運(yùn)動(dòng)的,又要具有很好的受控性,因此,要求手臂比較輕。綜合而言,應(yīng)該優(yōu)先選擇強(qiáng)度大而密度小的材料做手臂。其中,非金屬材料有尼龍6、聚乙烯和碳素纖維等;金屬材料以輕合金為主。
⑨腰關(guān)節(jié)采用齒輪二級(jí)傳動(dòng)??倐鲃?dòng)比為48,第一級(jí)傳動(dòng)傳動(dòng)比為4,第二級(jí)傳動(dòng)比為12,主軸的角速度為3.82 rad/s。
(二)預(yù)期效果:
工作可靠,結(jié)構(gòu)簡(jiǎn)單;裝卸方便,便于維修、調(diào)整;能很好的實(shí)現(xiàn)自動(dòng)電弧焊的功能。
3
關(guān)節(jié)型機(jī)器人腰部結(jié)構(gòu)設(shè)計(jì)
摘要: 為了提高生產(chǎn)效率和產(chǎn)品的焊接質(zhì)量,滿足實(shí)際工作需要,本課題設(shè)計(jì)了用于焊接的關(guān)節(jié)型機(jī)器人。根據(jù)機(jī)器人的工作要求和結(jié)構(gòu)特點(diǎn),進(jìn)行了機(jī)器人的總體設(shè)計(jì),確定了機(jī)器人的外形尺寸和工作空間,擬定了機(jī)器人各關(guān)節(jié)的總體傳動(dòng)方案,對(duì)機(jī)器人腰關(guān)節(jié)結(jié)構(gòu)進(jìn)行了詳細(xì)設(shè)計(jì),合理布置了電機(jī)和齒輪,確定了各級(jí)傳動(dòng)參數(shù),進(jìn)行了齒輪、軸和軸承的設(shè)計(jì)計(jì)算和校核。利用齊次變換矩陣法建立了六自由度關(guān)節(jié)機(jī)器人的正運(yùn)動(dòng)學(xué)模型,求出機(jī)器人末端相對(duì)于各自參考坐標(biāo)系的齊次坐標(biāo)值,建立了在直角坐標(biāo)空間內(nèi)機(jī)器人末端執(zhí)行器的位置和姿態(tài)與關(guān)節(jié)變量值的對(duì)應(yīng)關(guān)系?;趲缀瓮队霸硗茖?dǎo)出相應(yīng)的逆運(yùn)動(dòng)學(xué)模型,求出了各個(gè)關(guān)節(jié)的角度值,建立了機(jī)器人關(guān)節(jié)空間與世界空間的映射關(guān)系。該機(jī)器人具有剛性好,位置精度高、運(yùn)行平穩(wěn)的特點(diǎn)。
關(guān)鍵詞:關(guān)節(jié)型機(jī)器人;位姿分析;總體設(shè)計(jì);腰部結(jié)構(gòu)設(shè)計(jì)
The waist structural design of articulated robot
Abstract : In order to improve the efficiency of production and welding quality of products and meet real work's needs, this subject has designed the articulated robot used for welding . According to the job requirements for the robot and structure characteristic , I have carried on the overall design of the robot, confirmed the external dimension and workspace of the robot, drafted the overall transmission scheme of every joint of the robot. I have designed the waist structure of the robot in detail, assigned the electrical machinery and gear wheel rationally, confirmed at all level transmission parameters , carried on the design and calculating of gear wheels , shafts and bearings and checking them.The kinematic model of robot system has been built up by means of the homogenous transformation of matrix in this thesis and deduces the robot's homogenous coordinate which is relative to its reference coordinate. We also make up the position relationship between the robot's end effector and the variable friable of every joint. The inverse kinematic model is deduced which based on the projection principle of geometry and the value of angle is worked out. What’s more, the relationship is built up between the joint space of robot and the world space. This robot has the characteristics of fine rigidity , position precision high , that operate steadily.
Key words: Articulated robot; Appearance analysis in the location; Design overallly; Waist articulated structural design of the robot
目 錄
1 前言…………………………………………………………………………………1
1.1 題目來(lái)源及分析…………………………………………………………………1
1.2 研究目的…………………………………………………………………………2
1.3國(guó)內(nèi)外發(fā)展及研究現(xiàn)狀…………………………………………………………2
2 關(guān)節(jié)型機(jī)器人總體設(shè)計(jì)……………………………………………………………4
2.1 確定基本技術(shù)參數(shù)………………………………………………………………4
2.1.1機(jī)械結(jié)構(gòu)類型的選擇…………………………………………………………4
2.1.2 額定負(fù)載………………………………………………………………………5
2.1.3 工作范圍………………………………………………………………………5
2.1.4 操作機(jī)的驅(qū)動(dòng)系統(tǒng)設(shè)計(jì)………………………………………………………5
2.1.5 控制系統(tǒng)的選擇………………………………………………………………6
2.1.6 確定關(guān)節(jié)型機(jī)器人手臂的配置形式…………………………………………6
2.2 關(guān)節(jié)型機(jī)器人本體結(jié)構(gòu)設(shè)計(jì)……………………………………………………7
3 關(guān)節(jié)型機(jī)器人腰部結(jié)構(gòu)設(shè)計(jì)…………………………………………………… 10
3.1 電動(dòng)機(jī)的選擇…………………………………………………………………10
3.2 計(jì)算傳動(dòng)裝置的總傳動(dòng)比及分配各級(jí)傳動(dòng)比………………………………12
3.3 軸的設(shè)計(jì)計(jì)算…………………………………………………………………12
3.3.1 計(jì)算各軸轉(zhuǎn)速、轉(zhuǎn)矩和輸入功率……………………………………………12
3.3.2 確定三根軸的具體尺寸……………………………………………………13
3.4 確定齒輪的參數(shù)………………………………………………………………17
3.4.1 選擇材料……………………………………………………………………17
3.4.2 壓力角的選擇………………………………………………………………17
3.4.3 齒數(shù)和模數(shù)的選擇…………………………………………………………17
3.4.4 齒寬系數(shù)的確定……………………………………………………………17
3.4.5 確定齒輪傳動(dòng)的精度………………………………………………………18
3.4.6 齒輪的校核…………………………………………………………………19
3.5 殼體設(shè)計(jì)………………………………………………………………………22
4 關(guān)節(jié)型機(jī)器人的位姿分析………………………………………………………23
4.1 機(jī)器人的位姿與運(yùn)動(dòng)的描述…………………………………………………23
4.2 關(guān)節(jié)型機(jī)器人的廣義連桿變換矩陣…………………………………………23
4.3 關(guān)節(jié)型機(jī)器人運(yùn)動(dòng)方程………………………………………………………26
4.3.1 關(guān)節(jié)型機(jī)器人運(yùn)動(dòng)分析……………………………………………………26
4.3.2 關(guān)節(jié)型機(jī)器人運(yùn)動(dòng)反解……………………………………………………29
5 結(jié)論………………………………………………………………………………34
參考文獻(xiàn)……………………………………………………………………………35
附錄…………………………………………………………………………………36
英文原文
THE STRUCTURE DESIGN AND KINEMATICS OF A ROBOT
MANIPULATORml. THEORY
KESHENG WANG and TERJE K . LIEN
Production Engineering Laboratory, NTH-SINTEF, N-7034 Trondheim, Norway
A robot manipulator with six degrees of freedom can be separated into two parts: the arm with the first three joints for major positioning and the wrist with the last three joints for major orienting. If we consider theconsecutive links to be parallel or perpendicular, only 12 arm and two wrist configurations are potentially usefuland different for robot manipulator mechanical design. This kind of simplification can lead to a generalalgorithm of inverse kinematics for the corresponding configuration of different combinations of arm and wrist.The approaches for calculating the inverse kinematics of a robot manipulator are very efficient and easy.The approaches for calculating the inverse kinematics of a robot manipulator are very efficient and easy.
1. INTROUCTION
A robot manipulator consists of a number of linksconnected together by joints. In robot manipulatordesign, the selection of the kinematic chain of therobot manipulator is one of the most importantdecisions in the mechanical and controller designprocess.
In order to position and orient the end effector ofthe robot manipulator arbitrarily, six degrees offreedom are required: three degrees of freedom forposition and three degrees of freedom for orient-ation. Each manipulator joint can provide onedegree of freedom, and thus a manipulator musthave a minimum of six joints if it is to provide sixorthogonal degrees of freedom in position andorientation.
The construction of manipulators depends on thedifferent combination of joints. The number of poss-ible variations of an industrial robot structure can bedetermined as follows:
V =6
where
V= number of variations.
D F = n u m b e r of degrees of freedom
These considerations show that a very largenumber of different chains can be built, for examplesix axis 46,656 chains are possible. 6 However, alarge number is not appropriate for kinematicreasons.
We may divide the six degrees of freedom of arobot manipulator into two parts: the arm whichconsists of the first three joints and related links; andthe wrist which consists of the last three joints andrelated links. Then the variations of kinematic chainswill be tremendously reduced. Lien has developedthe constructions of arm and wrist, i.e. 20 differentconstructions for the arm and eight for the wrist.2
In this paper, we abbreviate the 20 different armsinto 12 kinds of arms which are useful and different.We conclude that five kinds of arms and two kinds ofwrists are basic constructions for commercial indus-trial robot manipulators. This kind of simplificationmay lead to a general algorithm of inverse kinema-tics for the corresponding configuration of differentcombinations of arm and wrist.
2.STRUCTURE DESIGN OF ROBOT MANIPULATORS
In this paper, for optimum workspace and sim-plicity, we assume that:
(a) A robot with six degrees of freedom may beseparated into two parts: the linkage consistingof the first three joints and related links is calledthe arm; the linkage of the remaining joints andrelated links is called the wrist.
(b) Two links are connected by a lower pair joint.Only revolute and linear joints are used in robotmanipulators.
(c) The axes of joints are either perpendicular or
According to the authors' knowledge, thisassumption is suitable for most commercially usedindustrial robot manipulators. We can consider thestructure of arm and wrist separately.
2.1. The structure o f the arm o f robot manipulator
(a) Graphical representation. To draw a robot inside view or in perspective is complicated and doesnot give a clear picture of how the various segmentsmove in relation to each other. To draw a robot in aplane sketched diagram is too simple and does notgive a clear construction picture. We compromisethis problem in a simple three-dimensional diagramto express the construction and movements of arobot manipulator. A typical form of representationfor different articulations is shown in Table 1.
(b) Combination of joints. We use R to representa revolute joint and L to represent a linear joint.Different combinations of joints can be obtained asfollows:
According to the different combinations with theparallel or perpendicular axes, each previous combin-ation has four kinds of sub-combination. Thus, 32combinations can be arrived at:
If the second joint is a linear joint and both the otherjoints are perpendicular to it, two choices in relationto the first and the third joints are considered paral-lel or perpendicular.
In all, there are 36 possible combinations of a simplethree-joint arm.
Nine of 36 possible combinations degenerate intoone or two degrees of freedom.
Seven of the remainder are planar mechanisms.Thus, there are 20 possible spatial simple arms.
Let us consider R1 [1 L2 I L3 in whichthe first joint permits rotation about the vertical axis,the second joint is a vertical linear joint (i.e. parallelto the first), and the third joint is a horizontal linearjoint (i.e. perpendicular to the second). This armdefines a typical cylindrical robot. Changing thesequential order of the joints so that either (a) thevertical linear joint precedes the rotary joint, or (b)the vertical linear joint follows the horizontal one,will result in no change in the motion of the arm. Inthis case there are two linkages which are both"equivalent" to the standard cylindrical linkage. Inall such cases where two or more equivalent linkagesexist, the representative of the group will be the onein which the linear joint that is parallel to a rotaryjoint is in the middle (joint No. 2). Counting onlyone linkage to represent the group of equivalentswill eliminate eight of the 20 combinations. Theremaining 12 categories of links are useful and dif-ferent shown in Fig. 1. We get the same results as inRef. 4.
(c) Five basic types o f manipulator arm. Althoughthere are 12 useful and different arm-configurationswhich can be used in the design of a robot man-ipulator arm, in practice only some of them arepractical and commonly used. We find that mostcommercially available industrial robots can bebroken down into only five groups according to the.
characteristics of their arm motion and geometricalappearance.The five groups can be defined as follows and areshown in Fig. 6.
1. Cartesian ( L I L I L)
2. Cylindrical (R II L 1 L)
3. Spherical (R I R I L)
4. Revolute (R I RII R)
5. Double cylindrical ( LII R II R).
2.2. The structure o f a manipulator wrist
(a) Joint type. We have used the first three joints,i.e. the arm of the robot manipulator, to completethe major task of positioning. Then we use the lastthree joints to provide the three degrees of freedomof orientation and refer to the related linkages as thewrist.
The wrist of a complete manipulator must containthree revolute joints, since the orientation of a rigidbody has three degrees of freedom, for example firstrotation about the X axis, then rotation about the yaxis, and finally rotation about the z axis.
(b) Combination or joints and links. Because theorientation of a wrist which only has three rotationaljoints is simplest, its combination is much simpFrom the combination R R R , we know that onlyone of the four configurations can be used for com-pleting the orientation of robot wrist. R II R II R is aplanar mechanism. R 1 R II R and R II R 1 R cannotexpress three degrees of freedom in the orientationof the robot wrist. So only the R 1 R 1 R construc-tion can be used to complete the orientation task.
If we have a different sequence of x, y, z axes, ofcourse we can get many kinds of wrist configuration.But many of them are "equivalent". We only con-sider the relationship between the first and the thirdjoint: parallel and perpendicular. Two differentcombinations can be arrived at, i.e. the Euler angleand r o l l - p i t c h - y a w angle expressions that are shownin Fig. 2. The sequence of x, y, z axes does, however,have an influence on the complexity of the inversekinematic solution.
2.3. Typical robot manipulator structure
We can use five categories of arm configurationand two kinds of wrist configuration to combine 10different kinds of robot manipulators with the sixdegrees of freedom which exist in industrial practice.Of course, we can also consider the other seven outof 12 arm categories with one out of two wristcategories to build a new robot manipulator. Butmost of them have not appeared in industrial prac-tice yet.
3. SOLUTION FOR INVERSE KINEMATICS OF ROBOT MANIPULATOR
3.1. General principlesTo find the inverse kinematic equations of a robotmanipulator at first appears to be a difficult task. Butwhen the manipulator is separated into two parts, itbecomes relatively simple.The relationship between the position and orien-tation of manipulator links connected together byrotational joints shown in Fig. 3, can be described by
Where
0i is the ith joint variable;
di is the ith joint offset;
ai is the ith link length; and
ai is the ith link twist angle.
The position and orientation of the end effector ofthe robot manipulator °T is the matrices product. 3,
T = A I A 2 A 3 A 4 A s A 6 . (2)
By the associative law the product of matrices can beregrouped into two subsets which represent the armand wrist respectively
Where
And
The superscripts designate the reference frame; arepresents the tip of the arm; and w represents thetip of wrist, i.e. the center of the end effector of themanipulator.°T given for the end effector can be written as a4 x 4 homogeneous matrix composed of a orienta-tion submatrix R and a position vector p5.6
We can obtain the vector OaPdirectly using a vectoranalysis method. The detail will be mentioned in thenext section.
from Eq. (4),
We can get 01, 02, 03, the first three joint variablesfrom the solution of the following equation:
The orientation of the end effector of the robotmanipulator can be considered as the product of theorientation of the arm and the orientation of the wrist:
From Eqs (12) and (5), we can obtain
where
We can get the last three joint variables 04, 05, 06 by solving Eq. (13).
3.2. Different methodsThere are two kinds of solutions for the robot
manipulator: closed form solutions and numericalsolutions. Because of their iterative nature, numeri-cal solutions are generally much slower than thecorresponding closed form solutions, so much so that for most uses, we are not interested in the numerical approach to solution of kinematics. But, in general, it is much easier to obtain the numerical algorithm
than to obtain the closed form solution.
In this paper we propose algorithms of both solu-tions.
(a) Closed form solution. In the closed form solu-tion, the key problem is to obtain the position of thetip of the arm P. It is simple to obtain the position ofthe arm tip for the wrist axis intersecting at onepoint. But it is complex for the wrists where there isan axis offset, because the movement of the wristwill greatly affect the position of end effector of themanipulator
In the following, we use the RRR + Euler angleand RRR + R - P - Y angle as examples to describehow to get the position of the tip of arm separately. RRR + Euler angleFigure 4 shows a sketch diagram of a
R R R + Euler angle
robot manipulator (PUMA 600) and the co-ordinate system which is represented by the D - Hexpression. The figure shows the relationship be-tween the arm and wrist vectors. ~r, is the positionvector from the base coordinate frame to the centerof the end effector of the robot manipulator. Arepresents the approach direction of the end effec-tor, °aPis the arm vector measured from the origin tothe connecting point of the arm and wrist, gP is thewrist vector having the same direction as the Avector and length measured from the connectionpoint of the arm and wrist to the center of the endeffector.
With reference to frame 0, the product ~R gP issimply gP, i.e. the position of the center of the endeffector of robot manipulator measured from the tipof the arm, all with respect to frame 0. We canobtain
This states that the total translation of the endeffector is the sum of the translation from the base to
the tip of the arm plus the transformation from thetip of the arm to the center of the end effector.
From Eq. (17), we can easily obtain the positionof the arm tip ~P as follows:
Then we can use Eqs (10) and (11) to obtain the firstthree joint variables 0:, 02, 03 and Eq. (13) to obtainthe last three joint variables 04, 05,06. The detailedsolution is shown in Part II. t0
Figure 5 shows a sketch diagram of a RRR +R - P - Y angle robot manipulator (Cincinatti Mila-
cran T 3) and the coordinate system. Euler anglesare different from R - P - Y angles because the vector0p is affected by the movement of joint 4. Here is anexample showing how to treat the wrist axis offset.gPt:is the wrist vector having the same direction asthe A vector and length measured from the point ofjoint 4 to the center of the end effector, i.e. d+. ~P2 isthe other wrist vector having length measured frompoint of joint 4 to point of joint 5, i.e. a4. oP, theposition of arm, can be computed from the se-quential solution of the following set of equations:
Then we can obtain 01, 02, 03 from Eqs (10) and (11)and obtain 0+, 05, 06 from Eq. (13).
? General closed form solution algorithm
Step 1. Finding the approach vector of the endeffector
Step 2.If there is some off-set in the wrist construc-tion, use the vector algebra to determine the
off-set gP, and get the arm vector, i.e. theposition of arm tip, then go to step 4.Otherwise go to Step 3. Compute the arm vector ~P directly usingapproach vector A.
Step 4. Compute the first three joint variables 01,02, 03, using the arm vector gP from Eqs
(10) and (11).
Step 5. Compute the last three joint variables 04, 05,06 from Eq. (13).This approach shows that the number of computa-tions is kept to a minimum by reducing the overallproblem into separate steps which in turn lowers thelikelihood of errors and helps to reduce the tedious-ness of the work.
(b) Numerical solution. The algorithm for thenumerical solution:
Step 1. Assume the last three joint variables 04, 05,06 by the best available approximation,perhaps from a previous computed point.
Step 2. Compute the arm joint variables 81, 02, 03from Eqs (10) and (11).
Step 3. Compute wrist joint variables 04, 05, 06 from
Eq. (13), using the values of the arm jointvariables obtained from step 2.
Step 4. Compute the position and orientation of theend effector of robot manipulator using the
values of all joint variables obtained fromstep 2 and step 3.
Step 5. If the errors between the given values andthe calculated values is less than a pre-
specified value, then the procedure stops.Otherwise go to step 2 to repeat the pro-
cedure.The physical interpretation of the above pro-cedure is alternately to move the arm and wrist, oneto satisfy the positional and other to satisfy theorientational specification of the end effector, eachtime moving only the arm (or the wrist) while hold-ing the wrist (or the arm) fixed.
This method has been implemented in a PUMA600 robot manipulator. It has been found that four is a sufficient number of iterations to reach therequired accuracy (A < 0.01 mm) and the number has been fixed in the inverse kinematic solution.This algorithm has the advantage of treating the different kinds of robots with the same algorithm.But this method needs so much more computing time than the closed form solution, that it is notsuitable for real-time control of robot manipulators.
4. CONCLUSIONS
The variety of possible robot configurations isvery large. A step towards generalization has been made by emphasizing that robot manipulators ofpractical importance are separable into primary sub-systems, the arm and the wrist. Mathematical treat-ment of various robots may be modularized and thusgreatly simplified by giving a separate description ofvarious arms and various wrists in common use.It has been discovered that only 12 useful and different categories of arm construction and twokinds of wrist construction exist. Using thehomogeneous transformation matrix method, theinverse kinematic solution is easily derived.The two algorithms which consist of the closedform and numerical solution of the inverse kine-matics have been given in this paper.
REFERENCES
1. Denavit, J., Hartenberg, R.S.: A kinematic notationfor law pair mechanisms based on matrices. J. Appl.Mech. Trans. ASME 77: 215-221, 1955.
2. Lien, T.K.: Banestyring for universelle handterings-automater. Trondheim, August 1980.
3. Lien, T.K.: Coordinate transformations in CNC sys-tem for automatic handling machines, llth CIRPSeminar on Manufacturing Systems, Nancy, France,June 1979.
4. Milenkovic,V., Huang, B.: Kinematicsof major robotlinkage. 13th International Symposium on IndustrialRobots and Robotics 7, Vol. 2, pp. 31-46, 1983.
5. Paul, R.P.: Robot Manipulators: Mathematics, Pro-gramming, and Control. MIT Press, Cambridge,1982.
6. Lee,. C.G.S.: Fundamentals of Robotics. Addison-Wesley, New York, 1983.
7. Warnecke, H.J., Schraft, R.D.: Industrial Robots. IFS,Bedford, 1982.
8. Pieper, D.L.: The kinematics of manipulators undercomputer control. AIM 72, Stanford, CA. StanfordUniversity Artificial Intelligence Laboratory.
9. Coiffet, P., Chirouze, M.: An Introduction to RobotTechnology. Kogan Page, London, 1983.
10. Wang, K., Lien T.K.: Closed form solution for theinverse kinematics of a PUMA robot man-ipulator--II. Demonstration. Robotics Comput.-Integr. Mfg. 5: 159-163, 1989.
中文原文
一個(gè)機(jī)器人結(jié)構(gòu)設(shè)計(jì)及運(yùn)動(dòng)學(xué)
機(jī)械臂毫升.理論
KESHENG WANG and TERJE K . LIEN
生產(chǎn)工程實(shí)驗(yàn)室,NTH-SINTEF,N-7034,挪威特隆赫姆
六自由度機(jī)器人可以分為兩個(gè)部分:與前三個(gè)關(guān)節(jié)為主要定位,最后三個(gè)關(guān)節(jié)為主要面向腕臂。如果我們考慮連續(xù)的鏈接是平行或垂直的,只有12的臂和兩個(gè)手腕結(jié)構(gòu)可能是有用的而且不同于對(duì)機(jī)器人機(jī)械手的機(jī)械設(shè)計(jì)。這種簡(jiǎn)化可以導(dǎo)致對(duì)手臂和手腕的不同組合配置相應(yīng)的逆運(yùn)動(dòng)學(xué)算法。對(duì)于一個(gè)機(jī)器人逆運(yùn)動(dòng)學(xué)是非常有效和簡(jiǎn)單的計(jì)算方法。
簡(jiǎn)介
一個(gè)機(jī)器人由若干環(huán)節(jié)通過(guò)接頭連接在一起。在機(jī)器人的機(jī)械手設(shè)計(jì),對(duì)運(yùn)動(dòng)鏈的選擇是器人一個(gè)最重要的決定在機(jī)械和控制器的設(shè)計(jì)過(guò)程。
為了定位和定向的機(jī)器人末端執(zhí)行器的任意,六自由度的要求:方向三度的位置和三自由度的自由。每個(gè)機(jī)械手關(guān)節(jié)可以提供一個(gè)自由度的機(jī)械手,因此必須要提供在六個(gè)自由度的位置和方向正交的至少有六的接頭。
機(jī)械手的結(jié)構(gòu)取決于節(jié)點(diǎn)的不同組合。對(duì)工業(yè)機(jī)器人的結(jié)構(gòu)的可能變化的數(shù)量可以確定如下。
V=6DF;那么V=數(shù)量的變化;DF=自由度
這些因素表明,不同鏈可建數(shù)量非常大,例如六軸46656鏈?zhǔn)强赡艿?。然而,這是大量不適合運(yùn)動(dòng)的原因。
我們可以將一個(gè)機(jī)器人六自由度分為兩部分:臂由前三個(gè)關(guān)節(jié)和相關(guān)鏈接;與手腕由過(guò)去的三節(jié)點(diǎn)和相關(guān)鏈接。然后運(yùn)動(dòng)鏈的變化將極大地減少。即留置了手臂和手腕的結(jié)構(gòu)。20種不同的手臂和8種手腕設(shè)計(jì)。
在文本中,我們有20種不同的手臂,有12中手臂是不同的,很有用的。我們得出這樣的結(jié)論:五種手臂和兩種手腕是商業(yè)工業(yè)機(jī)器人的基本結(jié)構(gòu)。這種簡(jiǎn)化可能導(dǎo)致對(duì)手臂和手腕的不同組合的相應(yīng)配置逆運(yùn)動(dòng)學(xué)算法。
機(jī)器人的結(jié)構(gòu)設(shè)計(jì)機(jī)械手
在本文中,最佳的工作空間和簡(jiǎn)單,
我們假設(shè):
(一)具有六個(gè)自由度的機(jī)器人可以分為兩部分:連接組成的前三個(gè)關(guān)節(jié)和相關(guān)的鏈接被稱為ARM;剩余的關(guān)節(jié)聯(lián)動(dòng)相關(guān)鏈接是所謂的手腕。
(二)兩個(gè)環(huán)節(jié)由一個(gè)聯(lián)合低副連接。旋轉(zhuǎn)和直線連接中使用的機(jī)器人機(jī)械手。
(三)接頭的軸線是垂直或相互平行。
據(jù)作者所知,這種假設(shè)是適用于大多數(shù)的商業(yè)工業(yè)機(jī)器人。我們可以考慮結(jié)構(gòu)的手臂和手腕的分別。
對(duì)機(jī)器人的手臂結(jié)構(gòu)
(一) 圖形表示。畫一個(gè)機(jī)器人在側(cè)視圖或透視是復(fù)雜的和不放棄的各個(gè)環(huán)節(jié)中的相互關(guān)系,如何清晰的照片。在一個(gè)平面上畫一個(gè)機(jī)器人繪圖過(guò)于簡(jiǎn)單,并沒(méi)有給出一個(gè)明確的施工圖。我們妥協(xié)的這個(gè)問(wèn)題的一個(gè)簡(jiǎn)單的三維圖表示的機(jī)器人機(jī)械手的結(jié)構(gòu)和動(dòng)作。對(duì)不同關(guān)節(jié)表示的一種典型形式顯示在表:
表1 一個(gè)機(jī)器人的圖形表示
類型 運(yùn)動(dòng) 自由度 符號(hào)
1. 固定梁 固定 0
2. 轉(zhuǎn)動(dòng) 旋轉(zhuǎn) 1
3 線性 翻譯 1
1 2 3 4 5 6 7 8
RRR RRL RLR RLL LRR LRL LLR LLL
(二)相結(jié)合的關(guān)節(jié)。我們使用R來(lái)表示一個(gè)轉(zhuǎn)動(dòng)關(guān)節(jié)和L代表一個(gè)線性聯(lián)合。接頭不同的組合可以得到如下:
根據(jù)與平行或垂直的軸的不同組合,每一組合有四種亞相結(jié)合。因此,32的組合可以到達(dá):
(1) RRR R⊥R⊥R (2)RRL R⊥R⊥L
R⊥R‖R R⊥R‖L
R‖R⊥R R‖R⊥L
R‖R‖R R‖R‖L
(3) RLR R⊥L⊥R (4)RLL R⊥L⊥L
R⊥L‖R R⊥L‖L
R‖L⊥R R‖L⊥L
R‖L‖R R‖L‖L
(4) LRR L⊥R⊥R (5)LRL
收藏