工業(yè)機(jī)器人 三自由度直角坐標(biāo)工業(yè)機(jī)器人設(shè)計(jì)

1、沈 陽 工 程 學(xué) 院課 程 設(shè) 計(jì) 設(shè)計(jì)題目:三自由度直角坐標(biāo)工業(yè)機(jī)器人設(shè)計(jì)系 別 自控系 班級 測控本 071學(xué)生姓名 楊薇 學(xué)號 04 指導(dǎo)教師 祝尚臻 職稱 講師起止日期: 2010 年 12月 27日起 至 2011年 1月 7日沈陽工程學(xué)院課程設(shè)計(jì)任務(wù)書課程設(shè)計(jì)題目:三自由度直角坐標(biāo)工業(yè)機(jī)器人設(shè)計(jì)系 別 自動控制工程系 班級 測控本 071 學(xué)生姓名 楊薇學(xué) 號 2007309104指導(dǎo)教師 祝尚臻 職稱 講師課程設(shè)計(jì)進(jìn)行地點(diǎn): F430任 務(wù) 下 達(dá) 時(shí) 間: 2010 年 12月 27日起止日期:2010 年 12 月 27日起至 2011 年 1 月 7日止 教 研 室 主

2、任 年 月 日批準(zhǔn)火災(zāi)預(yù)警機(jī)器人的設(shè)計(jì)課程設(shè)計(jì)成績評定表 系(部:自控系 班級:測控本 071 學(xué)生姓名:楊薇 - II -中 文 摘 要角坐標(biāo)機(jī)器人具有空間上相互垂直的兩根或三根直線移動軸,通過直角坐標(biāo)方向的 3個獨(dú)立自由度確定其手部的空間位置, 其動作空間為一長方體。 直角坐標(biāo)機(jī)器人結(jié)構(gòu)簡單, 定位精度高,空間軌跡易于求解;但其動作范圍相對較小,設(shè)備的空間因數(shù)較低,實(shí)現(xiàn)相 同的動作空間要求時(shí),機(jī)體本身的體積較大。大型的直角坐標(biāo)機(jī)器人也稱桁架機(jī)器人或龍門式機(jī)器人是能夠?qū)崿F(xiàn)自動控制的、 可重復(fù)編程的、多自由度的、運(yùn)動自由度建成空間直角關(guān)系的、多用途的操作機(jī)。其 工作的行為方式主要是通過完成沿著

3、 X 、 Y 、 Z 軸上的線性運(yùn)動。近年來隨著工業(yè)機(jī)器 人的不斷發(fā)展, 工業(yè)機(jī)器人不斷在工業(yè)領(lǐng)域得到廣泛的應(yīng)用, 尤其是結(jié)構(gòu)簡單的直角 坐標(biāo)機(jī)器人, 本次設(shè)計(jì)我主要是對三自由度的直角坐標(biāo)機(jī)器人進(jìn)行設(shè)計(jì), 完成一個大 概的設(shè)計(jì),在設(shè)計(jì)中我采用了各種光電傳感器,還采用了 C8051F 系列單片機(jī)作為本 次設(shè)計(jì)的主控芯片 , 各種算法的實(shí)現(xiàn)就是使用這款芯片實(shí)現(xiàn)的。隨著直角坐標(biāo)機(jī)器人 的應(yīng)用越來越廣泛, 直角坐標(biāo)機(jī)器人的設(shè)計(jì)工作日益顯得重要。 成功的設(shè)計(jì)一臺直角 坐標(biāo)機(jī)器人涉及到很多方面的工作,包括機(jī)械結(jié)構(gòu)、動力驅(qū)動、伺服控制等等。關(guān)鍵詞 三自由度 直角坐標(biāo) 機(jī)器人- I -I目 錄1.3時(shí)間進(jìn)度安

4、排 . 12 設(shè)計(jì)思路 . 2 2.1系統(tǒng)總體結(jié)構(gòu)的設(shè)計(jì) . . 22.2系統(tǒng)各環(huán)節(jié)設(shè)計(jì) . 23 設(shè)計(jì)方框圖 . 35直角坐標(biāo)機(jī)器人的控制設(shè)計(jì) . . 12 5.1 示教再現(xiàn)功能 . 125.2運(yùn)動控制功能 . 126 主要元器件介紹 . 137 小結(jié) . 148 致謝 . 159. 參考文獻(xiàn) . 16 附錄 . . 1- II -1三自由度直角坐標(biāo)工業(yè)機(jī)器人設(shè)計(jì)1.1設(shè)計(jì)目的及基本要求1了解工業(yè)機(jī)器人技術(shù)的基本知識以及單片機(jī)、機(jī)械設(shè)計(jì)、傳感器等相關(guān)技術(shù)。2初步掌握工業(yè)機(jī)器人的運(yùn)動學(xué)原理、傳動機(jī)構(gòu)、驅(qū)動系統(tǒng)及控制系統(tǒng)并應(yīng)用于工業(yè)機(jī) 器人的設(shè)計(jì)中。1要求設(shè)計(jì)一個微型的三自由度的直角坐標(biāo)工業(yè)機(jī)器

