Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)[課件

1、Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)機(jī)械電子工程原理機(jī)械電子工程原理第十七章第十七章 關(guān)節(jié)式機(jī)器人設(shè)計(jì)關(guān)節(jié)式機(jī)器人設(shè)計(jì)Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)217.1關(guān)節(jié)式機(jī)器人簡介關(guān)節(jié)式機(jī)器人簡介 n機(jī)器人是典型的機(jī)電一體化產(chǎn)品，一般由機(jī)械本機(jī)器人是典型的機(jī)電一體化產(chǎn)品，一般由機(jī)械本體，傳感器，控制器和功率驅(qū)動(dòng)器組成。體，傳感器，控制器和功率驅(qū)動(dòng)器組成。機(jī)械本體是機(jī)器人的執(zhí)行機(jī)構(gòu)；機(jī)械本體是機(jī)器人的執(zhí)行機(jī)構(gòu)；傳感器用于提供機(jī)器人本身或其所處環(huán)境的信息，從傳感器用于提供機(jī)器人本身或其所處環(huán)境的信息，從而對(duì)機(jī)械本體進(jìn)行精確控制；而對(duì)機(jī)械本體進(jìn)行精確控制；控制器用來產(chǎn)生指令信號(hào)，控制各關(guān)節(jié)運(yùn)動(dòng)坐標(biāo)的驅(qū)控制器用來產(chǎn)生

2、指令信號(hào)，控制各關(guān)節(jié)運(yùn)動(dòng)坐標(biāo)的驅(qū)動(dòng)器，使各臂桿端點(diǎn)按照要求的軌跡、速度和加速度，動(dòng)器，使各臂桿端點(diǎn)按照要求的軌跡、速度和加速度，以一定的姿態(tài)達(dá)到空間指定的位置；以一定的姿態(tài)達(dá)到空間指定的位置；功率驅(qū)動(dòng)器是將控制器輸出的信號(hào)變換成大功率的信功率驅(qū)動(dòng)器是將控制器輸出的信號(hào)變換成大功率的信號(hào)，以驅(qū)動(dòng)執(zhí)行器工作。號(hào)，以驅(qū)動(dòng)執(zhí)行器工作?，F(xiàn)代機(jī)器人系統(tǒng)還包括由許多精巧的傳感器以及各種現(xiàn)代機(jī)器人系統(tǒng)還包括由許多精巧的傳感器以及各種各樣的控制策略軟件。各樣的控制策略軟件。 Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)3反映機(jī)器人特性的基本參數(shù)反映機(jī)器人特性的基本參數(shù) n反映機(jī)器人特性的基本參數(shù)主要有工作空間、自反映機(jī)器人特性

3、的基本參數(shù)主要有工作空間、自由度、有效負(fù)載、運(yùn)動(dòng)精度、運(yùn)動(dòng)特性以及動(dòng)態(tài)由度、有效負(fù)載、運(yùn)動(dòng)精度、運(yùn)動(dòng)特性以及動(dòng)態(tài)特性等。特性等。工作空間通常指末端執(zhí)行器中心點(diǎn)在空間所能達(dá)到的工作空間通常指末端執(zhí)行器中心點(diǎn)在空間所能達(dá)到的范圍。范圍。機(jī)器人的自由度數(shù)一般就等于它的關(guān)節(jié)數(shù)，工業(yè)機(jī)器機(jī)器人的自由度數(shù)一般就等于它的關(guān)節(jié)數(shù)，工業(yè)機(jī)器人大多具有人大多具有46個(gè)自由度。個(gè)自由度。機(jī)器人的運(yùn)動(dòng)自由度數(shù)越多，它的功能就越強(qiáng)，結(jié)構(gòu)機(jī)器人的運(yùn)動(dòng)自由度數(shù)越多，它的功能就越強(qiáng)，結(jié)構(gòu)也越復(fù)雜。對(duì)于關(guān)節(jié)式機(jī)器人，在工作空間的邊緣，也越復(fù)雜。對(duì)于關(guān)節(jié)式機(jī)器人，在工作空間的邊緣，可能存在自由度退化現(xiàn)象。可能存在自由度退化現(xiàn)象。

4、Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)4機(jī)器人的運(yùn)動(dòng)精度機(jī)器人的運(yùn)動(dòng)精度 n機(jī)器人的運(yùn)動(dòng)精度涉及位置精度機(jī)器人的運(yùn)動(dòng)精度涉及位置精度h、重復(fù)位置精度、重復(fù)位置精度B和和系統(tǒng)分辨率。系統(tǒng)分辨率。位置精度位置精度h指機(jī)械本體的手臂端點(diǎn)實(shí)際到達(dá)的位置分布曲線指機(jī)械本體的手臂端點(diǎn)實(shí)際到達(dá)的位置分布曲線的中心和目標(biāo)點(diǎn)之間坐標(biāo)距離的大小。的中心和目標(biāo)點(diǎn)之間坐標(biāo)距離的大小。重復(fù)位置精度重復(fù)位置精度B是指手臂端點(diǎn)實(shí)際到達(dá)點(diǎn)分布曲線的寬度。是指手臂端點(diǎn)實(shí)際到達(dá)點(diǎn)分布曲線的寬度。系統(tǒng)分辨率是在機(jī)械系統(tǒng)設(shè)計(jì)時(shí)確定的。系統(tǒng)分辨率是在機(jī)械系統(tǒng)設(shè)計(jì)時(shí)確定的。 BhAA向(放大)Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)517.2總體設(shè)計(jì)總體設(shè)計(jì)

