買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 摘 要 在當今大規(guī)模制造業(yè)中，企業(yè)為提高生產效率，保障產品質量，普遍重視生產過程的自動化程度，工業(yè)柑橘采摘機器人作為自動化生產線上的重要成員，逐漸被企業(yè)所認同并采用。工業(yè)柑橘采摘機器人的技術水平和應用程度在一定程度上反映了一個國家工業(yè)自動化的水平，目前，工業(yè)柑橘采摘機器人主要承擔著焊接、噴涂、搬運以及堆垛等重復性并且勞動強度極大的工作，工作方式一般采取示教再現(xiàn)的方式。 本文將設計一臺五自由度的工業(yè)柑橘采摘機器人，用于給采摘水果。首先，本文將設計柑橘采摘機器人的底座、大臂、小臂和機械手的結構，然后選擇合適的傳動方式、驅動方式，搭建柑橘采摘機器人的結構平臺；在此基礎上，本文將設計該柑橘采摘機器人的控制系統(tǒng)，包括數(shù)據采集卡和伺服放大器的選擇、反饋方式和反饋元件的選擇、端子板電路的設計以及控制軟件的設計，重點加強控制軟件的可靠性和柑橘采摘機器人運行過程的安全性，最終實現(xiàn)的目標包括：關節(jié)的伺服控制和制動問題、實時監(jiān)測柑橘采摘機器人的各個關節(jié)的運動情況、柑橘采摘機器人的示教編程和在線修改程序、設置參考點和回參考點。 關鍵詞： 柑橘采摘機器人 ，示教編 程，伺服，制動 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 n on of in to As an of of of to of , of in In an is a of of of On I of AQ of be on of to of of in to 文檔就送您 紙全套， Q 號交流 401339828 或 11970985 目 錄 第 1 章 緒論 1 橘采摘機器人概述 3 橘采摘機器人的歷史、現(xiàn)狀 4 橘采摘機器人的發(fā)展趨勢 5 第 2 章 柑橘采摘機器人機械手的設計 5 由度及關節(jié) 6 座及連桿 7 座 8 臂 9 臂 10 械手的設計 12 動方式 13 動方式 14 動器 15 第 3 章 控制系統(tǒng)硬件 16 制系統(tǒng)模式的選擇 17 制系統(tǒng)的搭建 18 控機 19 據采集卡 20 服放大器 21 子板 22 位器及其標定 22 源 23 第 4 章 控制系統(tǒng)軟件 24 期的功能 25 現(xiàn)方法 26 時顯示各個關節(jié)角及運動范圍控制 26 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 流電機的伺服控制 27 機的自鎖 28 教 編程及在線修改程序 29 置參考點及回參考點 30 第 5 章 總結 32 完成的工作 33 計經驗 35 差分析 36 以繼續(xù)探索的方向 38 致 謝 39 參考文獻 40 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 第 1 章 緒論 橘采摘機器人概述 在現(xiàn)代工業(yè)中，生產過程的機械化、自動化已成為突出的主題?；さ冗B續(xù)性生產過程的自動化已基本得到解決。但在機械工業(yè)中，加工、裝配等生產是不連續(xù)的。專用機床是大批量生產自動化的有效辦法；程控機床、數(shù)控機床、加工中心等自動化機械是有效地解決多品種小批量生產自動化的重要辦法。但除切削加工本身外，還有大量的裝卸、搬運、裝配等作業(yè)， 有待于進一步實現(xiàn)機械化。柑橘采摘機器人的出現(xiàn)并得到應用，為這些作業(yè)的機械化奠定了良好的基礎。 “工業(yè)柑橘采摘機器人”（ 多數(shù)是指程序可變（編）的獨立的自動抓取、搬運工件、操作工具的裝置（國內稱作工業(yè)柑橘采摘機器人或通用柑橘采摘機器人）。 柑橘采摘機器人是一種具有人體上肢的部分功能，工作程序固定的自動化裝置。柑橘采摘機器人具有結構簡單、成本低廉、維修容易的優(yōu)勢，但功能較少，適應性較差。目前我國常把具有上述特點的柑橘采摘機器人稱為專用柑橘采摘機器人，而把工業(yè)機械人稱為通 用柑橘采摘機器人。 簡而言之，柑橘采摘機器人就是用機器代替人手，把工件由某個地方移向指定的工作位置，或按照工作要求以操縱工件進行加工。 柑橘采摘機器人一般分為三類。第一類是不需要人工操作的通用柑橘采摘機器人，也即本文所研究的對象。它是一種獨立的、不附屬于某一主機的裝置，可以根據任務的需要編制程序，以完成各項規(guī)定操作。它是除具備普通機械的物理性能之外，還具備通用機械、記憶智能的三元機械。第二類是需要人工操作的，稱為操作機（ 它起源于原子、軍事工業(yè)，先是通過操作機來完成特定的作業(yè) ，后來發(fā)展到用無線電訊號操作柑橘采摘機器人來進行探測月球等。工業(yè)中采用的鍛造操作機也屬于這一范疇。第三類是專業(yè)柑橘采摘機器人，主要附屬于自動機床或自動生產線上，用以解決機床上下料和工件傳送。這種柑橘采摘機器人在國外通常被稱之為“ 它是為主機服務的，由主機驅動。除少數(shù)外，工作程序一般是固定的，因此是專用的。 柑橘采摘機器人按照結構形式的不同又可分為多種類型，其中關節(jié)型柑橘采摘機器人以其結構緊湊，所占空間體積小，相對工作空間最大，甚至能繞過基座周圍的一些障礙物等這樣一些特點，成為 柑橘采摘機器人中使用最多的一種結構形式，世界一些著名柑橘采摘機器人的本體部分都采用這種機構形式的柑橘采摘機器人。 要柑橘采摘機器人像人一樣拿取東西，最簡單的基本條件是要有一套類似于指、腕、臂、關節(jié)等部分組成的抓取和移動機構 執(zhí)行機構；像 肌肉那樣 使手臂運動的驅動傳動系統(tǒng)；像大腦那樣指揮手動作的控制系統(tǒng)。這些系統(tǒng)的性能就決定了柑橘采摘機器人的性能。一般而言，柑橘采摘機器人通常就是由執(zhí)行機構、驅動傳動系統(tǒng)和控制系統(tǒng)這三部分組成，如圖 1示。 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 執(zhí) 行 機 構機器人控 制 系 統(tǒng)驅 動 - 傳 動 系 統(tǒng)手 部腕 部臂 部腰 部基 座 部 （ 固 定 或 移 動 ）電 、 液 或 氣 驅 動 裝 置單 關 節(jié) 伺 服 控 制 器關 節(jié) 協(xié) 調 及 其 它 信 息 交 換計 算 機圖 1橘采摘機器人的一般組成 對于現(xiàn)代智能柑橘采摘機器人而言，還具有智能系統(tǒng)，主要是感覺裝置、視覺裝置和語言識別裝置等。目前研究主要集中在賦予柑橘采摘機器人“眼睛”，使它能識別物體和躲避障礙物，以及柑橘采摘機器人的觸覺裝置。柑橘采摘機器人的這些組成部分并不是各自獨立的，或者說并不是簡單的疊加在一起，從而構成一個柑橘采摘機器人的。要實現(xiàn)柑橘采摘機器人所期望實現(xiàn)的功能，柑橘采摘機器人的各部分之間必然還存在著相互關聯(lián)、相互影響和相互制約。它們之間的相互關系如圖 1示。 位 形 檢 測控 制 系 統(tǒng) （ 二 ）驅 動傳 動裝 置執(zhí) 行機 構工 作 對 象智 能 系 統(tǒng)控 制 系 統(tǒng) （ 一 ）圖 1橘采摘機器人各組成部分之間的關系 柑橘采摘機器人的機械系統(tǒng)主要由執(zhí)行機構和驅動傳動系統(tǒng)組成。執(zhí)行機構是柑橘采摘機器人賴以完成工作任務的實體，通常由連桿和關節(jié)組成，由驅動傳動系統(tǒng)提供動力，按控制系統(tǒng)的要求完成工作任務。驅動傳動系統(tǒng)主要包括驅動機構和傳動系統(tǒng)。驅動機構提供柑橘采摘機器人各關節(jié)所需要的動力，傳動系統(tǒng)則將驅動力轉換為滿足柑橘采摘機器人各關節(jié)力矩和運動所要求的驅動力或力矩。有的文獻則把柑橘采摘機器人分為機械 系統(tǒng)、驅動系統(tǒng)和控制系統(tǒng)三大部分。其中的機械系統(tǒng)又叫操作機 (相當于本文中的執(zhí)行機構部分。 橘采摘機器人的歷史、現(xiàn)狀 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 柑橘采摘機器人首先是從美國開始研制的。 1958 年美國聯(lián)合控制公司研制出第一臺柑橘采摘機器人。它的結構特點是機體上安裝一回轉長臂，端部裝有電磁鐵的工件抓放機構，控制系統(tǒng)是示教型的。 日本是工業(yè)柑橘采摘機器人發(fā)展最快、應用最多的國家。自 1969 年從美國引進兩種典型柑橘采摘機器人后，大力從事柑橘采摘機器人的研究。 目前工業(yè)柑橘采摘機器人大 部分還屬于第一代，主要依靠人工進行控制；控制方式則為開環(huán)式，沒有識別能力；改進的方向主要是降低成本和提高精度。 第二代柑橘采摘機器人正在加緊研制。它設有微型電子計算機控制系統(tǒng)，具有視覺、觸覺能力，甚至聽、想的能力。研究安裝各種傳感器，把感覺到的信息進行反饋，使柑橘采摘機器人具有感覺機能。 第三代柑橘采摘機器人（柑橘采摘機器人）則能獨立地完成工作過程中的任務。它與電子計算機和電視設備保持聯(lián)系，并逐步發(fā)展成為柔性制造系統(tǒng)和柔性 制造單元 中的重要一環(huán)。 隨著工業(yè)柑橘采摘機器人研究制造和應用領域不斷擴大，國際性學術交流活動十分活躍，歐美各國和其他國家學術交流活動開展很多。國際工業(yè)柑橘采摘機器人會議 定每年召開一次會議，討論和研究柑橘采摘機器人的發(fā)展及應用問題。 目前，工業(yè)柑橘采摘機器人主要用于裝卸、搬運、焊接、鑄鍛和熱處理等方面，無論數(shù)量、品種和性能方面還不能滿足工業(yè)生產發(fā)展的需要。使用工業(yè)柑橘采摘機器人代替人工操作的，主要是在危險作業(yè)（廣義的） 、多粉塵、高溫、噪聲、工作空間狹小等不適于人工作業(yè)的環(huán)境。 在國外機械制造業(yè)中，工業(yè)柑橘采摘機器人應用較多，發(fā)展較快。目前主要應用于機床、模鍛壓力機的上下料，以及點焊、噴漆等作業(yè)，它可按照事先制訂的作業(yè)程序完成規(guī)定的操作，但還不具備傳感反饋能力，不能應付外界的變化。如發(fā)生某些偏離時，就將引起零部件甚至柑橘采摘機器人本身的損壞。 隨著現(xiàn)代化科學技術的飛速發(fā)展和社會的進步，針對于上述各個領域的柑橘采摘機器人系統(tǒng)的應用和研究對系統(tǒng)本身也提出越來越多的要求。制造業(yè)要求柑橘采摘機器人系統(tǒng)具有更大的柔性 和更強大的編程環(huán)境，適應不同的應用場合和多品種、小批量的生產過程。計算機集成制造（ 求柑橘采摘機器人系統(tǒng)能和車間中的其它自動化設備集成在一起。研究人員為了提高柑橘采摘機器人系統(tǒng)的性能和智能水平，要求柑橘采摘機器人系統(tǒng)具有開放結構和集成各種外部傳感器的能力。然而，目前商品化的柑橘采摘機器人系統(tǒng)多采用封閉結構的專用控制器，一般采用專用計算機作為上層主控計算機，使用專用柑橘采摘機器人語言作為離線編程工具，采用專用微處理器，并將控制算法固化在 ，這種專用系統(tǒng)很難（或不可能）集成外部硬件和軟件。修改 封閉系統(tǒng)的代價是非常昂貴的，如果不進行重新設計，多數(shù)情況下技術上是不可能的。解決這些問題的根本辦法是研究和使用具有開放結構的柑橘采摘機器人系統(tǒng)。 美國工業(yè)柑橘采摘機器人技術的發(fā)展，大致經歷了以下幾個階段： （ 1） 1963為試驗定型階段。 1963， 萬能自動化公司制造的工業(yè)柑橘采摘機器人供用戶做工藝試驗。 1967 年，該公司生產的工業(yè)柑橘采摘機器人定型為 1900 型。 （ 2） 1968為實際應用階段。這一時期，工業(yè)柑橘采摘機器人在美國進入應用階段，例如，美國通用汽車公司 1968 年訂購了 68 臺工業(yè)柑橘采摘機器買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 人； 1969 年該公司又自行研制出 工業(yè)柑橘采摘機器人，并用 21 組成電焊小汽車車身的焊接自動線；又如，美國克萊斯勒汽車公司 32 條沖壓自動線上的448 臺沖床都用工業(yè)柑橘采摘機器人傳遞工件。 （ 3） 1970 年至今一直處于推廣應用和技術發(fā)展階段。 1970，工業(yè)柑橘采摘機器人處于技術發(fā)展階段。 1970 年 4 月美國在伊利斯工學院研究所召開了第一屆全國工業(yè)柑橘采摘機器人會議。據當時統(tǒng)計，美國大約 200 臺工業(yè)柑橘采摘機器人，工作時間共達 60 萬小時以上，與此同時，出現(xiàn)了所謂了高級 柑橘采摘機器人，例如：森德斯蘭德公司（ 明了用小型計算機控制50 臺柑橘采摘機器人的系統(tǒng)。又如，萬能自動公司制成了由 25 臺柑橘采摘機器人組成的汽車車輪生產自動線。麻省理工學院研制了具有有“手眼”系統(tǒng)的高識別能力微型柑橘采摘機器人。 其他國家，如日本、蘇聯(lián)、西歐，大多是從 1967， 1968 年開始以美國的“ “ 柑橘采摘機器人為藍本開始進行研制的。就日本來說， 1967 年，日本豐田織機公司 引進美國的“ ,川崎重工公司引進“ ，并獲得迅速發(fā)展。通過引進技術、仿制、改造創(chuàng)新。很快研制出國產化柑橘采摘機器人，技術水平很快趕上美國并超過其他國家。經過大約 10年的實用化時期以后，從 1980 年開始進入廣泛的普及時代。 我國雖然開始研制工業(yè)柑橘采摘機器人僅比日本晚 5，但是由于種種原因，工業(yè)柑橘采摘機器人技術的發(fā)展比較慢。目前我國已開始有計劃地從國外引進工業(yè)柑橘采摘機器人技術，通過引進、仿制、改造、創(chuàng)新，工業(yè)柑橘采摘機器人將會獲得快速的發(fā)展。 橘采摘機器人發(fā)展趨勢 隨著現(xiàn)代化生產技術的提高，柑橘采摘機器人設計生產能力進一 步得到加強，尤其當柑橘采摘機器人的生產與柔性化制造系統(tǒng)和柔性制造單元相結合，從而改變目前機械制造的人工操作狀態(tài)，提高了生產效率。 就目前來看，總的來說現(xiàn)代工業(yè)柑橘采摘機器人有以下幾個發(fā)展趨勢： a)提高運動速度和運動精度，減少重量和占用空間，加速柑橘采摘機器人功能部件的標準化和模塊化，將柑橘采摘機器人的各個機械模塊、控制模塊、檢測模塊組成結構不同的柑橘采摘機器人； b)開發(fā)各種新型結構用于不同類型的場合，如開發(fā)微動機構用以保證精度；開發(fā)多關節(jié)多自由度的手臂和手指；開發(fā)各類行走柑橘采摘 機器人，以適應不同的場合； c)研制各類傳感器及檢測元器件，如，觸覺、視覺、聽覺、味覺、和測距傳感器等，用傳感器獲得工作對象周圍的外界環(huán)境信息、位置信息、狀態(tài)信息以完成模式識別、狀態(tài)檢測。并采用專家系統(tǒng)進行問題求解、動作規(guī)劃，同時，越來越多的系統(tǒng)采用微機進行控制。 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 第 2 章 實驗平臺介紹及機械手的設計 該設計的目的是為了設計一臺 柑橘采摘 柑橘采摘機器人，利用現(xiàn)有已經報廢的焊接柑橘采摘機器人，本文的中結構設計主要偏向于對原有機構的改造和機械手的設計。 座及連桿 座 基座是整個柑橘采摘機器人本體的支撐。為保證柑橘采摘機器人運行的穩(wěn)定性，采用兩塊“ Z”字形實心鑄鐵作支撐。 基座上面是接線盒子，所有電機的驅動信號和反饋信號都從中出入。接線盒子外面，有一個引入線出口和一個引出線出口。 臂 大臂長度 230體尺寸如圖 示： 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 圖 臂外形 臂 小臂長度 240體尺寸如圖 示： 圖 臂外形 械手的設計 工業(yè)柑橘采 摘機器人的手又稱為末端執(zhí)行器，它使柑橘采摘機器人直接用于抓取和握緊（吸附）專用工具（如噴槍、扳手、焊具、噴頭等）進行操作的部件。它具有模仿人手動作的功能，并安裝于柑橘采摘機器人手臂的前端。由于被握工件的形狀、尺寸、重量、材質及表面狀態(tài)等不同，因此工業(yè)柑橘采摘機器人末端操作器是多種多樣的，大致可分為以下幾類： 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 （ 1） 夾鉗式取料手 （ 2） 吸附式取料手 （ 3） 專用操作器及轉換器 （ 4） 仿生多指靈巧手 本文設計對象為 柑橘采摘 柑橘采摘機器人，并不需要復雜的多指人工指，只需要設計能從不同角度抓取工件的鉗形指。 手指是直接與工件接觸的部件。手指 松開和夾緊工件，是通過手指的張開與閉合來實現(xiàn)的。該設計采用兩個手指，其外形如圖 示 圖 械手手指形狀 傳動機構是向手指傳遞運動和動力，以實現(xiàn)夾緊和松開動作的機構。根據手指開合的動作特點分為回轉型和平移形。本文采用回轉型傳動機構。圖 初步設計的機械手機構簡圖（只畫出了一半，另外一半關于中心線對稱）。 圖 械手機構簡圖 在圖 ， O 為電機輸出軸，曲柄 連桿 塊 B 和支架構成曲買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 柄滑塊機構；滑塊 B、連桿 桿 支架構成滑塊搖桿機構。通過兩個機構串聯(lián)，使電機最終驅動 來回擺動，從而實現(xiàn)手指的開合運動。 圖 的黑線和藍線表示機構運行的兩個極限位置。 為便于手指的順利合攏，可以在兩個手指之間設置一個彈簧，這樣還可以提供適當?shù)膴A緊力。 另外，在選用電機的時候，要使電機的功率足以克服彈簧的收縮和張開，并且提供足夠加緊物體的力。 圖 采用虛擬樣機軟件 分析所設計的機械手機構的工作狀況。 圖 擬樣機場景 下面更進一步計算出所需要的電機力矩。 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 圖 矩變化情況 從圖 看到，起始階段須克服的彈簧力最大，電機轉矩必須大于550N 為電機的挑選提供了一定的依據。 動方式 該柑橘采摘機器人一共具有四個獨立的轉動關節(jié)，連同末端機械手的運動，一共需要五個動力源。 柑橘采摘機器人常用的驅動方式有液壓驅動、氣壓驅動和電機驅動三種類型。這三種方法各有所長，各種驅動方式 的特點見表 表 種驅動方式的特點對照 內容 驅動方式 液壓驅動 氣動驅動 電 機 驅動 輸出功率 很大，壓力范圍為50 140，壓力范圍為 4860大可達 大 利用液體的不可壓縮性，控制精度較高，氣體壓縮性大，精度低，阻尼效果差，低速控制精度高，功率較大，能精確定位，反應靈敏，買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 控制性能 輸出功率大，可無級調速，反應靈敏，可實現(xiàn)連續(xù)軌跡控制 不易控制，難以實現(xiàn)高速、高精度的連續(xù)軌跡控制 可實現(xiàn)高速、高精度的連續(xù)軌跡控制，伺服特性好，控制系統(tǒng)復雜 響 應速度 很高 較高 很高 結構性能及體積 結構適當，執(zhí)行機構可標準化、模擬化，易實現(xiàn)直接驅動。功率 /質量比大，體積小，結構緊湊，密封問題較大 結構適當，執(zhí)行機構可標準化、模擬化，易實現(xiàn)直接驅動。功率 /質量比大，體積小，結構緊湊，密封問題較小 伺服電動機易于標準化，結構性能好，噪聲低，電動機一般需配置減速裝置，除 動機外，難以直接驅動，結構緊湊，無密封問題 安全性 防爆性能較好，用液壓油作傳動介質，在一定條件下有火災危險 防爆性能好，高于10000 個大氣壓 )時應注意設備的抗壓性 設 備自身無爆炸和火災危險，直流有刷電動機換向時有火花，對環(huán)境的防爆性能較差 對環(huán)境的影響 液壓系統(tǒng)易漏油，對環(huán)境有污染 排氣時有噪聲 無 在工業(yè) 柑橘采摘機器人 中應用范圍 適用于重載、低速驅動，電液伺服系統(tǒng)適用于噴涂 柑橘采摘機器人 、點焊 柑橘采摘機器人 和托運 柑橘采摘機器人 適用于中小負載驅動、精度要求較低的有限點位程序控制 柑橘采摘機器人 ，如沖壓 柑橘采摘機器人 本體的氣動平衡及裝配 柑橘采摘機器人 氣動夾具 適用于中小負載、要求具有較高的位置控制精度和軌跡控制精度、速度較高的 柑橘采摘機器人 ，如服噴涂 柑橘采摘機器 人 、點焊 柑橘采摘機器人 、弧焊 柑橘采摘機器人 、裝配 柑橘采摘機器人等 成本 液壓元件成本較高 成本低 成本高 維修及使用 方便，但油液對環(huán)境溫度有一定要求 方便 較復雜 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 柑橘采摘機器人驅動系統(tǒng)各有其優(yōu)缺點，通常對柑橘采摘機器人的驅動系統(tǒng)的要求有： 1）驅動系統(tǒng)的質量盡可能要輕，單位質量的輸出功率要高，效率也要高； 2）反應速度要快，即要求力矩質量比和力矩轉動慣量比要大，能夠進行頻繁地起、制動，正、反轉切換； 3）驅動盡可能靈活，位移偏差和速度偏差要?。?4）安全可靠； 5）操作和維護方便； 6）對環(huán)境無污染，噪聲要??； 7）經濟上合理，尤其要盡量減少占地面積。 基于上述驅動系統(tǒng)的特點和柑橘采摘機器人驅動系統(tǒng)的設計要求，本文選用直流伺服電機驅動的方式對柑橘采摘機器人進行驅動。表 選定的各個關節(jié)電機型號及其相關參數(shù)。 表 橘采摘機器人驅動電機參數(shù) 電機參數(shù) 腰關節(jié) 肩關節(jié) 肘關節(jié) 腕關節(jié) 手爪 型號 定電壓 18v 18v 18v 6v 6v 額定轉矩 m m m m m 最大轉矩 m m m 額定轉速 7980980980460460高轉速 轉子慣量 9200200200動方式 由于一般的電機驅動系統(tǒng)輸出的力矩較小，需要通過傳動機構來增加力矩，提高帶負 載能力。對柑橘采摘機器人的傳動機構的一般要求有： （ 1）結構緊湊，即具有相同的傳動功率和傳動比時體積最小，重量最輕； 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 （ 2）傳動剛度大，即由驅動器的輸出軸到連桿關節(jié)的轉軸在相同的扭矩時角度變形要小，這樣可以提高整機的固有頻率，并大大減輕整機的低頻振動； （ 3） 回 差要小，即由正轉到反轉時空行程要小，這樣可以得到較高的位置控制精度； （ 4）壽命長、價格低。 本文所選用的電機都采用了電機和齒輪輪系一體化的設計，結構緊湊，具有很強的帶負載能力，但是不能通過電機直接驅動各個連桿的運動。為減小機構運行過程的沖擊 和振動，并且不降低控制精度，采用了齒形帶傳動。 齒形帶傳動是同步帶的一種，用來傳遞平行軸間的運動或將回轉運動轉換成直線運動，在本文中主要用于腰關節(jié)、肩關節(jié)和肘關節(jié)的傳動。 齒形帶傳動原理如圖 示。 齒輪帶的傳動比計算公式為 2112 齒輪帶的平均速度2211 圖 形帶傳動 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 動器 制動器及其作用： 制動器是將機械運動部分的能量變?yōu)闊崮茚尫?，從而使運動的機械速度降低或者停止的裝置，它大致可分為機械制動器和電氣制動起兩類。 在柑橘 采摘機器人機構中，學要使用制動器的情況如下： 特殊情況下的瞬間停止和需要采取安全措施 停電時，防止運動部分下滑而破壞其他裝置。 機械制動器： 機械制動器有螺旋式自動加載制動器、盤式制動器、閘瓦式制動器和電磁制動器等幾種。其中最典型的是電磁制動器。 在柑橘采摘機器人的驅動系統(tǒng)中常使用伺服電動機，伺服電機本身的特性決定了電磁制動器是不可缺少的部件。從原理上講，這種制動器就是用彈簧力制動的盤式制動器，只有勵磁電流通過線圈時制動器打開，這時制動器不起制動作用，而當電源斷開線圈中無勵磁電流時，在彈簧力 的作用下處于制動狀態(tài)的常閉方式。因此 這種制動器被稱為無勵磁動作型電磁制動器。又因為這種制動器常用于安全制動場合，所以也稱為安全制動器。 電氣制動器 電動機是將電能轉換為機械能的裝置，反之，他也具有將旋轉機械能轉換為電能的發(fā)電功能。換言之，伺服電機是一種能量轉換裝置，可將電能轉換為機械能，同時也能通過其反過程來達到制動的目的。但對于直流電機、同步電機和感應電機等各種不同類型的電機，必須分別采用適當?shù)闹苿与娐贰?本文中，該柑橘采摘機器人實驗平臺未安裝機械制動器，因此柑橘采摘機器人的肩關節(jié)和軸關 節(jié)在停止轉動的時候，會因為重力因素而下落。另外，由于各方面限制，不方便在原有機構上添加機械制動器，所以只能通過軟件來實現(xiàn)肩關節(jié)和軸關節(jié)的電氣制動。 采用電氣制動器，其優(yōu)點在于：在不增加驅動系統(tǒng)質量的同時又具有制動功能，這是非常理想的情況，而在柑橘采摘機器人上安裝機械制動器會使質量有所增加，故應盡量避免。缺點在于：這種方法不如機械制動器工作可靠，斷電的時買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 候將失去制動作用。 機械臂在抓取前必須先進行移動。本文中的移動機械臂，通過肩部和臂部進行方向移動。下面對隨動系統(tǒng)定義幾個性能參數(shù)，這幾個性能參數(shù)是反映移動過程 中抓取的精度、速度和難易程度的指標 (1)抓取速度 移動機械臂的驅動電機以一定速度驅動機械臂時，機械臂的角速度。移動速度是衡量機械臂動性的一個指標，它的大小反映了抓取轉移的快慢。 (2)工作空間 移動機械臂移動的工作范圍成為工作空間。工作空間是衡量移動機械臂動性的一個指標，它的大小反映了移動機械臂工作范圍 :工作空間大，一說明在不改變運動體的位置時，機械臂移動的范圍就大 ;反之，工作空間小，機械臂移動的范圍就小。 (3)對機械臂的要求 （ a）保證旋轉精度 移動機械臂的移動精度主要取決于移動系統(tǒng)的質量，傳動系統(tǒng)和 控制系統(tǒng)的精度。就肩部而言，移動精度與肩部空回量的大小有很大聯(lián)系。這里的空回量是由于移動的各運動副的嚙合間隙和各傳動連接件之間的空隙所產生的，這些空隙是由于零件的制造誤差和裝配誤差以及零件的磨損或分解組合調整得不夠好所造成的。另外各傳動件的加工、裝配質量的情況等對于移動精度都有影響。為了提高移動精度，減小移動時的方向變位，有利于提高移動準確度和密集度，對移動機械臂的空回量提出了一定的要求。 (b)保證移動操作輕便，平穩(wěn) 為了能夠迅速地，精確地進行移動完成抓取任務，要求移動機械臂的操作輕便、平穩(wěn)。移動機械臂的 操作輕便、平穩(wěn)主要取決于在一定移動旋轉速度下所需驅動力的大小。 移動機械臂的在穩(wěn)定運動時，驅動力可按下列公式求出 : （ 6 式中 : 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 M 移動關節(jié)回轉部分阻力矩 R 移動關節(jié)驅動電機軸半徑 移動臂總效率 i 移動臂總傳動比 而 w(6 驅動電機轉動的角速度 肩或臂回轉部分轉動的角速度即移動速度 由 (6可知： i 與 P 成反比， i 愈大，則 P 愈小。 由 (6可知： i 與成反比， i 愈大，則。、愈小。 所以電機驅動力 P 與移動速度是成正比的。這樣為了減少驅動力，就必須增加傳動比，而增加傳動比，會引起移動速度減小。同樣，若要提高移動速度，就必須減小傳動比 ;而減小了傳動比，又會引起 驅動力增大。因此，減小驅動力同提高移動速度是相矛盾的。所以要根據移動機械臂的移動抓取技術要求，在滿足一定移動速度的情況下，減小驅動力，以便移動機械臂操作輕便、平穩(wěn)、靈活。 (c)保證準確定位不易被破壞 引起定位被破壞的可能有以下原因 :不平衡力矩的變化、移動中振動等。當機械臂具有自鎖性和適當?shù)碾姍C驅動力時，就能保證移動的位置不因上述原因而被破壞。移動機械臂的自鎖性是指關節(jié)只能正傳動，不能逆?zhèn)鲃?。移動機械臂的關節(jié)的自鎖性很重要，它不僅保證移動位置不被破壞，而且也保證了因為斷電而發(fā)生機械臂下落撞擊本體。解決移動機 械臂自鎖的方法通常有以下二種 : 一種是移動機械臂的傳動機構中，采用自鎖的運動副。如自鎖的蝸輪蝸桿副，移動機械臂的肩部采用了自鎖的蝸輪蝸桿傳動方式，實現(xiàn)自鎖。另一種是在移動機械臂附加自鎖機構。如自鎖器、固定盤、電磁閘等。為了防止微小的外力作用到移動機械臂驅動電機軸上而破壞移動，移動機械臂的肩部驅動力不應過小。 (d)有足夠的強度、剛度和使用壽命 由于移動機械臂工作條件較差，傳遞運動受力較大，且受動載荷的作用，各買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 部件應有足夠的強度和剛度，以保證移動機械臂肩部不被破壞和產生變形影響抓取精度。這在結構設計和材料選用 上應予考慮。同時還要考慮各傳動件之間的磨損問題，應盡量減小磨損，磨損以后能夠調整。 上述要求，既是移動機械臂設計的基礎，又是衡量移動機械臂性能好壞的依據。 機械臂的肩部結構分析 移動機械臂的肩部采用的蝸輪蝸桿式的，下面移動機械臂的肩部結構分析。 作用原理 肩部結構為蝸輪蝸桿式的。所謂蝸輪蝸桿式肩部，是指在肩部的傳動機構中，主要通過蝸輪蝸桿的傳動，使肩部回轉部分轉動，來實現(xiàn)機械臂方向移動的。移動機械臂的肩部還承受并傳遞臂部時回轉部分所產生的回轉力矩。 結構及分析 (1)結構 在前面的移動機械臂的肩部機械設計中，對機械臂的肩部結構己經有了詳細的介紹，詳見前面機械臂結構設計的相關內容，這里就不再累述了。 (2)分析 根據對移動機械臂的要求，來分析機械臂肩部結構性能。 （ a）為了提高方向移動精度，減小移動時產生的變位，要求保證在肩部傳動輕便靈活的情況下，空回量要小，保證臂部裝置在肩部上總的配合間隙所產生的方向移動改變量要小于一定值。肩部的空回量，主要取決于蝸輪蝸桿嚙合間隙、磨損情況、蝸桿是否有軸向串動及傳動連接件的間隙等。 肩部的蝸輪蝸桿傳動是開式傳動，不便于潤滑和防塵 ;因此傳 動過程中的磨損是較嚴重的。同時蝸輪蝸桿間的摩擦系數(shù)較大，也易于磨損。由于磨損較嚴重，從而增大蝸輪蝸桿的嚙合間隙，使肩部空回量變大，這同樣會影響移動精度和移動時的變位。工廠在裝配過程中應盡量減少裝配誤差，保證總的配合間隙對移動角的影響最小。 （ b）為了使傳動輕便、平穩(wěn)、靈活，在機械臂的肩部的傳動機構中，采用了滾動軸承并能通過注油嘴注油潤滑。蝸輪蝸桿在裝配前經過研磨檢查，裝配后又經過調整，使其兩齒的接觸面沿齒高達 60%，沿齒寬達 50%. 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 蝸桿為右旋，頭數(shù) 1z =1，蝸輪齒數(shù) 2z =32，配套減速器的減速比 1i =156，齒輪副傳動比 2i = 1，因此肩部的總傳動比 2 121 . . 3 2 1 5 6 1 1 3 7 6zi i i X (6又 w(6 式中。 肩關節(jié)電機轉動角速度 (6n 電機每分鐘轉數(shù)， n=10200r/m 回轉部分轉動角速度，即為移動速度 （ 6 將（ 6 6入（ 6得到移動肩部的速度 =s 上述為肩關節(jié)旋轉速度的理論計算值，移動機械臂的 旋轉速度最大 際測量值雖然會因傳動機構的加工裝配質量等的影響而大一些，但仍是符合移動技術要求的。滿足移動機械臂肩部的設計要求。 (c)移動機械臂肩部的自鎖是靠能夠自鎖的蝸輪蝸桿副來保證的。蝸輪蝸桿副自鎖條件：蝸桿螺旋角 小于折合摩擦角 和要可靠自鎖必須 比 至少小 1度。 由機械零件可知 (6買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 (6式中 蝸桿頭數(shù) =1 q 蝸桿特性系數(shù) 01m(6一蝸桿分度圓直徑 =28一蝸桿軸向模數(shù) =2上述各值代入公式得到： 01 由此可以看出 :蝸輪蝸桿雖然符合 條件，而且差大于 1，故自鎖可靠。 (d)蝸輪蝸桿式的肩部易于旋轉方向的要求。 肩部是蝸輪蝸桿傳動，蝸桿固定于蝸輪箱內，蝸輪位于蝸輪箱內，通過軸套與轉軸相連，與蝸桿嚙合。進行旋轉運動操作時，主控計算機把臂部角度與目標點的角度進行比 較，角度的差值通過電機驅動器驅動電機轉動，電機轉動經配套的減速器后，經過一對齒輪副的傳動，帶動蝸桿轉動，蝸桿與蝸輪嚙合，使得與蝸輪通過軸套連接的肩部轉軸轉動，從而使得固定于肩部轉軸的臂 部轉動，賦予肩部在 150 度范圍內轉動。 (e)蝸輪副的傳動一般具有工作平穩(wěn)、結構緊湊的特定，但是在這里將它用作移動機械臂的肩部傳動機構后，具體情況有所變化。因為蝸輪蝸桿分別安裝在箱體上，不能實現(xiàn)對蝸輪蝸桿的固定裝置進行組合加工來保證蝸輪蝸桿的中心距買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 有較小的偏差 ;裝配時，蝸輪中心與回轉中心不易重合，存在較大的偏差。從而不能保證蝸桿軸線與蝸輪的節(jié)圓在同一平面內。所以解決的辦法是蝸桿兩端加上調整墊片。也就是說，在傳動過程中，蝸輪蝸桿的嚙合情況是變化的，這就使得電機驅動肩部轉動時出現(xiàn)轉動不平穩(wěn)、驅動力不均勻現(xiàn)象。又 因為肩部為一級傳動，而且旋轉部分很重，體積較大，進行肩部旋轉定位時，回轉慣性也就較大，同時也沒有消除回轉慣性力矩的緩沖機構，這種回轉慣性也就敏感地、直接地反映到電機上來。由于法蘭盤和臂部體積較大，使得肩部的體積也較大，且不夠緊湊。 第 3 章 控制系統(tǒng)硬件 制系統(tǒng)模式的選擇 構建柑橘采摘機器人平臺的核心是建立柑橘采摘機器人的控制系統(tǒng)。首先需要選擇和硬件平臺，控制系統(tǒng)硬件平臺對于系統(tǒng)的開放性、實現(xiàn)方式和開發(fā)工作量有很大的影響。一般常用的控制系統(tǒng)硬件平臺應滿足：硬件系統(tǒng)基于標準總線機構，具有可伸縮性 ；硬件結構具有必要的實時計算能力；硬件系統(tǒng)模塊化，便于添加或更改各種接口、傳感器和特殊計算機等；低成本。到目前為止，一般柑橘采摘機器人控制系統(tǒng)的硬件平臺可以大致分為兩類：基于 線（ 司 1981 年推出的第一代 32 位工業(yè)開放標準總線 ）的系統(tǒng)和基于 線的系統(tǒng)。近年來，隨著 性能的快速發(fā)展，可靠性大為提高，價格卻大幅度降低，以 為核心的控制系統(tǒng)已廣泛被柑橘采摘機器人控制領域所接受。 基于 控制系統(tǒng)一般包括單 制模式， C 的控制模 式， 布式控制器的控制模式， 動控制卡的控制模式， 據采集卡的控制模式，由于基于采集卡的控制方式靈活，成本低廉，有利于本文設計中的廢物利用，在程序和算法上可以自主編制各類算法，適合本課題研究的需要。因此本文選定 據采集卡的控制方式。 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 制系統(tǒng)的搭建 圖 制系統(tǒng)框圖 控機 在此選用研華工業(yè)控制機 ,主頻 233存 128 兆， 32 位數(shù)據總線。底板有 9 個 槽， 4 個 槽，帶 示器。其性能價格比優(yōu)越， 兼容性好，有利于軟硬件維護和升級。與普通個人計算機相比工業(yè)控制 有以下優(yōu)點： 芯片篩選要比一般個人計算機嚴格； 芯片驅動能力較強； 整機內部結構屬于工業(yè)加強型，具有較強的防震和抗干擾性能； 對環(huán)境（如溫度、濕度、灰塵等）的要求要比一般計算機低得多。 據采集卡 在本設計中我們主要用到 研華 公司的 參數(shù)如下。 要特點 ： 路單端 12 位模擬量輸入 買文檔就送您 紙全套， Q 號交流 401339828 或 11970985 路 12 位模擬量輸出 采樣速率可編程，最快達 30帶 中斷的 A/D 路數(shù)字量輸出 要特點 ： 路獨立 D/A 輸出 位分辨率雙緩沖 D/A 轉換器 路數(shù)字量輸入及 16 路數(shù)字量輸出 多種電壓范圍： +/+/0 +5V， 0 +10V 和 4 20流環(huán) 。 服放大器 在驅動系統(tǒng)設計 過程 中，主要是對 伺服電機 的驅