5、人;2要求設(shè)計(jì)機(jī)器人的機(jī)械機(jī)構(gòu)(示意圖 ,傳動機(jī)構(gòu)、控制系統(tǒng)、及必需的內(nèi)外部傳感器 的種類和數(shù)量布局。3要有控制系統(tǒng)硬件設(shè)計(jì)電路。1.2對設(shè)計(jì)論文撰寫內(nèi)容、格式、字?jǐn)?shù)的要求(1 課程設(shè)計(jì)論文是體現(xiàn)和總結(jié)課程設(shè)計(jì)成果的載體,一般不應(yīng)少于 3000字。(2 學(xué)生應(yīng)撰寫的內(nèi)容為:中文摘要和關(guān)鍵詞、目錄、正文、參考文獻(xiàn)等。課程設(shè)計(jì) 論文的結(jié)構(gòu)及各部分內(nèi)容要求可參照沈陽工程學(xué)院畢業(yè)設(shè)計(jì)(論文撰寫規(guī)范執(zhí)行。 應(yīng)做到文理通順,內(nèi)容正確完整,書寫工整,裝訂整齊。(3 論文要求打印,打印時(shí)按沈陽工程學(xué)院畢業(yè)設(shè)計(jì)(論文撰寫規(guī)范的要求進(jìn) 行打印。(4 課程設(shè)計(jì)論文裝訂順序?yàn)?封面、任務(wù)書、成績評審意見表、中文摘要和

6、關(guān)鍵詞、 目錄、正文、參考文獻(xiàn)。1.3時(shí)間進(jìn)度安排 2010-12-27- 1 -12 設(shè)計(jì)思路2.1系統(tǒng)總體結(jié)構(gòu)的設(shè)計(jì)本次設(shè)計(jì)的題目是三自由度直角坐標(biāo)機(jī)器人,直角坐標(biāo)機(jī)器人具有空間上相互垂直的 兩根或三根直線移動軸,通過直角坐標(biāo)方向的 3個獨(dú)立自由度確定其手部的空間位置,其 動作空間為一長方體。直角坐標(biāo)機(jī)器人結(jié)構(gòu)簡單,定位精度高,空間軌跡易于求解;但其 動作范圍相對較小,設(shè)備的空間因數(shù)較低,實(shí)現(xiàn)相同的動作空間要求時(shí),機(jī)體本身的體積 較大。2.2系統(tǒng)各環(huán)節(jié)設(shè)計(jì)直角坐標(biāo)機(jī)器人,它由水平軸 (X軸, Y 軸 ,垂直軸 Z 軸及驅(qū)動電機(jī)組成。此外一個完整的機(jī)器人系統(tǒng)還需要控制系統(tǒng)和手抓,下面分別予以

7、介紹 :直線運(yùn)動軸也叫直線運(yùn)動單元,它就是一個獨(dú)立的運(yùn)動軸,主要由支撐載體的鋁型材或鋼型材 和被安裝在型材內(nèi)部的直線導(dǎo)軌、運(yùn)動滑塊以及作為帶動滑塊做高速運(yùn)動的同步帶組成。運(yùn)動軸的驅(qū)動系統(tǒng)直角坐標(biāo)機(jī)器人的傳動主要是通過驅(qū)動電機(jī)的轉(zhuǎn)動帶動同步帶運(yùn)動,同步帶帶動直 線導(dǎo)軌上的滑塊運(yùn)動。當(dāng)驅(qū)動軸的最高轉(zhuǎn)速低于 60Or/min時(shí)通常選用步進(jìn)電機(jī),否則選 用交流伺服電機(jī)。直角坐標(biāo)機(jī)器人的控制系統(tǒng)機(jī)器人要在一定時(shí)間內(nèi)完成特定的任務(wù),在完成抓取,加速運(yùn)動,高速運(yùn)動,減速 運(yùn)動, 釋放工件等同時(shí), 還要與相關(guān)的設(shè)備通過通訊或 I/O口實(shí)現(xiàn)一些時(shí)序上的協(xié)調(diào)同步。 另外在涂膠應(yīng)用上,各個運(yùn)動軸要完成直線和圓弧插補(bǔ)

8、運(yùn)動。因此其數(shù)控系統(tǒng)要按具體應(yīng) 用要求來選定其控制軸數(shù)、 I/O口數(shù)量和軟件功能。通常選用數(shù)控系統(tǒng), PLC ,工控機(jī)加運(yùn) 動控制卡和帶軸卡功能及 I/O口的驅(qū)動電機(jī)來做控制系統(tǒng)。直角坐標(biāo)機(jī)器人的末端操作器手爪系統(tǒng)根據(jù)其具體應(yīng)用情況,其手爪系統(tǒng)可能是氣動吸盤、氣動夾取手爪、電動夾取手爪、 電磁吸取手爪、 焊槍、 膠槍、 專用工具和檢測儀器等。 在很多場合可以一次抓取多個工件。- 2 -3 設(shè)計(jì)方框圖 圖 3 1主程序方框圖 - 3 -34 直角坐標(biāo)機(jī)器人的硬件設(shè)計(jì)4.1直角坐標(biāo)機(jī)器人的結(jié)構(gòu)特點(diǎn)針對各種不同的應(yīng)用,實(shí)際上可以方便快速組合成不同維數(shù),各種行程和不同帶載能 力的壁掛式、懸臂式、龍門式

9、或倒掛式等各種形式的直角坐標(biāo)機(jī)器人。從簡單的二維機(jī)器 人到復(fù)雜的五維機(jī)器人就有上百種結(jié)構(gòu)形式的成功應(yīng)用案例。從電機(jī)到汽車等各行各業(yè)的 自動化生產(chǎn)線中,更是各式各樣的多臺直角坐標(biāo)機(jī)器人和其它設(shè)備嚴(yán)格同步協(xié)調(diào)工作。可 以說直角坐標(biāo)機(jī)器人幾乎能勝任所有的工業(yè)自動化任務(wù)。下面是其主要特點(diǎn) :1. 任意組合成各種樣式 :每根直線運(yùn)動軸最長是 6m ,其帶載能力從 10kg 到 20Okg 。 在實(shí)際應(yīng)用中已有近百種結(jié)構(gòu)的直角坐標(biāo)機(jī)器人, 這些結(jié)構(gòu)也可以任意組合成新 的結(jié)構(gòu)等 ;2. 超大行程 :因?yàn)閱胃堥T式直線運(yùn)動單元的長度是 6m , 還可以多根方便地級連成超 大行程,所以其工作空間幾乎沒有限制,小

10、到手機(jī)點(diǎn)膠機(jī),大到 18m 長行程的切 割機(jī), sm 長行程鉆銑床, 6m 6m ” 3m 的檢測機(jī)器人等。超大行程時(shí)要采用直線 導(dǎo)軌和齒條傳動方式 ;3. 負(fù)載能力強(qiáng) :單根直線運(yùn)動單元的負(fù)載通常小于 20Okg 。但當(dāng)采用雙滑塊或多滑塊 剛性聯(lián)結(jié)時(shí)負(fù)載能力可以增加 5到 10倍。當(dāng)把兩根或四根直線運(yùn)動單元并排接 起來使用時(shí),其負(fù)載可以增加 2到 4倍。當(dāng)采用多根多滑塊結(jié)構(gòu)時(shí)其負(fù)載能力可 增加到數(shù)噸 ;4. 高動態(tài)特性 :輕負(fù)載時(shí)其最大運(yùn)行速度可達(dá)到 sm/s,加速度可達(dá)到 4m/s 。使其具 有很高的動態(tài)特性,工作效率非常高,通常在幾秒內(nèi)完成一個工作節(jié)拍 ;5. 高精度 :按傳動方式及配置

11、在整個行程內(nèi)其重復(fù)定位精度可達(dá)到 0.05mm 到 0.olmm;6. 擴(kuò)展能力強(qiáng) :可以方便改變結(jié)構(gòu)或通過編程來適合新的應(yīng)用 ;7. 簡單經(jīng)濟(jì) :對比關(guān)節(jié)機(jī)器人,直角坐標(biāo)機(jī)器人不僅外觀直觀且構(gòu)造成本低,編程簡 單類同數(shù)控銑床,易培訓(xùn)員工和維修,使其具有非常好的經(jīng)濟(jì)性 ;8. 勝任復(fù)雜任務(wù) :采用帶有 RTCP 功能的五軸或五軸以上數(shù)控系統(tǒng)能完成非常復(fù)雜的 噴涂,噴丸,檢測,加工等任務(wù) ;9. 壽命長 :直角坐標(biāo)機(jī)器人的維護(hù)通常就是周期性加注潤滑油,壽命一般是 10年以 上,維護(hù)好了可達(dá) 20年 ;10. 應(yīng)用面寬 :可以方便地裝配多種形式和尺寸的手爪,可以勝任許多常見的工作,如 焊接、切割,

12、搬運(yùn)、上下料、包裝、碼垛、拆垛、檢測、探傷、分類、裝配、貼 標(biāo)、噴碼、打碼和噴涂等任務(wù)。- 4 -4.2直角坐標(biāo)機(jī)器人的應(yīng)用因末端操作工具的不同,直角坐標(biāo)機(jī)器人可以非常方便的用作各種自動化設(shè)備,完 成如焊接、搬運(yùn)、上下料、包裝、碼垛、拆垛、檢測、探傷、分類、裝配、貼標(biāo)、噴碼、 打碼、 (軟仿型噴涂、目標(biāo)跟隨、排爆等一系列工作。特別適用于多品種,便批量的柔 性化作業(yè),對于穩(wěn)定,提高產(chǎn)品質(zhì)量,提高勞動生產(chǎn)率,改善勞動條件和產(chǎn)品的快速更新 換代期著十分重要的作用。4.3 直角坐標(biāo)機(jī)器人的分類1,按用途分:焊接機(jī)器人、碼垛機(jī)器人、涂膠(點(diǎn)膠機(jī)器人、檢測(監(jiān)測機(jī)器人、 分揀(分類機(jī)器人、裝配機(jī)器人、排爆

13、機(jī)器人、醫(yī)療機(jī)器人、特種機(jī)器人等。2,按結(jié)構(gòu)形式分:壁掛(懸臂機(jī)器人、龍門機(jī)器人、倒掛機(jī)器人等3,按自由度分:兩坐標(biāo)機(jī)器人、三坐標(biāo)機(jī)器人、四坐標(biāo)機(jī)器人、五坐標(biāo)機(jī)器人、六坐標(biāo) 機(jī)器人。4.4三自由度直角坐標(biāo)機(jī)器人的硬件設(shè)計(jì)工業(yè)機(jī)器人的機(jī)械結(jié)構(gòu)系統(tǒng)由基座、手臂、末端操作器三大件組成。每一大件都有若 干自由度,構(gòu)成一個多自由度的機(jī)械結(jié)構(gòu)。若基座具備行走機(jī)構(gòu)、則構(gòu)成行走機(jī)器人;若基座不具備行走及腰轉(zhuǎn)機(jī)構(gòu),則構(gòu)成單 機(jī)器人臂(Single Robot Arm 。手臂一般由上臂、下臂和手腕組成。末端操作器是直接裝 在手腕上的一個重要部件,它可以是二手指或多手指的手抓,也可以是噴漆槍、焊具等作 業(yè)工具。工業(yè)

14、機(jī)器人的坐標(biāo)形式多種多樣,按坐標(biāo)形式來分的話有:直角坐標(biāo)型、圓柱坐標(biāo)型、 球坐標(biāo)型、關(guān)節(jié)坐標(biāo)型和平面關(guān)節(jié)型。在本次設(shè)計(jì)中我們要設(shè)計(jì)的機(jī)器人為三坐標(biāo)直角坐標(biāo)機(jī)器人,這種機(jī)器人由三個線性 關(guān)節(jié)組成,這三個關(guān)節(jié)用來確定末端操作器的位置,通常還帶有附加的旋轉(zhuǎn)關(guān)節(jié),用來確 定末端操作器的姿態(tài)。這種機(jī)器人在想 x 、 y 、 z 軸上的運(yùn)動時(shí)獨(dú)立的,運(yùn)動方程可獨(dú)立處 理,且方程式是線性的,因此,很容易通過計(jì)算機(jī)控制實(shí)現(xiàn);它可以兩端支撐,對于給定 的結(jié)構(gòu)長度,剛性最大;它的精度和位置分辨率不隨工作場合而變化,容易達(dá)到高精度。 下圖 4-1為其工作,空間示意圖。- 5 -5圖 4-1從上圖可以看到此機(jī)器人具有

15、三個自由度,其參考坐標(biāo)系為 x 、 y 、 z 。自由度是指機(jī)器 人所具有的獨(dú)立坐標(biāo)軸運(yùn)動的數(shù)目,理論上自由度越多機(jī)器人越靈活,那么它的躲避障礙 物和改善動力性能就會得到提高。表 4-1 工業(yè)機(jī)器人常用傳動方式的比較 傳動機(jī)構(gòu)是指向各軸傳遞運(yùn)動和動力,以實(shí)現(xiàn)軸間的相對移動,在三自由度直角坐標(biāo) 機(jī)器人中,其主要傳動機(jī)構(gòu)為平移型傳動機(jī)構(gòu)。從上表一中我們可以看到各種傳動方式的 對比。機(jī)械傳動機(jī)構(gòu),可以將動力所提供的運(yùn)動的方式、方向或速度加以改變,被人們 有目的地加以利用。我國古代傳動機(jī)構(gòu)類型很多,應(yīng)用很廣,除了上面介紹的以外,- 6 -像地動儀、鼓風(fēng)機(jī)等等,都是機(jī)械傳動機(jī)構(gòu)的產(chǎn)物。我國古代傳動機(jī)構(gòu),

16、主要有齒輪 傳動、繩帶傳動和鏈傳動。齒輪傳動 齒輪只用來傳遞運(yùn)動,強(qiáng)度要求不高。至于生產(chǎn)上所采用的齒輪,要 傳遞較大的動力,受力一般較大,強(qiáng)度要求較高。古代在利用畜力、水力和風(fēng)力進(jìn)行 提水、糧食加工等工作時(shí),都要應(yīng)用此類齒輪。例如在翻車上,須應(yīng)用一級齒輪傳動 機(jī)構(gòu),以改變運(yùn)動的方位和傳遞,適應(yīng)翻車的工作要求。其工作示意圖如下圖 4-2。 齒輪傳動式由兩個或兩個以上的齒輪組成的傳動機(jī)構(gòu)。它不但可以傳遞運(yùn)動角位 移和角速度,而且還可以傳遞力和力矩。圖 4-2鏈傳動 鏈,在我國古代出現(xiàn)很早,商代的馬具上已有青銅鏈條,其他青銅器和 玉器上也有用鏈條作為裝飾的。西安出土的秦代銅車馬上,有十分精美的金屬鏈

17、條。 但這都不能算是鏈傳動。作為動力傳動的鏈條,出現(xiàn)在東漢時(shí)期。東漢時(shí)畢嵐率先發(fā) 明翻車, 用以引水。 根據(jù)其工作原理和運(yùn)動關(guān)系, 可以看作是一種鏈傳動。 翻車的上、 下鏈輪,一主動,一從動,繞在輪上的翻板就是傳動鏈,這個傳動鏈兼做提水的工作 件,因此,翻車是鏈傳動的一種特例。到了宋代,蘇頌制造的水運(yùn)儀象臺上,出現(xiàn)了 一種“天梯”,實(shí)際上是一種鐵鏈條,下橫軸通過“天梯”帶動上橫軸,從而形成了 真正的鏈傳動。繩帶傳動 這是一種利用摩擦力的傳動方式。在西漢時(shí),四川出產(chǎn)井鹽,在鑿井、 提水時(shí),都是用牛帶動大繩輪,收卷繞過滑輪上的繩索,來提升鑿井工具、鹵水等。 西漢時(shí)出現(xiàn)的手搖紡車,是一種典型的繩帶傳

18、動。在西漢時(shí)期的畫像石上,有幾幅手 搖紡車圖,可以清楚地看到:大繩輪主動,通過繩索帶動紗錠,用手搖大繩輪旋轉(zhuǎn)一 周,紗錠旋轉(zhuǎn)幾十周,效率很高。以后出現(xiàn)的三錠、五錠的紡車,效率就更高了。元 代的水運(yùn)大紡車, 也是用繩帶傳動的。 東漢時(shí), 冶金手工業(yè)有一項(xiàng)重要發(fā)明“水排”, 用于鼓風(fēng)。這種繩帶傳動的工作原理是:水力推動臥式水輪旋轉(zhuǎn),水輪軸上裝有大繩 輪,通過繩帶帶動小繩輪,小繩輪軸上端曲柄隨之旋轉(zhuǎn),通過連桿推動鼓風(fēng)器鼓風(fēng)。 這種水排鼓風(fēng)效力很高,可以抵得上幾百匹馬鼓風(fēng)。它的出現(xiàn),標(biāo)志著東漢時(shí)發(fā)達(dá)的 機(jī)械已經(jīng)在我國出現(xiàn)了,因而意義十分重大。在經(jīng)過了以上論證后,我決定采用齒輪鏈傳動機(jī)構(gòu)。現(xiàn)在我以圖 4

19、-3為例來說明齒輪鏈傳動的轉(zhuǎn)換關(guān)系。 - 7 -7 圖 4-3在設(shè)計(jì)這個齒輪鏈傳動機(jī)構(gòu)的時(shí)候我主要考慮到兩個問題:一是齒輪鏈的引入會改變 系統(tǒng)的等效轉(zhuǎn)動慣量,從而使驅(qū)動電機(jī)的響應(yīng)時(shí)間減少,這樣伺服系統(tǒng)就更加容易控制。 輸出軸轉(zhuǎn)動慣量轉(zhuǎn)換到驅(qū)動電機(jī)上,等效轉(zhuǎn)動慣量的下降與輸入輸出齒輪齒數(shù)的平方成正 比。 二是在引入齒輪鏈的同時(shí), 由于齒輪間隙誤差, 將會導(dǎo)致機(jī)器人手臂的定位誤差增加; 而且,假如不采取一些補(bǔ)救措施,齒隙誤差還會引起伺服系統(tǒng)的不穩(wěn)定性。要使機(jī)器人運(yùn)動起來,需給各個關(guān)節(jié)即每個運(yùn)動自由度安置傳動裝置,這就是驅(qū)動系 統(tǒng)。驅(qū)動系統(tǒng)可以是液壓驅(qū)動、氣動驅(qū)動、電動驅(qū)動,或者把它們結(jié)合起來應(yīng)用的

20、綜合系 統(tǒng);可以是直接驅(qū)動或者是通過同步帶、鏈條、輪系、諧波齒輪等機(jī)械傳動機(jī)構(gòu)進(jìn)行間接 驅(qū)動。下面我各自介紹這三種驅(qū)動方式:( 1 液壓驅(qū)動液壓驅(qū)動是由高精度的缸體和活塞一起完成的?；钊透左w采用滑動配合,壓力油從 液壓缸的一端進(jìn)入,把活塞推向液壓缸的另一端,調(diào)節(jié)液壓缸內(nèi)部活塞兩端的液體壓力和 進(jìn)入液壓缸的油量即可控制活塞的運(yùn)動。機(jī)器人的驅(qū)動系統(tǒng)采用液壓驅(qū)動,有以下幾個優(yōu)點(diǎn):A 、液壓容易達(dá)到較高的單位面積壓力,體積小,可獲得較大的推理或轉(zhuǎn)矩。B 、液壓系統(tǒng)介質(zhì)的可壓縮性小,工作平穩(wěn)可靠,并可得到較高的位置精度。C 、液壓傳動中力、速度和方向比較容易實(shí)現(xiàn)自動控制。D 、液壓系統(tǒng)采用油液做介質(zhì),

21、具有防銹性和自潤滑性能,壽命長。但是液壓驅(qū)動也有其不足之處:A 、 液壓的粘度隨溫度變化而變化,這將影響工作性能。高溫度容易引起爆炸、燃燒等 危險(xiǎn)。B 、 液體的泄露難于克服,要求液壓元件有較高的精度和質(zhì)量,故造價(jià)較高。C 、 需要相應(yīng)的供油系統(tǒng), 尤其是電液伺服系統(tǒng)要求嚴(yán)格的濾油裝置, 否則會引起故障。 ( 2 氣壓驅(qū)動與液壓驅(qū)動相比,氣壓驅(qū)動的特點(diǎn)是:A 、壓縮空氣粘度小,容易達(dá)到高速(1m/s 。B 、利用工廠集中的空氣壓縮機(jī)站供氣,不必添加動力設(shè)備。- 8 -C 、空氣介質(zhì)對環(huán)境無污染,使用安全,可直接應(yīng)用于高溫作業(yè)。D 、氣動元件工作壓力低,故制造要求也比液壓元件低。氣壓驅(qū)動的不足之

22、處是:A 、壓縮空氣常用壓力為 0.40.6MPa,若要獲得較大的壓力,其結(jié)構(gòu)就要相對增大。B 、空氣壓縮性大,工作平穩(wěn)性差,速度控制困難,要達(dá)到準(zhǔn)確的位置控制和困難。C 、 壓縮空氣的除水問題是一個很重要的問題,處理不當(dāng)會使剛類零件生銹,導(dǎo)致機(jī) 器人失靈。此外,排氣還會造成噪聲污染。( 3 電力驅(qū)動分類:按照電機(jī)的工作原理不同分為步進(jìn)電機(jī)、直流伺服電機(jī)、無刷電機(jī)等。按照控制水平的高低來分分為開環(huán)控制系統(tǒng)和閉環(huán)控制系統(tǒng)。適用范圍:適合于中等負(fù)載,特別適合于動作復(fù)雜、運(yùn)動軌跡嚴(yán)格的各類機(jī)器人?？紤]到體積以及精度,在比較了以上三種驅(qū)動方式后,我最終選擇了電力驅(qū)動,因?yàn)殡娏?驅(qū)動體積小,而且容易組成

23、閉環(huán)控制系統(tǒng),故控制精度高,方便,但在算法上可能稍微復(fù) 雜一些,但這都可以克服的,故實(shí)現(xiàn)起來時(shí)選擇電力驅(qū)動更好一些。電機(jī)控制系統(tǒng)中的位置檢測通常有:微電機(jī)解算元件,光電元件,磁敏元件,電磁感 應(yīng)元件等。這些位置檢測傳感器或者與電機(jī)的非負(fù)載端同軸連接,或者直接安裝在電機(jī)的 特定的部位。其中光電元件的測量精度較高,能夠準(zhǔn)確的反應(yīng)電機(jī)的轉(zhuǎn)子的機(jī)械位置,從 而間接的反映出與電機(jī)連接的機(jī)械負(fù)載的準(zhǔn)確的機(jī)械位置,從而達(dá)到精確控制電機(jī)位置的 目的。( 1 光電編碼器的介紹:光電編碼器是通過讀取光電編碼盤上的圖案或編碼信息來表示與光電編碼器相連的 電機(jī)轉(zhuǎn)子的位置信息的。根據(jù)光電編碼器的工作原理可以將光電編碼器

24、分為絕對式光電編 碼器與增量式光電編碼器,下面我就這兩種光電編碼器的結(jié)構(gòu)與工作原理做介紹。A 、絕對式光電編碼器絕對式光電編碼器如圖 4-4所示,它是通過讀取編碼盤上的二進(jìn)制的編碼信息來表示 絕對位置信息的。編碼盤是按照一定的編碼形式制成的圓盤。圖十一是二進(jìn)制的編碼盤,圖中空白部分 是透光的,用“0”來表示 ; 涂黑的部分是不透光的,用“1”來表示。通常將組成編碼的 圈稱為碼道, 每個碼道表示二進(jìn)制數(shù)的一位, 其中最外側(cè)的是最低位, 最里側(cè)的是最高位。 如果編碼盤有 4個碼道,則由里向外的碼道分別表示為二進(jìn)制的 23、 22、 21和 20, 4位 二進(jìn)制可形成 16個二進(jìn)制數(shù),因此就將圓盤劃

25、分 16個扇區(qū),每個扇區(qū)對應(yīng)一個 4位二進(jìn) 制數(shù),如 0000、 0001、 1111。- 9 -9圖 4-4按照碼盤上形成的碼道配置相應(yīng)的光電傳感器,包括光源、透鏡、碼盤、光敏二極管和驅(qū) 動電子線路。當(dāng)碼盤轉(zhuǎn)到一定的角度時(shí),扇區(qū)中透光的碼道對應(yīng)的光敏二極管導(dǎo)通,輸出 低電平“0”,遮光的碼道對應(yīng)的光敏二極管不導(dǎo)通,輸出高電平“1”,這樣形成與編碼 方式一致的高、低電平輸出,從而獲得扇區(qū)的位置腳。B 、增量式光電編碼器增量式光電編碼器是碼盤隨位置的變化輸出一系列的脈沖信號,然后根據(jù)位置變化的 方向用計(jì)數(shù)器對脈沖進(jìn)行加 /減計(jì)數(shù),以此達(dá)到位置檢測的目的。它是由光源、透鏡、主 光柵碼盤、鑒向盤、光

26、敏元件和電子線路組成。增量式光電編碼器的工作原理是是由旋轉(zhuǎn)軸轉(zhuǎn)動帶動在徑向有均勻窄縫的主光柵碼盤 旋轉(zhuǎn),在主光柵碼盤的上面有與其平行的鑒向盤,在鑒向盤上有兩條彼此錯開 90o 相位的 窄縫,并分別有光敏二極管接收主光柵碼盤透過來的信號。工作時(shí),鑒向盤不動,主光柵 碼盤隨轉(zhuǎn)子旋轉(zhuǎn),光源經(jīng)透鏡平行射向主光柵碼盤,通過主光柵碼盤和鑒向盤后由光敏二 極管接收相位差 90o 的近似正弦信號,再由邏輯電路形成轉(zhuǎn)向信號和計(jì)數(shù)脈沖信號。為了 獲得絕對位置角,在增量式光電編碼器有零位脈沖,即主光柵每旋轉(zhuǎn)一周,輸出一個零位 脈沖,使位置角清零。利用增量式光電編碼器可以檢測電機(jī)的位置和速度。( 2 光電編碼器的測量

27、方法:光電碼器在電機(jī)控制中可以用來測量電機(jī)轉(zhuǎn)子的磁場位置和機(jī)械位置以及轉(zhuǎn)子的磁場 和機(jī)械位置的變化速度與變化方向。下面就我就光電編碼器在這幾方面的應(yīng)用方法做一下 介紹?？梢岳枚〞r(shí)器 /計(jì)數(shù)器配合光電編碼器的輸出脈沖信號來測量電機(jī)的轉(zhuǎn)速。具體的測 速方法有 M 法、 T 法和 M/T法 3種。M法又稱之為測頻法,其測速原理是在規(guī)定的檢測時(shí)間 Tc 內(nèi),對光電編碼器輸出的脈 沖信號計(jì)數(shù)的測速方法,例如光電編碼器是 N 線的,則每旋轉(zhuǎn)一周可以有 4N 個脈沖,因 為兩路脈沖的上升沿與下降沿正好使編碼器信號 4倍頻。 現(xiàn)在假設(shè)檢測時(shí)間是 Tc , 計(jì)數(shù)器 的記錄的脈沖數(shù)是 M1,則電機(jī)的每分鐘的轉(zhuǎn)速

28、為在實(shí)際的測量中,時(shí)間 Tc 內(nèi)的脈沖個數(shù)不一定正好是整數(shù),而且存在最大半個脈沖的 誤差。如果要求測量的誤差小于規(guī)定的范圍,比如說是小于百分之一,那么 M1就應(yīng)該大 于 50。 在一定的轉(zhuǎn)速下要增大檢測脈沖數(shù) M1以減小誤差, 可以增大檢測時(shí)間 Tc 單考慮到 實(shí)際的應(yīng)用檢測時(shí)間很短,例如伺服系統(tǒng)中的測量速度用于反饋控制,一般應(yīng)在 0.01秒 以下。由此可見,減小測量誤差的方法是采用高線數(shù)的光電編碼器。 - 10 -M法測速適用于測量高轉(zhuǎn)速, 因?yàn)閷τ诮o定的光電編碼器線數(shù) N 機(jī)測量時(shí)間 Tc 條件下, 轉(zhuǎn)速越高,計(jì)數(shù)脈沖 M1越大,誤差也就越小。T法也稱之為測周法,該測速方法是在一個脈沖周期

29、內(nèi)對時(shí)鐘信號脈沖進(jìn)行計(jì)數(shù)的方 法。例如時(shí)鐘頻率為 fclk, 計(jì)數(shù)器記錄的脈沖數(shù)為 M2,光電編碼器是 N 線的,每線輸出 4N 個脈沖,那么電機(jī)的每分鐘的轉(zhuǎn)速為為了減小誤差,希望盡可能記錄較多的脈沖數(shù),因此 T 法測速適用于低速運(yùn)行的場合。 但轉(zhuǎn)速太低,一個編碼器輸出脈沖的時(shí)間太長,時(shí)鐘脈沖數(shù)會超過計(jì)數(shù)器最大計(jì)數(shù)值而產(chǎn) 生溢出 ; 另外,時(shí)間太長也會影響控制的快速性。與 M 法測速一樣,選用線數(shù)較多的光電 編碼器可以提高對電機(jī)轉(zhuǎn)速測量的快速性與精度。M/T法測速是將 M 法和 T 法兩種方法結(jié)合在一起使用, 在一定的時(shí)間范圍內(nèi), 同時(shí)對光 電編碼器輸出的脈沖個數(shù) M1和 M2進(jìn)行計(jì)數(shù),則電機(jī)

30、每分鐘的轉(zhuǎn)速為實(shí)際工作時(shí),在固定的 Tc 時(shí)間內(nèi)對光電編碼器的脈沖計(jì)數(shù),在第一個光電編碼器上升 沿定時(shí)器開始定時(shí),同時(shí)開始記錄光電編碼器和時(shí)鐘脈沖數(shù),定時(shí)器定時(shí) Tc 時(shí)間到,對 光電編碼器的脈沖停止計(jì)數(shù),而在下一個光電編碼器的上升沿到來時(shí)刻,時(shí)鐘脈沖才停止 記錄。采用 M/T法既具有 M 法測速的高速優(yōu)點(diǎn),又具有 T 法測速的低速的優(yōu)點(diǎn),能夠覆蓋 較廣的轉(zhuǎn)速范圍,測量的精度也較高,在電機(jī)的控制中有著十分廣泛的應(yīng)用。通過以上這種光電式的測速傳感器,我們就可以達(dá)到控制機(jī)器人的運(yùn)動速度和控制機(jī) 器人的位移的目的,例如假如我要讓機(jī)器人快速地完成某個搬運(yùn)的任務(wù),這個時(shí)候我就可 以調(diào)用 PID 算法來使

31、機(jī)器人快速地達(dá)到某個速度,從而完成這個動作,又例如我要讓機(jī)器 人移動某段距離,這個時(shí)候我就可以通過對脈沖個數(shù)的累加來完成對距離的控制,由于這 種光電式編碼器的精度很高,故可以達(dá)到高精度的距離控制。 - 11 -11 5直角坐標(biāo)機(jī)器人的控制設(shè)計(jì)5.1 示教再現(xiàn)功能示教再現(xiàn)功能是指控制系統(tǒng)可以通過坐示教盒或手把手進(jìn)行示教,將動作順序、運(yùn)動 速度、位置等信息用一定的方法預(yù)先教給工業(yè)機(jī)器人,由工業(yè)機(jī)器人的記憶裝置將所 教的操作過程自動地記錄在存儲器中,當(dāng)需要再現(xiàn)操作時(shí),重放存儲器中存儲的內(nèi)容 即可。如需要更改操作內(nèi)容時(shí),只需要重新示教一遍即可。5.2運(yùn)動控制功能運(yùn)動控制功能是指對工業(yè)機(jī)器人末端操作器的

32、位置、速度、加速度等項(xiàng)目的控制。 在本次設(shè)計(jì)中我采用示教再現(xiàn)控制方式來對此機(jī)器人進(jìn)行控制,其主控芯片為我們熟 悉的 C8051F020單片機(jī)。 使用此款單片機(jī)再配合一些外圍電路的集成就可實(shí)現(xiàn)對各個電動 機(jī)的控制,再加上一些在軟件上的編寫配合好光電編碼器,就可以實(shí)現(xiàn) PID 算法,并組成 一個簡單的閉環(huán)系統(tǒng)。圖 5-1人機(jī)交互模塊6 主要元器件介紹C8051F020系列單片機(jī)是高集成度的混合信號系統(tǒng)級 MCU 芯片,片內(nèi)集成了一個多通道 ADC 、兩個電壓比較器、五個通用的十六位定時(shí)器、 UART 、 SPI 總線接口、內(nèi)部振蕩器、 64個通用數(shù)字 I/O引腳、 64KB 的 FLASH 程序寄存器和與 8051兼容的高速微控制器內(nèi)核。 C8051F020的主要特點(diǎn)如下:1、模擬外設(shè)( 1 逐次逼近型 ADC 12位分辨率或 8位分辨率;可編程轉(zhuǎn)換速率,最大為 100kps ;可多達(dá) 32個外部輸入,每個引腳都可以被配置為 ADC 的輸入。( 2 兩個模擬比較器 16個可編程回差電壓值;可用于產(chǎn)生中斷或復(fù)位。( 3 VDD監(jiān)視器和降壓檢測器2、片內(nèi) JTAG 調(diào)試片內(nèi)調(diào)試電路提供提供全速、非侵入式的在系統(tǒng)調(diào)試;支持?jǐn)帱c(diǎn)、單步、觀察點(diǎn)、堆棧監(jiān)視器,支持觀察 /修改存儲器和寄存器。3、高速 8051微控制器內(nèi)核流水線