5、 n系統(tǒng)分析系統(tǒng)分析 系統(tǒng)分析的主要目的是確定機(jī)器人系統(tǒng)的使用場合、系統(tǒng)分析的主要目的是確定機(jī)器人系統(tǒng)的使用場合、工作環(huán)境和工作要求。工作環(huán)境和工作要求。本機(jī)器人系統(tǒng)主要作為教學(xué)研究用，其工作環(huán)境為教本機(jī)器人系統(tǒng)主要作為教學(xué)研究用，其工作環(huán)境為教學(xué)實(shí)驗(yàn)室，要求它能夠進(jìn)行連續(xù)軌跡控制，同時(shí)應(yīng)具學(xué)實(shí)驗(yàn)室，要求它能夠進(jìn)行連續(xù)軌跡控制，同時(shí)應(yīng)具有行程控制功能，在異常情況時(shí)能夠人工制動(dòng)，保護(hù)有行程控制功能，在異常情況時(shí)能夠人工制動(dòng)，保護(hù)電機(jī)、減速器以及手臂等。電機(jī)、減速器以及手臂等。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)6技術(shù)設(shè)計(jì)技術(shù)設(shè)計(jì)n機(jī)器人基本參數(shù)的確定機(jī)器人基本參數(shù)的確定 末端負(fù)載末端負(fù)載質(zhì)量質(zhì)量1kg允

6、許轉(zhuǎn)矩允許轉(zhuǎn)矩腰關(guān)節(jié)（腰關(guān)節(jié)（S軸）軸）6Nm肩關(guān)節(jié)（肩關(guān)節(jié)（L軸）軸）6Nm肘關(guān)節(jié)（肘關(guān)節(jié)（U軸）軸）3Nm工作范圍工作范圍S軸軸-170+170L軸軸-45+150U軸軸-170+170最大運(yùn)動(dòng)最大運(yùn)動(dòng)速度速度S軸（旋轉(zhuǎn)）軸（旋轉(zhuǎn)）210/sL軸（旋轉(zhuǎn)）軸（旋轉(zhuǎn)）170/sU軸（旋轉(zhuǎn)）軸（旋轉(zhuǎn)）225/s定位精度定位精度末端重復(fù)定位精度末端重復(fù)定位精度0.1mmCh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)7機(jī)器人運(yùn)動(dòng)形式的選擇機(jī)器人運(yùn)動(dòng)形式的選擇 n機(jī)器人的運(yùn)動(dòng)形式常見有五種：直角坐標(biāo)型、圓柱坐機(jī)器人的運(yùn)動(dòng)形式常見有五種：直角坐標(biāo)型、圓柱坐標(biāo)型、球坐標(biāo)型、關(guān)節(jié)型和標(biāo)型、球坐標(biāo)型、關(guān)節(jié)型和SCARA型。型。

7、n運(yùn)動(dòng)形式的選擇原則是，在滿足需要的情況下，使自運(yùn)動(dòng)形式的選擇原則是，在滿足需要的情況下，使自由度最少，結(jié)構(gòu)最簡單。由度最少，結(jié)構(gòu)最簡單。 (d)(e)(c)(b)(a)(a)直角坐標(biāo)型(b)圓柱坐標(biāo)型 (c)球坐標(biāo)型 (d)關(guān)節(jié)型 (e)SCARA型Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)8機(jī)器人運(yùn)動(dòng)形式的選擇機(jī)器人運(yùn)動(dòng)形式的選擇n本章設(shè)計(jì)的機(jī)器人系統(tǒng)采用關(guān)節(jié)型三自由度的運(yùn)動(dòng)形本章設(shè)計(jì)的機(jī)器人系統(tǒng)采用關(guān)節(jié)型三自由度的運(yùn)動(dòng)形式。關(guān)節(jié)型結(jié)構(gòu)形式的機(jī)器人動(dòng)作靈活，工作空間大，式。關(guān)節(jié)型結(jié)構(gòu)形式的機(jī)器人動(dòng)作靈活，工作空間大，在作業(yè)空間內(nèi)手臂的干涉最小，結(jié)構(gòu)緊湊，占地面積在作業(yè)空間內(nèi)手臂的干涉最小，結(jié)構(gòu)緊湊，占地

