《六自由度搬運機械手結(jié)構(gòu)設(shè)計[答辯畢業(yè)論文 資料 ]》由會員分享，可在線閱讀，更多相關(guān)《六自由度搬運機械手結(jié)構(gòu)設(shè)計[答辯畢業(yè)論文 資料 ]（64頁珍藏版）》請在裝配圖網(wǎng)上搜索。

六自由度搬運機械手結(jié)構(gòu)設(shè)計目 錄目 錄 .........................................................................................................................................................- 1 -摘 要 .........................................................................................................................................................- 3 -Abstract .....................................................................................................................................................- 4 -第一章 緒論 .............................................................................................................................................- 5 -1.1 工業(yè)機械手的概述 .....................................................................................................................- 5 -1.2　 本論文研究的主要內(nèi)容 ...........................................................................................................- 5 -第二章 機械手方案的創(chuàng)成和機械設(shè)計 .................................................................................................- 6 -2.1 機械手機械設(shè)計的特點 ...........................................................................................................- 6 -2.2 與機械手有關(guān)的概念 ...............................................................................................................- 6 -2.3 設(shè)計方案 .....................................................................................................................................- 7 -2.3.1 方案要求 .......................................................................................................................- 7 -2.3.2 方案功能設(shè)計與分析 ...................................................................................................- 7 -2.5 后軸和大臂板剛度和強度分析 .............................................................................................- 10 -2.5.1 后軸和大臂板有限元模型的建立與解析 .................................................................- 11 -2.5.2 計算結(jié)果分析 .............................................................................................................- 12 -2.6 機械手旋轉(zhuǎn)電機的選取 .........................................................................................................- 13 -第三章 運動學(xué)分析 ...............................................................................................................................- 16 -3.1 概述 .........................................................................................................................................- 16 -3.2 運動學(xué)正解 .............................................................................................................................- 18 -3.3 運動學(xué)逆解 .............................................................................................................................- 20 -3.4 雅可比矩陣的推算和速度分析 .............................................................................................- 23 -第四章 工作空間分析 ...........................................................................................................................- 26 -4.1 工作空間分析簡述 .................................................................................................................- 26 -4.1.1 工作空間的概念 .........................................................................................................- 26 -4.1.2 工作空間的形成 .........................................................................................................- 26 -4.1.3 工作空間中的空腔和空洞 .........................................................................................- 27 -4.2 理想工作空間的包絡(luò)方程 .....................................................................................................- 28 -4.3 實際工作空間分析和作圖 .....................................................................................................- 32 -第五章 機械手結(jié)構(gòu)設(shè)計 .........................................................................................................................- 34 -5.1 手部設(shè)計基本要求 ...................................................................................................................- 34 -5.1.1 傳動機構(gòu) .......................................................................................................................- 34 -5.1.2 回轉(zhuǎn)型傳動機構(gòu) ...........................................................................................................- 34 -5.1.3 平移型傳動機構(gòu) ...........................................................................................................- 35 -5.1.4 機械手手抓的設(shè)計計算 ...............................................................................................- 35 -5.2 腕部設(shè)計的基本要求 ...............................................................................................................- 37 -5.2.2 腕部的結(jié)構(gòu)以及選擇 ...................................................................................................- 38 -5.2.3 腕部設(shè)計考慮的參數(shù) ...................................................................................................- 38 -5.3 機身回轉(zhuǎn)結(jié)構(gòu)的選擇 ...............................................................................................................- 40 -需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載5.4 機械手最終設(shè)計三維圖 ...........................................................................................................- 40 -第六章 系統(tǒng)控制部分 .......................................................................................................................- 41 -6.1 應(yīng)用背景與要求 .....................................................................................................................- 41 -6.2 組成部分 ...................................................................................................................................- 41 -6.2.1 關(guān)節(jié)的限位控制 ...........................................................................................................- 41 -6.2.2 工件坐標系的測量與計算 ...........................................................................................- 41 -6.2.3 機械手的張合控制 .......................................................................................................- 42 -6.2.4 公式之間的轉(zhuǎn)換 ...........................................................................................................- 42 -6.2.5 計算結(jié)果的存儲 ...........................................................................................................- 42 -6.3 機械手系統(tǒng)的工藝流程 ...........................................................................................................- 42 -6.4 機械手控制系統(tǒng)功能設(shè)計分析 .............................................................................................- 44 -6.4.1 PLC 的資源分配 ..........................................................................................................- 44 -6.4.2 機械手系統(tǒng)的控制程序 ................................................................................................- 45 -第七章 結(jié)論 ...........................................................................................................................................- 47 -7.1 本論文取得的結(jié)果 .................................................................................................................- 47 -7.2 設(shè)計中存在的問題 .................................................................................................................- 47 -7.3 對本設(shè)計改進的方法 .............................................................................................................- 47 -致 謝 .......................................................................................................................................................- 48 -參考文獻 ...................................................................................................................................................- 49 -附錄一 PLC I/O 口分配圖 ................................................................................................................- 51 -附錄二 示例程序 ...............................................................................................................................- 52 -需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載摘 要隨著現(xiàn)代科學(xué)技術(shù)的發(fā)展，機械手技術(shù)越來越受到廣泛關(guān)注，在工業(yè)生產(chǎn)日益現(xiàn)代化的今天，機械手的使用變得越來越普及。因此，對于機械手技術(shù)的研究也變得越來越迫切，尤其是工業(yè)機械手方面。本論文作者針對這一領(lǐng)域，設(shè)計了一款擁有 6 個自由度的機械手。首先，作者針對該機械手的設(shè)計要求，對結(jié)構(gòu)設(shè)計選擇了一個最優(yōu)方案，同時進行了運動學(xué)分析，用 D-H 法建立坐標變換矩陣，推算了運動方程的正逆解，用矢量積法推導(dǎo)了速度雅克比矩陣；其次進行工作空間分析；然后進行動力學(xué)分析，對關(guān)鍵零件進行校核。機械手是工業(yè)生產(chǎn)的必然產(chǎn)物，它是一種模仿人體上肢的部分功能，按照預(yù)定要求輸送工件或握持工具進行操作的自動化技術(shù)設(shè)備，對實現(xiàn)工業(yè)生產(chǎn)自動化，推動工業(yè)生產(chǎn)的進一步發(fā)展起著重要作用，因而具有強大的生命力受到人們的廣泛重視和歡迎。本課題對搬運機械手進行了總體方案研究，確定了機械手的坐標形式和自由度，確定了機械手的技術(shù)參數(shù)。關(guān)鍵詞：機械手，運動學(xué)分析，工作空間分析，動力學(xué)分析需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載AbstractWith the development of modern science and technology, robotics, more and more attention in an increasingly modernized industrial production, the use of robots becoming more and more popular. Therefore, robotics has become increasingly urgent, especially industrial robots. For this area, the authors designed a robot with 6 degrees of freedom. First of all, of the requirements for the design of the robot, structural design options for an optimal solution, while for the kinematic analysis, coordinates with the DH method to establish the transformation matrix is calculated by inverse solution of equations of motion, derived by vector product method Jacobian matrix of speed; followed by spatial analysis work; and dynamic analysis, the key parts of the check.Industrial manipulator is the inevitable product of industrial production, it is a part of the upper extremity function to imitate the human body, in accordance with the scheduled transfer jobs or holding tools required to operate the automation equipment, automation of industrial production, and promote the further development of industrial production playsimportant role, which has a strong vitality by the widespread attention and welcome.The subject of the overall transportation plan manipulator studied to determine the coordinates of the manipulator forms and degrees of freedom to determine the technical parameters of the manipulator.Key Words: manipulator,； kinematic analysis； work space analysis； dynamic analysis需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載第一章 緒論1.1 工業(yè)機械手的概述在工業(yè)領(lǐng)域廣泛應(yīng)用著工業(yè)機械手。工業(yè)機械手一般是指在工業(yè)生產(chǎn)過程中為實現(xiàn)自動化生產(chǎn)的需要，用于搬運材料、工具、零件等或進行裝配、加工等各種工作任務(wù)的特種裝置。工業(yè)機械手的定義有很多，綜合而言有以下幾個重要特征：(1) 是一種類似人的手臂的機械裝置，用于搬運材料、零件、工具等或進行裝配、加工等各種工作任務(wù)。(2) 是可以再編程的，用戶可根據(jù)工作環(huán)境編制各種程序流程，完成不同的作業(yè)任務(wù)。(3) 是一種自動控制裝置，在無人參與的情況下自動按程序工作。(4) 具有通用性，除專用的工業(yè)機械手外，一般工業(yè)機械手在執(zhí)行不同的作業(yè)任務(wù)時有較好的通用性，如更換其手部末端操作器（手爪、工具等）便可執(zhí)行不同的作業(yè)任務(wù)。一個典型的工業(yè)機械手是由機械本體、關(guān)節(jié)步進驅(qū)動系統(tǒng)、計算機控制系統(tǒng)、傳感系統(tǒng)和通訊接口等組成，一般多關(guān)節(jié)型串聯(lián)機械手具有 4～6 個自由度，其中 2～3個自由度決定了末端執(zhí)行器在空間的位置，其余 2～3 個自由度決定了末端執(zhí)行器在空間的姿態(tài)。1.2　本論文研究的主要內(nèi)容本人系統(tǒng)學(xué)習了機械手技術(shù)的知識，查閱了一些相關(guān)的文獻資料，在此基礎(chǔ)上，結(jié)合本人的設(shè)想和設(shè)計工作中需要解決的任務(wù)，主要進行了以下幾項工作：(1) 進行機械手本體結(jié)構(gòu)的方案創(chuàng)成、分析和設(shè)計。(2) 進行機械手運動學(xué)分析，推算運動方程的正、逆解。(3) 分析機械手操作臂的工作空間，根據(jù)分析結(jié)果對操作臂各個桿件的長度進行選擇和確定。（4） 對機械手操作臂進行力學(xué)分析，對操作臂進行強度校核需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載第二章 機械手方案的創(chuàng)成和機械設(shè)計2.1 機械手機械設(shè)計的特點串聯(lián)機械手機械設(shè)計與一般的機械設(shè)計相比，有很多不同之處。首先，從機構(gòu)學(xué)角度看，機械手的結(jié)構(gòu)是由一系列連桿通過旋轉(zhuǎn)關(guān)節(jié)（或移動關(guān)節(jié)）連接起來的開式運動鏈。開鏈結(jié)構(gòu)使得機械手的運動分析和靜力分析復(fù)雜，兩相鄰桿件坐標系之間的位姿關(guān)系、末端執(zhí)行器的位姿與各關(guān)節(jié)變量之間的關(guān)系、末端執(zhí)行器的受力和各關(guān)節(jié)驅(qū)動力矩（或力）之間的關(guān)系等，都不是一般機構(gòu)分析方法能解決得了的。需要建立一套針對空間開鏈機構(gòu)的運動學(xué)、靜力學(xué)方法。末端執(zhí)行器的位置、速度、加速度和各個關(guān)節(jié)驅(qū)動力矩之間的關(guān)系是動力學(xué)分析的主要內(nèi)容，在手臂開鏈結(jié)構(gòu)中，每個關(guān)節(jié)的運動受到其它關(guān)節(jié)運動的影響，作用在每個關(guān)節(jié)上的重力負載和慣性負載隨手臂位姿變化而變化。因此，機械手是一個多輸入多輸出的、非線性、強耦合、位置時變的動力學(xué)系統(tǒng)，動力學(xué)分析十分復(fù)雜，所以，即使通過一定的簡化，也需要使用不同于一般機構(gòu)分析的專門分析方法。其次，由于開鏈機構(gòu)相當于一系列懸臂桿件串聯(lián)在一起，機械誤差和彈性再變形的累積使機械手的剛度和精度大受影響。因此在進行機械手機械設(shè)計時特別注意剛度和精度設(shè)計。再次，機械手是典型的機電一體化產(chǎn)品，在進行結(jié)構(gòu)設(shè)計時必須考慮到驅(qū)動、控制等方面的問題，這和一般的機械產(chǎn)品設(shè)計是不同的。另外，與一般機械產(chǎn)品相比，機械手在機械設(shè)計在結(jié)構(gòu)的緊湊性、靈巧性方面有更高的要求。2.2 與機械手有關(guān)的概念自由度：工業(yè)機械手一般都為多關(guān)節(jié)的空間機構(gòu)，其運動副通常有移動副和轉(zhuǎn)動副兩種。相應(yīng)的，以轉(zhuǎn)動副相連的關(guān)節(jié)稱為轉(zhuǎn)動關(guān)節(jié)，以移動副相連的關(guān)節(jié)稱為移動需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載關(guān)節(jié)。在這些關(guān)節(jié)中，單獨驅(qū)動的關(guān)節(jié)稱為主動關(guān)節(jié)。主動關(guān)節(jié)的數(shù)目稱為機械手的自由度。2.3 設(shè)計方案 2.3.1 方案要求工業(yè)機械手大都用于簡單、重復(fù)、繁重的工作，如上、下料搬運以及工作環(huán)境惡劣的場所，本機械手為搬運機械手。要求動作靈活，自由度為 6 個，結(jié)構(gòu)緊湊，用于搬運物料。采用電機驅(qū)動，設(shè)計其負重為 100 公斤。2.3.2 方案功能設(shè)計與分析1．機械手自由度的分配和手臂手腕的構(gòu)形手臂是執(zhí)行機構(gòu)中的主要運動部件，它用來支承腕關(guān)節(jié)和末端執(zhí)行器，并使它們能在空間運動。為了使手部能達到工作空間的任意位置，手臂一般至少有三個自由度。本題要求機械手手臂能達到工作空間的任意位置，而目標物形狀大小和姿態(tài)則比較單一，同時要求機械手結(jié)構(gòu)簡單，容易控制。綜合考慮后確定該機械手具有六個自由度，其中手臂三個自由度。由于在同樣的體積條件下，關(guān)節(jié)型機械手比非關(guān)節(jié)型機械手有更大的工作空間，同時關(guān)節(jié)型機械手的動作和軌跡更靈活，因此決定采用關(guān)節(jié)型機械手。旋轉(zhuǎn)關(guān)節(jié)相對平移關(guān)節(jié)來說，操作空間大，結(jié)構(gòu)緊湊，重量輕，關(guān)節(jié)易于密封防塵。這里使用了六個旋轉(zhuǎn)關(guān)節(jié)，綜合各種手臂和手腕構(gòu)形，最后確定其結(jié)構(gòu)形式如圖。圖 2.1 該型機械手構(gòu)形需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載前三個關(guān)節(jié)決定了末端執(zhí)行器在空間的位置，后三個關(guān)節(jié)決定了末端執(zhí)行器在空間的姿態(tài)。2．傳動系統(tǒng)的布置總體結(jié)構(gòu)方案確定后，作出機械手結(jié)構(gòu)草圖。在傳動系統(tǒng)的布置方面采用種以下這種方案，如圖所示。根據(jù)該方案進行機械結(jié)構(gòu)設(shè)計圖 2.2 傳動系統(tǒng)方案原理圖3．方案描述該機械手由機座、大臂、小臂、手腕、末端執(zhí)行器和驅(qū)動裝置組成。共有六個自由度，依次為夾緊、旋轉(zhuǎn)、俯仰（1） 、左右搖擺、俯仰（2） 、基座的回轉(zhuǎn)。基座的回轉(zhuǎn)自由度可以進行 360 度的回轉(zhuǎn)；與基座相連的俯仰機構(gòu)（包含液壓缸）可進行俯仰動作，幅度較大，可以滿足 60-120 度的俯仰要求，與此相連部分為左右搖擺機構(gòu)，能夠完成-60~60 度的左右來回擺動，接著下去的是俯仰機構(gòu)，與搖擺機構(gòu)內(nèi)部類似，亦可完成-60~60 度的上下俯仰動作，最后的是旋轉(zhuǎn)部分與手指部分，旋轉(zhuǎn)部分可以正反旋轉(zhuǎn)，手指部分通過在手腕上滑槽來控制收放動作。機構(gòu)采用液壓控制各自由度的動作，簡單方便且功率大，各自由度之間相互聯(lián)系且獨立，動作時互不干涉。機械手采用電機驅(qū)動，這種方式結(jié)構(gòu)簡單、易于控制、使用維修方便、不污染環(huán)境等優(yōu)點，這也是現(xiàn)代機械手應(yīng)用最多的驅(qū)動方式。需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載機械手的電源為：220V，50Hz 的交流電。由于該機械手功率較小，電動機可以選擇步進電機。步進電機驅(qū)動具有成本低，控制系統(tǒng)簡單的優(yōu)點。故確定這種機械手的五個關(guān)節(jié)都采用步進電動機驅(qū)動，開環(huán)控制，整機的旋轉(zhuǎn)采用步進電機。由于一些關(guān)節(jié)驅(qū)動力矩較大，因此統(tǒng)一采用帶減速器的步進電機，而大臂和小臂俯仰運動的力矩較大，其出現(xiàn)的最大值分別為 11Nm 和 5Nm，還要再進行減速傳動。步進電機的輸出扭矩為 0.5Nm，配置的減速器的減速比為 1：9，大臂和小臂為 1：4 的齒輪減速驅(qū)動。機械手結(jié)構(gòu)中全部采用球軸承。在電機的布置上，可以將六個關(guān)節(jié)電機均置于回轉(zhuǎn)底座上，可以最大限度地減小扭矩，重心很穩(wěn)定，便于安裝和控制。參考 PUMA 560 機械手的運動參數(shù)，結(jié)合工作情況的需要，定出該型機械手的運動參數(shù)如下：關(guān)節(jié) 1（T）：　30o /s ( 0.524 rad/s ) ( 5 r/min )關(guān)節(jié) 2（W）： 15o /s ( 0.262 rad/s ) ( 2.5 r/min )關(guān)節(jié) 3（U）：　15o /s ( 0.262 rad/s ) ( 2.5 r/min )關(guān)節(jié) 4（B）：　30o /s ( 0.524 rad/s ) (5 r/min )關(guān)節(jié) 5（S）：　60o /s ( 1.047 rad/s ) ( 10 r/min )各關(guān)節(jié)轉(zhuǎn)動范圍：關(guān)節(jié) 1（T）：　0o ～ +360o關(guān)節(jié) 2（W）： 0o ～ +90o關(guān)節(jié) 3（U）：　-120o ～ +120o關(guān)節(jié) 4（B）：　-180o ～ 0o關(guān)節(jié) 5（S）：　-180o ～ +180o2.4 方案結(jié)構(gòu)設(shè)計與分析各部件組成和功能描述如下：(1) 底座部件：底座部件包括底座、回轉(zhuǎn)部件、傳動部件等。底座支持整個操作機，步進電機通過齒輪傳動將運動傳遞到腰部回轉(zhuǎn)軸，同時起減速作用。(2) 腰部回轉(zhuǎn)部件：需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載腰部回轉(zhuǎn)部件包括腰部支架、回轉(zhuǎn)軸、電機座、各傳動部件、步進電機等。作用是支承大臂部件，完成腰部回轉(zhuǎn)運動。五臺步進電機均固定在腰部支架上。(3) 大臂部件：包括大臂、張緊部件、各傳動部件等。(4) 小臂部件：包括小臂、張緊部件、各傳動部件等。(5) 手腕部件：包括傳動齒輪、機械連接部件等。(6) 末端執(zhí)行器：由于抓取的物體是圓柱形，尺寸相差不大，末端執(zhí)行器的開合范圍為 20～40cm。手爪采用電機驅(qū)動，機構(gòu)采用絲杠驅(qū)動平行四連桿機構(gòu)，如下圖2.3 所示。2.5 后軸和大臂板剛度和強度分析后軸是整個機械手本體中一個很重要的零件，是用來驅(qū)動大臂轉(zhuǎn)動的零件。它的剛度直接影響整個機械手的精度。由于大臂和后軸結(jié)構(gòu)復(fù)雜，為了快速準確地校核后軸的剛度和強度，同時根據(jù)設(shè)計要求本人采用有限元單元法進行分析。有限元法是隨著計算機的發(fā)展崦迅速發(fā)展起來的一種現(xiàn)代計算機方法，對于完成復(fù)雜結(jié)構(gòu)的力學(xué)分析十分有效。其基本思想是將一個連續(xù)的求解區(qū)域劃分為適當形狀的許多微小單元，并在各個小單元分片構(gòu)造插值函數(shù)，然后根據(jù)極值原理將問題的控制微分方程化為控制所有單元的有限元方程，把總體的極值作為各個單元極值之和，即將局部單元總體合成，形成包含指定邊界條件的代數(shù)方程組。其解此方程組即得到各個節(jié)點上待求的函數(shù)值。圖 2.3 末端執(zhí)行器需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載2.5.1 后軸和大臂板有限元模型的建立與解析首先建立后軸的三維模型，由于 Solid works 軟件本身就是三維設(shè)計軟件，這一點很容易實現(xiàn)。接著定義后軸和大臂板的材質(zhì)，建立約束條件，施加重力和集中栽荷，然后劃分網(wǎng)格，形成它們的有限元模型。進行完前置處理后，便可利用 Cosmos works軟件進行解析計算了。在 Solid works 建立模型，定義后軸材料（45 鋼） ，密度為 7.8g/cm3，彈性模量E＝210GPa，泊松比為 0.28，屈服強度為 220MPa，施加重力和作用力，然后劃分單元，如圖 2.4；定義大臂板材料（硬鋁） ，密度為 2.7g/cm3，彈性模量 E＝69GPa，泊松比為0.33，屈服強度為 27.5MPa，施加重力和作用力，然后劃分單元，如圖 2.5；圖 2.4 對后軸模型劃分單元 圖 2.5 對大臂板模型劃分單元需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載2.5.2 計算結(jié)果分析通過分析，可以清楚地看出后軸和大臂板的變形分布情況，如下圖所示。在后軸中，最大變形發(fā)生在中間附近，最大變形為 0.087mm，滿足剛度的要求；在大臂板中，最大變形發(fā)生在最上端，最大變形為 0.046mm，滿足剛度的要求。圖 2.6 后軸的變形規(guī)律圖 2.7 大臂板的變形規(guī)律需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載后軸的應(yīng)力分布如下圖所示，可以看出，應(yīng)力的總體分布規(guī)律是從中間到兩端逐漸增大，兩端軸承支承邊緣應(yīng)力最大，為 187MPa，小于普通碳鋼的屈服強度，因此，結(jié)構(gòu)參數(shù)滿足強度要求。大臂板的應(yīng)力分布如圖所示，可以看出，應(yīng)力的總體分布規(guī)律是從寬度方向上從中間到兩側(cè)面逐漸增大，兩側(cè)邊緣處應(yīng)力最大，為 11MPa，小于硬鋁的屈服強度，因此，結(jié)構(gòu)參數(shù)滿足強度要求。2.6 機械手旋轉(zhuǎn)電機的選取工業(yè)機械手的旋轉(zhuǎn)采用了電機驅(qū)動，下面就給出各種驅(qū)動方式的比較，以作為選取步進電機作為驅(qū)動方式的依據(jù)。 表 2-1 各種驅(qū)動方式比較驅(qū)動方式電機驅(qū)動比較內(nèi) 容 機械驅(qū)動異步電機直流電機步進電機步進電機氣壓傳動 液壓傳動輸出力矩 輸出力矩較大 輸出力可 輸出力可 氣體壓力小， 液體壓力高，可圖 2.8 后軸的應(yīng)力分布需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載較大 較小 輸出力矩小，如需輸出力矩較大， 結(jié)構(gòu)尺寸過大 以獲得較大的輸出力 控制性能 速度可高，速度和加速度均由機構(gòu)控制，定位精度高，可與主機嚴格同步 控制性能較差，慣性大，步易精確定位 控制性能好， 可精確定位， 但控制系統(tǒng)復(fù)雜 可高速，氣體壓縮性大，阻力效果差，沖擊較嚴重，精確定位較困難，低速步易控制 油液壓縮性小，壓力流量均容易控制，可無級調(diào)速， 反應(yīng)靈敏，可實現(xiàn)連續(xù)軌跡控制 應(yīng)用范圍 適用于自由度少的專用機械手， 高速低速均能適用 適用于抓取重量大和速度低的專用機械手 可用于程序復(fù)雜和運動軌跡要求嚴格的小型通用機械手 中小型專用通用機械手都有 中小型專用通用機械手都有，特別時重型機械手多用 由上表可知步進電機應(yīng)用于驅(qū)動工業(yè)機械手有著許多無可替代的優(yōu)點，如控制性能好，可精確定位，體積較小可用于程序復(fù)雜和運動軌跡要求嚴格的小型通用機械手等，下面就對步進電機的型號進行選取。a 、 初選電機為 EML 型步進電機，型號為：40APA。它的有關(guān)技術(shù)參數(shù)如下表：電機型號 額定輸出功率轉(zhuǎn)子轉(zhuǎn)動慣量額定轉(zhuǎn)矩瞬間最大轉(zhuǎn)矩額定電流瞬間最大電流額定轉(zhuǎn)速 最高轉(zhuǎn)速40APA 4KW 102*10-4Kg.m238.2N.m 114.6N.m 24A 72A 1000r/min 1500r/minb 、電機功率的確定電機所需工作功率式為 ??WdaPk??因此表 3-2 技術(shù)參數(shù)需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載??3.62950ndTPkW?c 、電機轉(zhuǎn)速的確定腰部的工作轉(zhuǎn)速為 2.5r/min腰部采用單 級 諧 波 傳 動 齒 輪 ， 傳 動 比 ， 可 達 i=70～ 500。 故 電 機 的 轉(zhuǎn)速 可 選 范 圍 為 dni??=( 70～ 500 ) 2.5= 175～ 1250因 此 ， 初 選 電 機 符 合 要 求 。需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載第三章 運動學(xué)分析3.1 概述多自由度機械手是具有多個關(guān)節(jié)的空間機構(gòu)，為了描述末端執(zhí)行器在空間的位置和姿態(tài)，可以在每個關(guān)節(jié)上建立一個坐標系，利用坐標系之間的關(guān)系來描述末端執(zhí)行器的位姿。常用的有 D－H 法（四參數(shù)法）和五參數(shù)法及矩陣變換法等。D－H 法是 1955 年由 Denavit 和 Hartenberg 提出的一種建立相對位姿的矩陣方法。它用齊次變換描述各個連桿相對于固定參考系的空間幾何關(guān)系，用一個 4×4 的齊次變換矩陣描述相臨兩連桿的空間關(guān)系，從而推導(dǎo)出“末端執(zhí)行器坐標系”相對于“基坐標系”的等價齊次坐標變換矩陣，建立操作臂的運動方程。本論文使用 D－H 法來建立坐標系并推導(dǎo)該機械手的運動方程。各桿件和關(guān)節(jié)的示意圖如圖 (a)。連拉桿 1 與 2 的關(guān)節(jié)為關(guān)節(jié) 2，記做J2，O 0，O 1，O 2 的原點在關(guān)節(jié) 2 轉(zhuǎn)軸上，連接桿 2 與 3 的關(guān)節(jié)為關(guān)節(jié) 3，記做 J3，O 3的原點在關(guān)節(jié) 3 轉(zhuǎn)軸上，依次類推。最終建立機械手坐標系如圖 (b)。其中表明坐標間關(guān)系的四個參數(shù)為：1．a(chǎn) i：從 z i 到 z i+1 沿 x i 測得的距離；2．α i：從 z i 到 z i+1 繞 x i 測得的角度；3．d i：從 x i-1 到 x i 沿 z i 測得的距離；4．θ i：從 x i-1 到 x i 繞 z i 測得的角度。各桿參數(shù)及關(guān)節(jié)變量如表 3-1。需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載關(guān)節(jié) i ai-1 αi-1 di θi1 0 0 0 θ 12 0 +90° 0 θ 23 a2=254 0 0 θ 34 a3=186 0 0 θ 45 0 -90° 0 θ 56 0 -90 0 θ 6OmJ1J2J3J4J5桿 5桿 4桿 3桿 2桿 1桿 0dma3(a) (b)圖 3.1 機械手坐標系x0z0x2z2z1x1O3O0O1O2x5z5O4O5O5a2xmzmx4z4x3z3表 3.1 各連桿參數(shù)及關(guān)節(jié)變量需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載3.2 運動學(xué)正解在直角坐標系中，可以用齊次矩陣表示繞 x，y，z 軸的轉(zhuǎn)動和沿 x，y，z 軸的平移。????????100cosini1),(??xRot ????????10cossini),(??yRot???????100csii),(?zot ???????10),(aaxTrns???????10),(bayTrns ???????10),(aazTrns（3-1）坐 標 系 {i}相 對 于 {i-1}的 變 換 可 以 看 成 是 以 下 四 個 子 變 換 的 乘 積 ：Ti1?（ 1） 繞 x i-1 軸轉(zhuǎn) α i-1 角； （ 2） 沿 x i-1 軸移動 a i-1；（ 3） 繞 z i 軸轉(zhuǎn) θ i 角；（ 4） 沿 z i 軸移動 d i。這 些 變 換 是 相 對 于 動 坐 標 系 描 述 的 ， 將 式 （3-1）中 的 相 關(guān) 齊 次 矩 陣 按 “從 左 到 右 ”的 原 則 相 乘 ， 得 ：),(),(),(),(111 iiiii dZTransRotaXTrnsRotT??????（3-2）得 到 連 桿 變 換 矩 陣 ：???????? ?? ?? 100coscssincosininii111 11 iiiii iiiiii daT ????（3-3）需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載將 表 3-1 中 各 參 數(shù) 代 入 連 桿 變 換 矩 陣 （3-2） ，可得相鄰兩坐標系的位姿變換矩陣 ，T01， ， ， 。T124T5????????100cossini1101? ????????100cossini222212?T????????100cossini33223?aT ???????100cssii44334 aT????????100cossini555545 ?T?T051T12T23T34 ???????1045 zzyyxxpaonT（ 3-4）式 中 ： ； ； ；512341scnx??512341scny??5234cnz?； ； ；ososoz?； ； ； 2341ax 2341ay 234az（ 3-5）； ；)(2231cpx??)(2231cspy??223sapz??注 ： ， ， ；)sinii?o(ii?in434?co(432234初 始 位 置 ： ； ； ； ；01???9203???9405?將 的 初 始 值 代 入 式 （ 3-5） 得 ：i?????????103205 aT這 與 圖 3.1 所 示 的 位 姿 一 致 ， 證 明 所 做 的 推 算 是 正 確 的 。需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載要 考 察 末 端 執(zhí) 行 器 在 空 間 上 相 對 于 基 坐 標 系 的 位 姿 ， 則 應(yīng) 建 立 末 端 執(zhí) 行 器 的 位 姿 變換 矩 陣 。高 末 端 執(zhí) 行 變 換 器 的 坐 標 系 為 {m}， 坐 標 系 {m}對 基 坐 標 系 {0}的 位 姿 變 換 矩 陣 為 ：Tm0?Tm05m ??????????????10100cossini5 mmm dd????????100 zzyyxxmpaonT（ 3-6）式 中 ， ， ， ， ， ， ， ， ， 與 式 （ 3-4） 中 對 應(yīng) 項 相 同 ， ，xnyzxoyzxayz xp， 為 ：ypz )(2342231sdcacmx???sy（ 3-7） 234223cdapmz??根據(jù)某時刻的時間 t，機械手關(guān)節(jié)變量 ，便可求得末端執(zhí)行器在空間的位姿。)5,21(??ii?這就是機械手運動學(xué)方程的正解。3.3 運動學(xué)逆解若 已 知 末 端 執(zhí) 行 器 的 位 姿 ， 即 式 （ 3-6） 中 的 ， ， … ， ， （ 已 知 三 組 參 數(shù) 中xnyypz只 要 已 知 兩 組 即 可 ， 剩 下 一 組 參 數(shù) 是 其 余 兩 組 的 叉 積 ）， 求 出 相 應(yīng) 的 關(guān) 節(jié) 變 量的 過 程 稱 為 運 動 學(xué) 逆 解 。)5,21(??ii?從 工 程 應(yīng) 用 的 角 度 ， 運 動 學(xué) 逆 解 往 往 更 重 要 。 它 是 機 械 手 運 動 規(guī) 劃 和 軌 跡 控 制 的 依據(jù) 。得 到 封 閉 解 有 兩 個 充 分 條 件 ：需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載1． 有 三 個 相 鄰 關(guān) 節(jié) 軸 線 交 于 一 點 ；2． 有 三 個 相 鄰 關(guān) 節(jié) 軸 線 相 互 平 行 。該 型 機 械 手 的 手 臂 和 手 腕 三 個 相 鄰 關(guān) 節(jié) 平 行 ， 滿 足 條 件 2， 因 此 能 得 到 封 閉 形 式 解 。如 上 所 述 ， 該 機 械 手 運 動 方 程 可 寫 為 ：???????10zzyyxxpaonT0112T2334T45m5（ 3-8）1． 求 解 ，1?5式 (3-8)兩 邊 同 乘 10?T（ 3-10????????10zzyyxxpaonT2345m9）方 程 左 邊 ：?????? ??????????????????? 10001010 1111111 zzzz yxyxyxyx zzyyxx paon cscscscspaoncs（ 3-10）方 程 右 邊 ：T1223T3445Tm5 ?????? ????100023422323452345234 234223234523452341 cdsacscs m（ 3-11）需要 CAD 圖紙，咨詢 Q：414951605 或 1304139763優(yōu)秀畢業(yè)論文，支持預(yù)覽，答辯通過，歡迎下載比 較 兩 邊 （ 2， 4） 項 有 ： 011???yxpcs解 得 ： 和 )arctn(1xyp???81?（ 3-12）比 較 兩 邊 （ 2， 1） 項 有 ： ；yxncs15???于是得： 和 )arcsin(15 yx??5580???（ 3-13）2． 求 解 ， ，234比 較 兩 邊 （ 1， 3） 項 有 ： yxascs1234??于是得： )arin()(142 yx??)(80432432?????（ 3-14）式 (3-8)兩 邊 同 乘 10?T2（ 3-10?2 ???????10zzyyxxpaonT2345m15）方 程 左 邊 ：?????? ???? ????????????????????????? 1000 101010 1212