8、面積小，關(guān)節(jié)上相對(duì)部位容易密封防塵。小，關(guān)節(jié)上相對(duì)部位容易密封防塵。 兩臺(tái)同型號(hào)的伺服電機(jī)對(duì)稱布置在腰座上，一臺(tái)驅(qū)動(dòng)L臂，一臺(tái)驅(qū)動(dòng)L臂上的同步齒輪，經(jīng)同步帶傳動(dòng)U臂，系統(tǒng)容易獲得靜態(tài)平衡，慣量減小，穩(wěn)定性得到提高。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)9確定控制系統(tǒng)總體方案確定控制系統(tǒng)總體方案 n本機(jī)器人系統(tǒng)的控本機(jī)器人系統(tǒng)的控制系統(tǒng)采用制系統(tǒng)采用PC+DSP運(yùn)動(dòng)卡的控制模式，運(yùn)動(dòng)卡的控制模式，利用了以利用了以DSP為核心為核心的多軸運(yùn)動(dòng)控制技的多軸運(yùn)動(dòng)控制技術(shù)，實(shí)現(xiàn)對(duì)多軸伺術(shù)，實(shí)現(xiàn)對(duì)多軸伺服作業(yè)系統(tǒng)的直接服作業(yè)系統(tǒng)的直接控制，構(gòu)成了新一控制，構(gòu)成了新一代的開放式機(jī)器人代的開放式機(jī)器人通用控制系統(tǒng)。通用

9、控制系統(tǒng)。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)10確定控制系統(tǒng)總體方案確定控制系統(tǒng)總體方案nPMAC（Programmable Multi-Axis Controller）是美國是美國DELTA TAU公司九十年代推出的基于公司九十年代推出的基于DSP的開放式可編程多軸運(yùn)動(dòng)控制器，提供多軸插補(bǔ)的開放式可編程多軸運(yùn)動(dòng)控制器，提供多軸插補(bǔ)計(jì)算、運(yùn)動(dòng)控制、用戶輔助計(jì)算、運(yùn)動(dòng)控制、用戶輔助PLC編程以及數(shù)據(jù)采編程以及數(shù)據(jù)采集處理等功能。集處理等功能。 n設(shè)計(jì)的基于設(shè)計(jì)的基于PC+PMAC運(yùn)動(dòng)卡的開放式三關(guān)節(jié)機(jī)運(yùn)動(dòng)卡的開放式三關(guān)節(jié)機(jī)械手控制器采用標(biāo)準(zhǔn)工業(yè)械手控制器采用標(biāo)準(zhǔn)工業(yè)PC機(jī)作為硬件平臺(tái)，處機(jī)作為硬件平臺(tái)

10、，處理機(jī)械手控制中的非實(shí)時(shí)任務(wù)；實(shí)時(shí)任務(wù)由理機(jī)械手控制中的非實(shí)時(shí)任務(wù)；實(shí)時(shí)任務(wù)由PMAC運(yùn)動(dòng)控制卡處理。運(yùn)動(dòng)控制卡可控制伺服運(yùn)動(dòng)控制卡處理。運(yùn)動(dòng)控制卡可控制伺服電機(jī)驅(qū)動(dòng)機(jī)械手的各個(gè)關(guān)節(jié)，使機(jī)械手末端按預(yù)電機(jī)驅(qū)動(dòng)機(jī)械手的各個(gè)關(guān)節(jié)，使機(jī)械手末端按預(yù)定的軌跡運(yùn)動(dòng)。定的軌跡運(yùn)動(dòng)。 Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)11機(jī)械結(jié)構(gòu)設(shè)計(jì)機(jī)械結(jié)構(gòu)設(shè)計(jì) n機(jī)械結(jié)構(gòu)設(shè)計(jì)的目的是確定驅(qū)動(dòng)方式，選擇運(yùn)動(dòng)機(jī)械結(jié)構(gòu)設(shè)計(jì)的目的是確定驅(qū)動(dòng)方式，選擇運(yùn)動(dòng)部件和設(shè)計(jì)具體結(jié)構(gòu)，繪制機(jī)器人總裝圖及主要部件和設(shè)計(jì)具體結(jié)構(gòu)，繪制機(jī)器人總裝圖及主要部件零件圖。部件零件圖。n各關(guān)節(jié)上采用的電機(jī)及驅(qū)動(dòng)器型號(hào)如下表所示各關(guān)節(jié)上采用的電機(jī)及驅(qū)動(dòng)器型號(hào)如

11、下表所示 伺服驅(qū)動(dòng)系統(tǒng)伺服驅(qū)動(dòng)系統(tǒng)關(guān)節(jié)部位關(guān)節(jié)部位電機(jī)電機(jī)驅(qū)動(dòng)器驅(qū)動(dòng)器腰關(guān)節(jié)腰關(guān)節(jié)MSMA022C1HMSDA023D1A肩關(guān)節(jié)、肘關(guān)節(jié)肩關(guān)節(jié)、肘關(guān)節(jié)MSMA5AZC1HMSDA5A3D1A諧波減速器諧波減速器腰關(guān)節(jié)腰關(guān)節(jié)XB3-80-100I肩關(guān)節(jié)、肘關(guān)節(jié)肩關(guān)節(jié)、肘關(guān)節(jié)XB3-50-100ICh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)12機(jī)器人系統(tǒng)本體裝配圖機(jī)器人系統(tǒng)本體裝配圖 n與傳統(tǒng)的機(jī)械機(jī)與傳統(tǒng)的機(jī)械機(jī)構(gòu)相比，機(jī)器人構(gòu)相比，機(jī)器人的本體集支撐、的本體集支撐、連接和執(zhí)行三大連接和執(zhí)行三大功能于一身，它功能于一身，它是機(jī)器人設(shè)計(jì)的是機(jī)器人設(shè)計(jì)的重要部分。重要部分。 1-基座 2-電機(jī) 3-減速器 4-軸承

12、 5-腰關(guān)節(jié) 6-腰部 7-肩關(guān)節(jié) 8-電機(jī) 9-法蘭 10-同步帶 11-臂板 12-小臂主體 13-小臂擴(kuò)展體Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)13仿真分析仿真分析 n仿真分析的目的是：仿真分析的目的是：（1）運(yùn)動(dòng)學(xué)計(jì)算。分析是否能夠達(dá)到要求的速度、加）運(yùn)動(dòng)學(xué)計(jì)算。分析是否能夠達(dá)到要求的速度、加速度和位置；速度和位置；（2）動(dòng)力學(xué)計(jì)算。計(jì)算關(guān)節(jié)驅(qū)動(dòng)力的大小，分析驅(qū)動(dòng)）動(dòng)力學(xué)計(jì)算。計(jì)算關(guān)節(jié)驅(qū)動(dòng)力的大小，分析驅(qū)動(dòng)裝置是否滿足要求；裝置是否滿足要求；（3）運(yùn)動(dòng)的動(dòng)態(tài)仿真。將每一位姿用三維圖形連續(xù)顯）運(yùn)動(dòng)的動(dòng)態(tài)仿真。將每一位姿用三維圖形連續(xù)顯示出來，實(shí)現(xiàn)機(jī)器人的運(yùn)動(dòng)仿真；示出來，實(shí)現(xiàn)機(jī)器人的運(yùn)動(dòng)仿真；（

13、4）性能分析。建立機(jī)器人數(shù)學(xué)模型，對(duì)機(jī)器人動(dòng)態(tài)）性能分析。建立機(jī)器人數(shù)學(xué)模型，對(duì)機(jī)器人動(dòng)態(tài)性能進(jìn)行仿真計(jì)算；性能進(jìn)行仿真計(jì)算；（5）方案和參數(shù)修改。運(yùn)用仿真分析的結(jié)果對(duì)所設(shè)計(jì)）方案和參數(shù)修改。運(yùn)用仿真分析的結(jié)果對(duì)所設(shè)計(jì)的方案、結(jié)構(gòu)、尺寸和參數(shù)進(jìn)行修改，加以完善。的方案、結(jié)構(gòu)、尺寸和參數(shù)進(jìn)行修改，加以完善。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)14仿真分析仿真分析n機(jī)器人的本體可以看作由幾個(gè)獨(dú)立運(yùn)動(dòng)桿件以旋機(jī)器人的本體可以看作由幾個(gè)獨(dú)立運(yùn)動(dòng)桿件以旋轉(zhuǎn)或位移的關(guān)節(jié)組成的機(jī)構(gòu)，每一個(gè)關(guān)節(jié)上安裝轉(zhuǎn)或位移的關(guān)節(jié)組成的機(jī)構(gòu)，每一個(gè)關(guān)節(jié)上安裝有傳感器檢測各個(gè)關(guān)節(jié)的位移有傳感器檢測各個(gè)關(guān)節(jié)的位移qi(t)。機(jī)器人的運(yùn)。

14、機(jī)器人的運(yùn)動(dòng)學(xué)分析涉及到兩個(gè)問題：動(dòng)學(xué)分析涉及到兩個(gè)問題：(1) 對(duì)一給定的機(jī)器人，已知桿件的幾何參數(shù)和關(guān)節(jié)位對(duì)一給定的機(jī)器人，已知桿件的幾何參數(shù)和關(guān)節(jié)位移矢量移矢量Q(t)=q1(t), q2(t), , qn(t)(n為自由度數(shù)為自由度數(shù))，求機(jī)，求機(jī)器人操作器相對(duì)于參考坐標(biāo)系的位置和姿態(tài)（器人操作器相對(duì)于參考坐標(biāo)系的位置和姿態(tài)（運(yùn)動(dòng)學(xué)運(yùn)動(dòng)學(xué)正問題正問題）；）；(2) 已知機(jī)器人的桿件幾何參數(shù)，給定機(jī)器人的末端操已知機(jī)器人的桿件幾何參數(shù)，給定機(jī)器人的末端操作器相對(duì)于參考坐標(biāo)系的期望位姿，求解其對(duì)應(yīng)的關(guān)作器相對(duì)于參考坐標(biāo)系的期望位姿，求解其對(duì)應(yīng)的關(guān)節(jié)位移矢量（節(jié)位移矢量（運(yùn)動(dòng)學(xué)逆問題運(yùn)動(dòng)學(xué)逆

15、問題）。）。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)15位姿矩陣與逆陣位姿矩陣與逆陣 n機(jī)器人是通過控制關(guān)節(jié)位移矢量，來實(shí)現(xiàn)和操作機(jī)器人是通過控制關(guān)節(jié)位移矢量，來實(shí)現(xiàn)和操作本體完成要求的作業(yè)的。而作業(yè)通常在參考坐標(biāo)本體完成要求的作業(yè)的。而作業(yè)通常在參考坐標(biāo)系中說明，因此要頻繁地求解運(yùn)動(dòng)學(xué)逆問題。在系中說明，因此要頻繁地求解運(yùn)動(dòng)學(xué)逆問題。在大量的機(jī)器人問題中，涉及到用不同的參考坐標(biāo)大量的機(jī)器人問題中，涉及到用不同的參考坐標(biāo)系表示同一位姿的問題。系表示同一位姿的問題。 n剛體的位置、姿態(tài)可用其上的任一基準(zhǔn)點(diǎn)（通常剛體的位置、姿態(tài)可用其上的任一基準(zhǔn)點(diǎn)（通常為物體的質(zhì)心）和過該點(diǎn)的坐標(biāo)系相對(duì)于參考坐為物體的質(zhì)心）

16、和過該點(diǎn)的坐標(biāo)系相對(duì)于參考坐標(biāo)系的相對(duì)關(guān)系來確定。引進(jìn)齊次坐標(biāo)標(biāo)系的相對(duì)關(guān)系來確定。引進(jìn)齊次坐標(biāo)(X,Y,Z,1)T，可用四階方陣表示兩坐標(biāo)系間的關(guān)系，即可用四階方陣表示兩坐標(biāo)系間的關(guān)系，即位姿矩位姿矩陣與逆陣陣與逆陣 。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)16兩剛體間的坐標(biāo)變換兩剛體間的坐標(biāo)變換 n設(shè)有一剛體設(shè)有一剛體A，選其上的，選其上的P為基準(zhǔn)點(diǎn)，為基準(zhǔn)點(diǎn)，P在剛體在剛體A上上的直角坐標(biāo)系的直角坐標(biāo)系Oi Xi Yi Zi中的齊次坐標(biāo)為中的齊次坐標(biāo)為(Xi1 Xi2 Xi3 Xi4)T，P在另一剛體在另一剛體B上直角坐標(biāo)系上直角坐標(biāo)系Oj Xj Yj Zj中的中的齊次坐標(biāo)為齊次坐標(biāo)為(Xj1 X

17、j2 Xj3 Xj4)T。 AXjYjZjXiYiPBOjOiZiCh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)17兩剛體間的坐標(biāo)變換兩剛體間的坐標(biāo)變換n坐標(biāo)系坐標(biāo)系j可以看作坐標(biāo)系可以看作坐標(biāo)系i的原點(diǎn)的原點(diǎn)Oi沿沿Zi移動(dòng)移動(dòng)di到達(dá)到達(dá)Oi，然后繞軸轉(zhuǎn)然后繞軸轉(zhuǎn)角，再沿角，再沿Xj軸移動(dòng)距離軸移動(dòng)距離aj到達(dá)原點(diǎn)到達(dá)原點(diǎn)Oj，再，再繞繞Xj軸轉(zhuǎn)軸轉(zhuǎn)角。角。n利用空間坐標(biāo)系的變換關(guān)系，可以得到兩坐標(biāo)系間的利用空間坐標(biāo)系的變換關(guān)系，可以得到兩坐標(biāo)系間的變換矩陣為：變換矩陣為： cossin cossin coscossincos coscos sinsin0sincos00010001jijijjijiaoo

18、adqqaqaqqqaqaqaa輊-犏輊 輊犏-犏犏 臌犏=犏犏犏犏臌犏臌RTcossin0sin coscos cossincossin coscos sincoscos00010001jjijiijiiao oddqqqaqaaaqaqaaa輊-犏輊 輊犏-犏犏 臌犏=犏犏-犏犏臌犏臌RTCh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)18n齊次坐標(biāo)矩陣可以分解為一個(gè)平移和一個(gè)旋轉(zhuǎn)矩齊次坐標(biāo)矩陣可以分解為一個(gè)平移和一個(gè)旋轉(zhuǎn)矩陣之積，即陣之積，即 式中，式中，Trans(px ,py, pz)為平移齊次坐標(biāo)變換矩陣，平移為平移齊次坐標(biāo)變換矩陣，平移矢量為矢量為px, py, pzT；Rot(k,)為旋轉(zhuǎn)齊次坐標(biāo)

19、變換矩陣；為旋轉(zhuǎn)齊次坐標(biāo)變換矩陣；k為表示旋轉(zhuǎn)軸線方向的單位矢量；為表示旋轉(zhuǎn)軸線方向的單位矢量；為轉(zhuǎn)角。為轉(zhuǎn)角。 兩剛體間的坐標(biāo)變換兩剛體間的坐標(biāo)變換3 300Trans(,)Rot( , )0010001xxxxyyyyijxyzzzzzpnoapnoapppkpnoaq輊輊犏犏犏犏犏犏=犏犏犏犏犏犏臌臌ITCh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)19兩剛體間的坐標(biāo)變換兩剛體間的坐標(biāo)變換n平移變換用于兩個(gè)矢量的相加。繞齊次坐標(biāo)軸的平移變換用于兩個(gè)矢量的相加。繞齊次坐標(biāo)軸的旋轉(zhuǎn)變換如下：旋轉(zhuǎn)變換如下：10000cossin0Rot( , )0sincos00001xqqqqq輊犏犏-犏=犏犏犏臌cos0s

20、in00100Rot( , )sin0cos00001yqqqqq輊犏犏犏=犏-犏犏臌cossin00sincos00Rot( , )00100001zqqqqq輊-犏犏犏=犏犏犏臌Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)20多剛體間的位姿關(guān)系及矩陣方程多剛體間的位姿關(guān)系及矩陣方程 n由于機(jī)器人是由多個(gè)剛體（連桿）組成的，在進(jìn)行機(jī)由于機(jī)器人是由多個(gè)剛體（連桿）組成的，在進(jìn)行機(jī)器人運(yùn)動(dòng)分析時(shí)，常要用到合成齊次變換。齊次變換器人運(yùn)動(dòng)分析時(shí)，常要用到合成齊次變換。齊次變換矩陣可以表示一連串旋轉(zhuǎn)和平移的最終結(jié)果。矩陣可以表示一連串旋轉(zhuǎn)和平移的最終結(jié)果。n合成齊次變換矩陣相乘的法則如下：合成齊次變換矩陣相乘的法則如

21、下：(1) 兩坐標(biāo)系最初相重合，因此齊次變換矩陣是兩坐標(biāo)系最初相重合，因此齊次變換矩陣是44的單位的單位矩陣矩陣I44;(2) 若動(dòng)坐標(biāo)系若動(dòng)坐標(biāo)系B繞（沿）固定的基礎(chǔ)參考系繞（沿）固定的基礎(chǔ)參考系A(chǔ)的軸轉(zhuǎn)動(dòng)的軸轉(zhuǎn)動(dòng)（平移），則用相應(yīng)的基本齊次旋轉(zhuǎn)（平移）矩陣左乘原有（平移），則用相應(yīng)的基本齊次旋轉(zhuǎn)（平移）矩陣左乘原有的齊次變換矩陣；的齊次變換矩陣；(3) 若動(dòng)坐標(biāo)系若動(dòng)坐標(biāo)系B繞（沿）它自己的移動(dòng)軸轉(zhuǎn)動(dòng)（平移），繞（沿）它自己的移動(dòng)軸轉(zhuǎn)動(dòng)（平移），則用相應(yīng)的基本齊次旋轉(zhuǎn)（平移）矩陣右乘原有的齊次變換則用相應(yīng)的基本齊次旋轉(zhuǎn)（平移）矩陣右乘原有的齊次變換矩陣。矩陣。n上述規(guī)律可簡單地記作上述規(guī)律

22、可簡單地記作“左基右移左基右移”。 Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)21n例如，已知例如，已知B坐標(biāo)系是與固定的參考系坐標(biāo)系是與固定的參考系A(chǔ)重合重合的坐標(biāo)系，需要經(jīng)過以下處理的坐標(biāo)系，需要經(jīng)過以下處理 (1) 繞參考系繞參考系A(chǔ)的的YA軸轉(zhuǎn)過軸轉(zhuǎn)過角；角；(2) 再繞動(dòng)坐標(biāo)系的當(dāng)前再繞動(dòng)坐標(biāo)系的當(dāng)前ZB轉(zhuǎn)過轉(zhuǎn)過角；角；(3) 再繞參考系再繞參考系A(chǔ)的的ZA軸轉(zhuǎn)過軸轉(zhuǎn)過角；角；(4) 最后繞動(dòng)坐標(biāo)系的當(dāng)前最后繞動(dòng)坐標(biāo)系的當(dāng)前XA軸轉(zhuǎn)過軸轉(zhuǎn)過角。角。n相應(yīng)的合成齊次變換矩陣為相應(yīng)的合成齊次變換矩陣為多剛體間的位姿關(guān)系及矩陣方程多剛體間的位姿關(guān)系及矩陣方程 (3) (1) (2) (4) 4 4 (,

23、 ) (, ) ( , ) (, )ABAABATT R ZT R YIT R ZT R Xbfqa=販販Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)22機(jī)器人的位姿方程機(jī)器人的位姿方程n上面的變換矩陣是由上面的變換矩陣是由J.Denavit 和和R.S.Harterberg在在1955年年提出的齊次坐標(biāo)變換矩陣方法，也稱作提出的齊次坐標(biāo)變換矩陣方法，也稱作D-H矩陣法，它可矩陣法，它可以同時(shí)表示剛體的位置、姿態(tài)，在機(jī)器人運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)以同時(shí)表示剛體的位置、姿態(tài)，在機(jī)器人運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)分析得到了廣泛的應(yīng)用。分析得到了廣泛的應(yīng)用。 關(guān)節(jié)軸(i)關(guān)節(jié)軸（i1）平行于關(guān)節(jié)軸i的直線連桿(i)長度(i)扭度(i)Yi

24、ZiXiOiZi+1Oi+1Yi+1Xi+1Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)23機(jī)器人的位姿方程機(jī)器人的位姿方程 n采用采用D-H方法，對(duì)上頁圖示的用回轉(zhuǎn)副連接的兩桿件，方法，對(duì)上頁圖示的用回轉(zhuǎn)副連接的兩桿件，連桿附體坐標(biāo)系的選擇及參數(shù)的規(guī)定如下：連桿附體坐標(biāo)系的選擇及參數(shù)的規(guī)定如下：(1) Zi坐標(biāo)軸是沿著坐標(biāo)軸是沿著i+1關(guān)節(jié)的運(yùn)動(dòng)軸。關(guān)節(jié)的運(yùn)動(dòng)軸。(2) Xi軸是沿著軸是沿著Zi和和Zi-1的公法線，指向離開的公法線，指向離開Zi-1軸的方向；軸的方向；(3) Yi軸的方向是按使軸的方向是按使Xi Yi Zi構(gòu)成右手直角坐標(biāo)系來建立；構(gòu)成右手直角坐標(biāo)系來建立；(4) 兩公法線兩公法線ai-1

25、和和ai之間的距離稱為連桿距離之間的距離稱為連桿距離di；(5) 公法線長度公法線長度ai是是Zi-1和和Zi兩軸間的最小距離，兩軸間的最小距離，ai被定義為被定義為連桿的長度；連桿的長度；(6) Xi-1軸與軸與Xi軸間的夾角為軸間的夾角為i，以繞，以繞Zi-1軸右旋為正，軸右旋為正，i為二為二連桿夾角。連桿夾角。(7) Zi-1軸與軸與Zi軸間的夾角為軸間的夾角為i，以繞，以繞Xi軸右旋為正，軸右旋為正，i為連為連桿桿i的扭歪角。的扭歪角。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)24機(jī)器人的位姿方程機(jī)器人的位姿方程n按照按照D-H法對(duì)每一連桿建立了坐標(biāo)系后，便可建立相鄰兩連法對(duì)每一連桿建立了坐標(biāo)系后，

26、便可建立相鄰兩連桿間的相對(duì)位姿矩陣桿間的相對(duì)位姿矩陣 ，它是相鄰坐標(biāo)系，它是相鄰坐標(biāo)系i-1和和i之間的位姿之間的位姿矩陣，稱為相鄰坐標(biāo)系矩陣，稱為相鄰坐標(biāo)系i-1和和i的的D-H變換矩陣，表示為變換矩陣，表示為n這個(gè)矩陣稱為這個(gè)矩陣稱為Ai矩陣。它的逆矩陣為矩陣。它的逆矩陣為 A1ii-111 (,) (,) ( ,) ( ,)iiiiiiiiiT R zT trans zdT trans x aT R xiqa-=Acoscossinsinsincossincoscossincossin0sincos0001iiiiiiiiiiiiiiiiiaadqaqaqqqaqaqqaa輊-犏犏-犏=

27、犏犏犏臌11cossin0cossincoscossinsinsinsinsincoscoscos0001iiiiiiiiiiiiiiiiiiiiaddqqaqaqaaaqaqaa-輊-犏犏-犏=犏-犏犏臌AACh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)25機(jī)器人的位姿方程機(jī)器人的位姿方程 n第第i坐標(biāo)系相對(duì)與機(jī)座坐標(biāo)系的位姿齊次矩陣坐標(biāo)系相對(duì)與機(jī)座坐標(biāo)系的位姿齊次矩陣 是是各坐標(biāo)系變換矩陣各坐標(biāo)系變換矩陣Ai的連乘積，即的連乘積，即 =A1(q1)A2(q2)A3(q3)Ai(qi)式中，式中，qi為關(guān)節(jié)變量。為關(guān)節(jié)變量。對(duì)轉(zhuǎn)動(dòng)關(guān)節(jié)，對(duì)轉(zhuǎn)動(dòng)關(guān)節(jié)，qi= i。當(dāng)。當(dāng)i=6時(shí)，時(shí)， 便是六自由度機(jī)器便是六自由度

28、機(jī)器人的端部相對(duì)于機(jī)座坐標(biāo)系的位置和姿態(tài)。人的端部相對(duì)于機(jī)座坐標(biāo)系的位置和姿態(tài)。n上式稱為機(jī)器人的位姿方程。上式稱為機(jī)器人的位姿方程。T0i06T0iTCh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)26機(jī)器人的位姿方程機(jī)器人的位姿方程 n對(duì)于三關(guān)節(jié)式機(jī)械手，設(shè)置的機(jī)械手本體坐標(biāo)系對(duì)于三關(guān)節(jié)式機(jī)械手，設(shè)置的機(jī)械手本體坐標(biāo)系如圖示。如圖示。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)27機(jī)器人的位姿方程機(jī)器人的位姿方程n采用采用D-H方法建立系統(tǒng)的位姿矩陣方法建立系統(tǒng)的位姿矩陣 ，具體表示，具體表示為：為：式中，式中，si=sini，ci=cosi，i=1,2,3。T031 2 31 2 311 2 31 2 31 2 31 2

29、31 21231 2 311 2 31 231 2 31 2 31 2032 32 3232 32 3232260()260()0260()3000001s s ss c ccs s cs c ss s cs c ss sc s sc c csc s cc c csc s cc c sc sc ss cc cs sc cs sc輊-+-+犏犏-+-+犏=犏-+犏犏臌TCh17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)28機(jī)器人的工作空間機(jī)器人的工作空間 n機(jī)器人的工作空間可用幾何計(jì)算法得到。機(jī)器人的工作空間可用幾何計(jì)算法得到。（1）以）以3為參量，為參量，2為變量，得到以為變量，得到以(0, 300)為圓心，為圓心

30、，半徑為半徑為 的圓族。的圓族。 （2）以）以2為參量，為參量，3為變量，得到以為變量，得到以(260sin2, 300+cos2)為圓心，半徑為為圓心，半徑為260的圓族。的圓族。 3520cos2ZYZOOXTT33322322310260sinsin()260coscos()3001oooxyzqqqqqq=+Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)2917.3 機(jī)器人本體系統(tǒng)設(shè)計(jì)機(jī)器人本體系統(tǒng)設(shè)計(jì) n本體設(shè)計(jì)包括確定機(jī)器人驅(qū)動(dòng)方式、關(guān)節(jié)驅(qū)動(dòng)方本體設(shè)計(jì)包括確定機(jī)器人驅(qū)動(dòng)方式、關(guān)節(jié)驅(qū)動(dòng)方式、材料選擇、平衡系統(tǒng)設(shè)計(jì)以及零部件設(shè)計(jì)。式、材料選擇、平衡系統(tǒng)設(shè)計(jì)以及零部件設(shè)計(jì)。機(jī)器人驅(qū)動(dòng)方式有電動(dòng)、液壓和氣動(dòng)

31、三種。電動(dòng)驅(qū)動(dòng)機(jī)器人驅(qū)動(dòng)方式有電動(dòng)、液壓和氣動(dòng)三種。電動(dòng)驅(qū)動(dòng)系統(tǒng)適合于中等負(fù)載、動(dòng)作復(fù)雜以及運(yùn)動(dòng)軌跡嚴(yán)格的系統(tǒng)適合于中等負(fù)載、動(dòng)作復(fù)雜以及運(yùn)動(dòng)軌跡嚴(yán)格的場合。場合。關(guān)節(jié)驅(qū)動(dòng)方式有直接驅(qū)動(dòng)和間接驅(qū)動(dòng)兩種。關(guān)節(jié)直接關(guān)節(jié)驅(qū)動(dòng)方式有直接驅(qū)動(dòng)和間接驅(qū)動(dòng)兩種。關(guān)節(jié)直接驅(qū)動(dòng)機(jī)器人（驅(qū)動(dòng)機(jī)器人（DDR）將電機(jī)直接做在關(guān)節(jié)上。目前大）將電機(jī)直接做在關(guān)節(jié)上。目前大部分機(jī)器人的關(guān)節(jié)是間接驅(qū)動(dòng)，即電機(jī)通過減速裝置部分機(jī)器人的關(guān)節(jié)是間接驅(qū)動(dòng)，即電機(jī)通過減速裝置與關(guān)節(jié)軸相連。與關(guān)節(jié)軸相連。在選擇機(jī)器人的制造材料時(shí)要綜合考慮材料的強(qiáng)度、在選擇機(jī)器人的制造材料時(shí)要綜合考慮材料的強(qiáng)度、剛度、比重、彈性、抗振性、可加工性、外觀及

32、價(jià)格剛度、比重、彈性、抗振性、可加工性、外觀及價(jià)格等。常用的材料有碳素結(jié)構(gòu)鋼、合金結(jié)構(gòu)鋼、鋁、鋁等。常用的材料有碳素結(jié)構(gòu)鋼、合金結(jié)構(gòu)鋼、鋁、鋁合金及其它輕合金，纖維增強(qiáng)合金等等。本系統(tǒng)采用合金及其它輕合金，纖維增強(qiáng)合金等等。本系統(tǒng)采用鋁合金材料鑄造殼體。鋁合金材料鑄造殼體。Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)30機(jī)器人本體系統(tǒng)設(shè)計(jì)機(jī)器人本體系統(tǒng)設(shè)計(jì)n在機(jī)器人的設(shè)計(jì)中，在機(jī)器人的設(shè)計(jì)中，可選擇通用的標(biāo)準(zhǔn)可選擇通用的標(biāo)準(zhǔn)零部件，如伺服電零部件，如伺服電機(jī)、減速器、傳感機(jī)、減速器、傳感器和手爪等。對(duì)一器和手爪等。對(duì)一些專用部件則需要些專用部件則需要自行設(shè)計(jì)，如底座、自行設(shè)計(jì)，如底座、手臂和交叉滾子軸手臂和交叉滾子軸承等。承等。 Ch17關(guān)節(jié)式機(jī)械人系統(tǒng)設(shè)計(jì)3117.4 機(jī)器人控制系統(tǒng)設(shè)計(jì)機(jī)器人控制系統(tǒng)設(shè)計(jì) n本系統(tǒng)采用分散控制方式，由一臺(tái)工業(yè)控制計(jì)算機(jī)，進(jìn)行本系統(tǒng)采用分散控制方式，由一臺(tái)工業(yè)控制計(jì)算機(jī)，進(jìn)行大間隔的插補(bǔ)指令值的計(jì)算，在各個(gè)關(guān)節(jié)軸上用大間隔的插補(bǔ)指令值的計(jì)算，在各個(gè)關(guān)節(jié)軸上用PMAC多多軸運(yùn)動(dòng)控制卡進(jìn)行小間隔的插補(bǔ)運(yùn)算和伺服系統(tǒng)的處理。軸運(yùn)動(dòng)控制卡進(jìn)行小間隔的插補(bǔ)運(yùn)算和伺服系統(tǒng)的處理。系統(tǒng)由鼠標(biāo)和鍵盤擔(dān)任輸入、輸出控制等功能，如圖所示系統(tǒng)由鼠標(biāo)和鍵盤擔(dān)