課程設計--三自由度機械手臂設計說明書

1、<p>　　三自由度機械手臂設計</p><p><b>　　學 院： </b></p><p><b>　　專 業(yè)： </b></p><p><b>　　學生姓名： </b></p><p><b>　　學生姓名： </b&

2、gt;</p><p><b>　　學生姓名： </b></p><p>　　指導教師： </p><p><b>　　摘 要</b></p><p>　　在當今大規(guī)模制造業(yè)中，企業(yè)為提高生產(chǎn)效率，保障產(chǎn)品質量，普遍重視生產(chǎn)過程的自動化程度，工業(yè)機器人作為自動化生產(chǎn)線上的重要成員，逐漸被企

3、業(yè)所認同并采用。工業(yè)機器人的技術水平和應用程度在一定程度上反映了一個國家工業(yè)自動化的水平，目前，工業(yè)機器人主要承擔著焊接、噴涂、搬運以及堆垛等重復性并且勞動強度極大的工作，工作方式一般采取示教再現(xiàn)的方式。</p><p>　　本文將設計一臺四自由度的工業(yè)機器人，用于給沖壓設備運送物料。首先，本文將設計機器人的底座、大臂、小臂和機械手的結構，然后選擇合適的傳動方式、驅動方式，搭建機器人的結構平臺；在此基礎上，本文將

4、設計該機器人的控制系統(tǒng)，包括數(shù)據(jù)采集卡和伺服放大器的選擇、反饋方式和反饋元件的選擇、端子板電路的設計以及控制軟件的設計，重點加強控制軟件的可靠性和機器人運行過程的安全性，最終實現(xiàn)的目標包括：關節(jié)的伺服控制和制動問題、實時監(jiān)測機器人的各個關節(jié)的運動情況、機器人的示教編程和在線修改程序、設置參考點和回參考點。</p><p><b>　　目 錄</b></p><p>　

5、　第1章 緒論………………………………………………………………………… 5</p><p>　　1.1 機器人概述……………………………………………………………… 5</p><p>　　第2章 機器人實驗平臺介紹及機械手的設計…………………………………… 6</p><p>　　2.1自由度及關節(jié)…………………………………………………………… 6</p>

6、;<p>　　2.2 基座及連桿……………………………………………………………… 6</p><p>　　2.2.1 基座……………………………………………………………… 6</p><p>　　2.2.2 機械臂…………………………………………………………… 6</p><p>　　2.3 機械手的設計……………………………………………………………

7、6</p><p>　　2.4 驅動方式………………………………………………………………… 8</p><p>　　2.5 傳動方式………………………………………………………………… 9</p><p>　　2.6 制動器…………………………………………………………………… 10</p><p>　　第3章 控制系統(tǒng)硬件……………………………

8、………………………………… 11</p><p>　　3.1 控制系統(tǒng)模式的選擇…………………………………………………… 11</p><p>　　3.2 控制系統(tǒng)的搭建……………………………………………………… 11</p><p>　　3.2.1 工控機…………………………………………………………… 12</p><p>　　3.2.

9、2 數(shù)據(jù)采集卡……………………………………………………… 12</p><p>　　3.2.3 伺服放大器……………………………………………………… 13</p><p>　　3.2.4 端子板…………………………………………………………… 14</p><p>　　3.2.5電位器及其標定………………………………………………… 15</p><

10、p>　　3.2.6電源……………………………………………………………… 16</p><p>　　第4章 控制系統(tǒng)軟件……………………………………………………………… 16</p><p>　　4.1預期的功能……………………………………………………………… 16</p><p>　　4.2 實現(xiàn)方法………………………………………………………………… 16&l

11、t;/p><p>　　4.2.1實時顯示各個關節(jié)角及運動范圍控制………………………… 16</p><p>　　4.2.2直流電機的伺服控制…………………………………………… 16</p><p>　　4.2.3電機的自鎖………………………………………………………16</p><p>　　4.2.4示教編程及在線修改程序…………………………………

12、… 17</p><p>　　第5章 總結……………………………………………………………………… 18</p><p>　　5.1 所完成的工作………………………………………………………… 18</p><p>　　5.2 設計經(jīng)驗……………………………………………………………… 18</p><p>　　參考文獻…………………………………

13、……………………………………… 20</p><p><b>　　第1章 緒論</b></p><p><b>　　1.1 機器人概述</b></p><p>　　在現(xiàn)代工業(yè)中，生產(chǎn)過程的機械化、自動化已成為突出的主題。化工等連續(xù)性生產(chǎn)過程的自動化已基本得到解決。但在機械工業(yè)中，加工、裝配等生產(chǎn)是不連續(xù)的。專用機床是大批

14、量生產(chǎn)自動化的有效辦法；程控機床、數(shù)控機床、加工中心等自動化機械是有效地解決多品種小批量生產(chǎn)自動化的重要辦法。但除切削加工本身外，還有大量的裝卸、搬運、裝配等作業(yè)，有待于進一步實現(xiàn)機械化。機器人的出現(xiàn)并得到應用，為這些作業(yè)的機械化奠定了良好的基礎。</p><p>　　“工業(yè)機器人”（Industrial Robot）：多數(shù)是指程序可變（編）的獨立的自動抓取、搬運工件、操作工具的裝置（國內稱作工業(yè)機器人或通用機器

15、人）。</p><p>　　機器人是一種具有人體上肢的部分功能，工作程序固定的自動化裝置。機器人具有結構簡單、成本低廉、維修容易的優(yōu)勢，但功能較少，適應性較差。目前我國常把具有上述特點的機器人稱為專用機器人，而把工業(yè)機械人稱為通用機器人。</p><p>　　簡而言之，機器人就是用機器代替人手，把工件由某個地方移向指定的工作位置，或按照工作要求以操縱工件進行加工。</p>&

16、lt;p>　　機器人一般分為三類。第一類是不需要人工操作的通用機器人，也即本文所研究的對象。它是一種獨立的、不附屬于某一主機的裝置，可以根據(jù)任務的需要編制程序，以完成各項規(guī)定操作。它是除具備普通機械的物理性能之外，還具備通用機械、記憶智能的三元機械。第二類是需要人工操作的，稱為操作機（Manipulator）。它起源于原子、軍事工業(yè)，先是通過操作機來完成特定的作業(yè)，后來發(fā)展到用無線電訊號操作機器人來進行探測月球等。工業(yè)中采用的鍛造

17、操作機也屬于這一范疇。第三類是專業(yè)機器人，主要附屬于自動機床或自動生產(chǎn)線上，用以解決機床上下料和工件傳送。這種機器人在國外通常被稱之為“Mechanical Hand”，它是為主機服務的，由主機驅動。除少數(shù)外，工作程序一般是固定的，因此是專用的。</p><p>　　機器人按照結構形式的不同又可分為多種類型，其中關節(jié)型機器人以其結構緊湊，所占空間體積小，相對工作空間最大，甚至能繞過基座周圍的一些障礙物等這樣一些特

18、點，成為機器人中使用最多的一種結構形式，世界一些著名機器人的本體部分都采用這種機構形式的機器人。</p><p>　　第2章 實驗平臺介紹及機械手的設計</p><p>　　該設計的目的是為了設計一臺物料搬運機器人，利用現(xiàn)有已經(jīng)報廢的焊接機器人，本文的中結構設計主要偏向于對原有機構的改造和機械手的設計。</p><p><b>　　2.1自由度及關節(jié)<

19、;/b></p><p>　　該機器人具有三個自由度 ，即腰關節(jié)、肩關節(jié)、肘關節(jié)，都為轉動關節(jié)；還有一個用于夾持物料的機械手。</p><p><b>　　2.2基座及連桿</b></p><p><b>　　2.2.1 基座</b></p><p>　　基座是整個機器人本體的支撐。為保證機器

20、人運行的穩(wěn)定性，采用兩塊“Z”字形實心鑄鐵作支撐。</p><p>　　基座上面是接線盒子，所有電機的驅動信號和反饋信號都從中出入。接線盒子外面，有一個引入線出口和一個引出線出口。</p><p><b>　　2.2.2 機械臂</b></p><p>　　大臂長度230mm 小臂長度240mm</p>

21、<p><b>　　2.3機械手的設計</b></p><p>　　工業(yè)機器人的手又稱為末端執(zhí)行器，它使機器人直接用于抓取和握緊（吸附）專用工具（如噴槍、扳手、焊具、噴頭等）進行操作的部件。它具有模仿人手動作的功能，并安裝于機器人手臂的前端。由于被握工件的形狀、尺寸、重量、材質及表面狀態(tài)等不同，因此工業(yè)機器人末端操作器是多種多樣的，大致可分為以下幾類：</p>&l

22、t;p><b>　　夾鉗式取料手</b></p><p><b>　　吸附式取料手</b></p><p><b>　　專用操作器及轉換器</b></p><p><b>　　仿生多指靈巧手</b></p><p>　　本文設計對象為物料搬運機器人，

23、并不需要復雜的多指人工指，只需要設計能從不同角度抓取工件的鉗形指。</p><p>　　手指是直接與工件接觸的部件。手指松開和夾緊工件，是通過手指的張開與閉合來實現(xiàn)的。該設計采用兩個手指，其外形如圖2.3所示</p><p>　　圖2.1 機械手手指形狀</p><p>　　傳動機構是向手指傳遞運動和動力，以實現(xiàn)夾緊和松開動作的機構。根據(jù)手指開合的動作特點分為回轉型

24、和平移形。本文采用回轉型傳動機構。圖2.4為初步設計的機械手機構簡圖（只畫出了一半，另外一半關于中心線對稱）。</p><p>　　圖2.2 機械手機構簡圖</p><p>　　在圖2.4中，O為電機輸出軸，曲柄OA、連桿AB、滑塊B和支架構成曲柄滑塊機構；滑塊B、連桿BC、搖桿CE和支架構成滑塊搖桿機構。通過兩個機構串聯(lián)，使電機最終驅動DE的來回擺動，從而實現(xiàn)手指的開合運動。</p

25、><p>　　圖2.4中的黑線和藍線表示機構運行的兩個極限位置。</p><p>　　為便于手指的順利合攏，可以在兩個手指之間設置一個彈簧，這樣還可以提供適當?shù)膴A緊力。</p><p>　　另外，在選用電機的時候，要使電機的功率足以克服彈簧的收縮和張開，并且提供足夠加緊物體的力。</p><p><b>　　2.4驅動方式</b&

26、gt;</p><p>　　該機器人一共具有四個獨立的轉動關節(jié)，連同末端機械手的運動，一共需要五個動力源。機器人常用的驅動方式有液壓驅動、氣壓驅動和電機驅動三種類型。</p><p>　　機器人驅動系統(tǒng)各有其優(yōu)缺點，通常對機器人的驅動系統(tǒng)的要求有：</p><p>　　1）．驅動系統(tǒng)的質量盡可能要輕，單位質量的輸出功率要高，效率也要高；</p><

27、;p>　　2）．反應速度要快，即要求力矩質量比和力矩轉動慣量比要大，能夠進行頻繁地起、制動，正、反轉切換；</p><p>　　3）．驅動盡可能靈活，位移偏差和速度偏差要小；</p><p><b>　　4）．安全可靠；</b></p><p>　　5）．操作和維護方便；</p><p>　　6）．對環(huán)境無污染，噪

28、聲要小；</p><p>　　7）．經(jīng)濟上合理，尤其要盡量減少占地面積。</p><p>　　基于上述驅動系統(tǒng)的特點和機器人驅動系統(tǒng)的設計要求，本文選用直流伺服電機驅動的方式對機器人進行驅動。表2.2為選定的各個關節(jié)電機型號及其相關參數(shù)。</p><p>　　表2.1機器人驅動電機參數(shù)</p><p><b>　　2.5傳動方式&l

29、t;/b></p><p>　　由于一般的電機驅動系統(tǒng)輸出的力矩較小，需要通過傳動機構來增加力矩，提高帶負載能力。對機器人的傳動機構的一般要求有：</p><p>　　（1）結構緊湊，即具有相同的傳動功率和傳動比時體積最小，重量最輕；</p><p>　　（2）傳動剛度大，即由驅動器的輸出軸到連桿關節(jié)的轉軸在相同的扭矩時角度變形要小，這樣可以提高整機的固有頻率

30、，并大大減輕整機的低頻振動；</p><p>　　（3）回差要小，即由正轉到反轉時空行程要小，這樣可以得到較高的位置控制精度；</p><p>　?。?）壽命長、價格低。</p><p>　　本文所選用的電機都采用了電機和齒輪輪系一體化的設計，結構緊湊，具有很強的帶負載能力，但是不能通過電機直接驅動各個連桿的運動。為減小機構運行過程的沖擊和振動，并且不降低控制精度，

31、采用了齒形帶傳動。</p><p>　　齒形帶傳動是同步帶的一種，用來傳遞平行軸間的運動或將回轉運動轉換成直線運動，在本文中主要用于腰關節(jié)、肩關節(jié)和肘關節(jié)的傳動。</p><p>　　齒形帶傳動原理如圖2.7所示。</p><p>　　齒輪帶的傳動比計算公式為</p><p><b>　　齒輪帶的平均速度為</b><

32、;/p><p><b>　　2.6制動器</b></p><p><b>　　制動器及其作用：</b></p><p>　　制動器是將機械運動部分的能量變?yōu)闊崮茚尫?，從而使運動的機械速度降低或者停止的裝置，它大致可分為機械制動器和電氣制動起兩類。</p><p>　　在機器人機構中，學要使用制動器的情況

33、如下：</p><p>　　特殊情況下的瞬間停止和需要采取安全措施</p><p>　　停電時，防止運動部分下滑而破壞其他裝置。</p><p><b>　　機械制動器：</b></p><p>　　機械制動器有螺旋式自動加載制動器、盤式制動器、閘瓦式制動器和電磁制動器等幾種。其中最典型的是電磁制動器。</p>

34、;<p>　　在機器人的驅動系統(tǒng)中常使用伺服電動機，伺服電機本身的特性決定了電磁制動器是不可缺少的部件。從原理上講，這種制動器就是用彈簧力制動的盤式制動器，只有勵磁電流通過線圈時制動器打開，這時制動器不起制動作用，而當電源斷開線圈中無勵磁電流時，在彈簧力的作用下處于制動狀態(tài)的常閉方式。因此</p><p>　　這種制動器被稱為無勵磁動作型電磁制動器。又因為這種制動器常用于安全制動場合，所以也稱為安全

35、制動器。</p><p><b>　　電氣制動器</b></p><p>　　電動機是將電能轉換為機械能的裝置，反之，他也具有將旋轉機械能轉換為電能的發(fā)電功能。換言之，伺服電機是一種能量轉換裝置，可將電能轉換為機械能，同時也能通過其反過程來達到制動的目的。但對于直流電機、同步電機和感應電機等各種不同類型的電機，必須分別采用適當?shù)闹苿与娐贰?lt;/p><

36、;p>　　本文中，該機器人實驗平臺未安裝機械制動器，因此機器人的肩關節(jié)和軸關節(jié)在停止轉動的時候，會因為重力因素而下落。另外，由于各方面限制，不方便在原有機構上添加機械制動器，所以只能通過軟件來實現(xiàn)肩關節(jié)和軸關節(jié)的電氣制動。</p><p>　　采用電氣制動器，其優(yōu)點在于：在不增加驅動系統(tǒng)質量的同時又具有制動功能，這是非常理想的情況，而在機器人上安裝機械制動器會使質量有所增加，故應盡量避免。缺點在于：這種方法

37、不如機械制動器工作可靠，斷電的時候將失去制動作用。</p><p>　　第3章 控制系統(tǒng)硬件</p><p>　　3.1 控制系統(tǒng)模式的選擇</p><p>　　構建機器人平臺的核心是建立機器人的控制系統(tǒng)。首先需要選擇和硬件平臺，控制系統(tǒng)硬件平臺對于系統(tǒng)的開放性、實現(xiàn)方式和開發(fā)工作量有很大的影響。一般常用的控制系統(tǒng)硬件平臺應滿足：硬件系統(tǒng)基于標準總線機構，具有可伸縮

38、性；硬件結構具有必要的實時計算能力；硬件系統(tǒng)模塊化，便于添加或更改各種接口、傳感器和特殊計算機等；低成本。到目前為止，一般機器人控制系統(tǒng)的硬件平臺可以大致分為兩類：基于VME總線（Versamodel Eurocard由Motorola公司1981年推出的第一代32位工業(yè)開放標準總線）的系統(tǒng)和基于PC總線的系統(tǒng)。近年來，隨著PC機性能的快速發(fā)展，可靠性大為提高，價格卻大幅度降低，以PC機為核心的控制系統(tǒng)已廣泛被機器人控制領域所接受。&l

39、t;/p><p>　　基于PC機控制系統(tǒng)一般包括單PC控制模式，PC+PC的控制模式，PC+分布式控制器的控制模式，PC+DSP運動控制卡的控制模式，PC+數(shù)據(jù)采集卡的控制模式，由于基于采集卡的控制方式靈活，成本低廉，有利于本文設計中的廢物利用，在程序和算法上可以自主編制各類算法，適合本課題研究的需要。因此本文選定PC+數(shù)據(jù)采集卡的控制方式。</p><p>　　3.2控制系統(tǒng)的搭建</

40、p><p>　　圖3.1 控制系統(tǒng)框圖</p><p><b>　　3.2.1工控機</b></p><p>　　在此選用研華工業(yè)控制機,主頻233MHz,內存128兆，32位數(shù)據(jù)總線。底板有9個ISA插槽，4個PCI插槽，帶VGA顯示器。其性能價格比優(yōu)越，兼容性好，有利于軟硬件維護和升級。與普通個人計算機相比工業(yè)控制PC機有以下優(yōu)點：</p

41、><p>　　·芯片篩選要比一般個人計算機嚴格；</p><p>　　·芯片驅動能力較強；</p><p>　　·整機內部結構屬于工業(yè)加強型，具有較強的防震和抗干擾性能；</p><p>　　·對環(huán)境（如溫度、濕度、灰塵等）的要求要比一般計算機低得多。</p><p>　　3.2.2

42、數(shù)據(jù)采集卡</p><p>　　在本設計中我們主要用到研華公司的PCL812PG和PCL726，其參數(shù)如下。</p><p><b>　　PCL-812PG</b></p><p><b>　　主要特點： </b></p><p>　　? 16路單端12位模擬量輸入 </p><

43、;p>　　? 2路12位模擬量輸出 </p><p>　　? 采樣速率可編程，最快達30KHz </p><p>　　? 帶DMA或中斷的A/D </p><p>　　? 16路數(shù)字量輸出</p><p><b>　　PCL-726</b></p><p><b>　　主要

44、特點： </b></p><p>　　? 6路獨立D/A輸出 </p><p>　　? 12位分辨率雙緩沖D/A轉換器 </p><p>　　? 16路數(shù)字量輸入及16路數(shù)字量輸出 </p><p>　　? 多種電壓范圍：+/-10V，+/-5V，0—+5V，0—+10V和4—20mA電流環(huán)。</p><

45、;p>　　3.2.3伺服放大器</p><p>　　在驅動系統(tǒng)設計過程中，主要是對伺服電機的驅動，本文中利用報廢機器人上的maxon電機驅動關節(jié)，因此同樣選用maxon伺服電機驅動器（maxon motor control4-Q-DC Servo Control LSC 30/2）進行驅動，如圖3.2所示，這是專門針對maxon電機設計的伺服電機放大控制器，具有很強的控制功能和穩(wěn)定性，電源電壓12~30v之

46、間，1、2接線端子接伺服電機，直接給電機供電，3，4接線端與電源相連，7、8接控制電壓，通過數(shù)據(jù)采集卡輸出的模擬電壓信號進入這兩個接線端來控制電機的轉速大小和正反轉，13、14接測速計（本文中未用），3、4、10之間是一個光耦合器，輸入“準備好”信號。在伺服控制器前面，有5個旋鈕調節(jié)器涌來調節(jié)電機的五個參數(shù)，下邊有10個DIP開關，用來選擇控制器工作狀態(tài)。</p><p>　　圖3.2伺服放大器接線及其調節(jié)示意&

47、lt;/p><p><b>　　3.2.4端子板</b></p><p>　　不同的被測信號通過不同的傳送路線到采集卡，而采集卡在工控機機箱內，不變直接連接到工業(yè)系統(tǒng)中的各種傳感器或執(zhí)行器。</p><p>　　端子板的主要作用有兩個：</p><p>　?、伲俗影迨遣杉ㄅc每一個信號調理電路或驅動裝置之間的電器連接部件，

48、給每一路輸入、輸出信號提供單獨的信號線和地線，使每一路通道可單獨接通或斷開，系統(tǒng)檢修和排除故障時不必全部停止運行。</p><p>　?、冢畬⒚恳宦沸盘柦?jīng)過各自的傳送路線到達端子板后，可以根據(jù)各路信號和傳送路線的特點，在端子板上對各路信號進行簡單的調理，如經(jīng)電阻衰減、分流或經(jīng)過RC低通濾波后進入采集卡。</p><p>　　圖3.3所示為端子板電路</p><p>

49、<b>　　圖3.3端子板電路</b></p><p>　　圖3.3所示的電路圖中，為防止直流電機產(chǎn)生的噪聲影響電路的正常運行，使用了光電耦合器4N25。在機電一體化技術中，光電耦合電路是重要的接口電路。</p><p>　　其中PCL-812PG通過五路數(shù)字量輸出來控制電機電路的通斷，PCL-726通過五路模擬量輸出來控制電機的正反轉和運行速度，另外PCL-812P

50、G還負責采集五個電位器的電壓，以此將電機的運行角度反饋給計算機。</p><p>　　3.2.5電位器及其標定</p><p>　　電位器是一種可調電阻，也是電子電路中用途最廣泛的元器件之一。它對外有三個引出端，其中兩個為固定端，另一個是中心抽頭。轉動或調節(jié)電位器轉動軸，其中心抽頭與固定端之間的電阻將發(fā)生變化。</p><p>　　本文采用的電位器是單圈的，也就是說

51、各關節(jié)的運動角度小于360º，對于該機器人已經(jīng)足夠了。電位器安裝在機器人的各個關節(jié)輸出軸上，所以在關節(jié)角的運動范圍內，電位計的輸出電壓和關節(jié)角是一一對應的，存在著一定的函數(shù)關系。</p><p>　　從理論上來講，電位器應該是線性的測量元件，但由于電位器的滑動噪聲以及滑線電阻的工作過程中的磨損，這種函數(shù)關系并非理想的線性關系，而是存在一定的偏移。電位器的標定就是根據(jù)在各個角度處測量的電壓值，擬合出一條直

52、線，</p><p>　　近似替代真實的函數(shù)關系。</p><p><b>　　3.2.6電源</b></p><p>　　電位器和伺服放大器都需要一定的電壓，特別是電位計是在10.0v的條件下工作的，穩(wěn)定的電壓對于保證電位計反饋信號的真實性具有重大的影響；而伺服放大器是在12v~30v范圍內工作的，電壓只要在此范圍內即可。</p>

53、<p>　　本文采用DH1715A-3型 雙路穩(wěn)壓穩(wěn)流電源，可以提供0~32v電壓輸出和0~2A電流輸出。</p><p>　　這里設定兩路電壓輸出：14.0v——供給伺服放大器運行，10.0v——保證電位計的正常工作。</p><p>　　第4章 控制系統(tǒng)軟件</p><p>　　以上完成了機器人的本體設計和控制系統(tǒng)硬件的搭建，下面將通過設計控制軟件

54、，使計算機通過數(shù)據(jù)采集卡有條不紊地向外部發(fā)送指揮信號，最終驅動機器人各個關節(jié)的運動，使之按照人的意愿“工作”。</p><p><b>　　4.1預期的功能</b></p><p>　?。?）. 實時顯示各個關節(jié)角，并且可以防止各個關節(jié)的運動角度超出預定的關 節(jié)角范圍內；</p><p>　?。?）. 實現(xiàn)直流電機的伺服控制；<

55、/p><p>　?。?）. 實現(xiàn)電機的自鎖；</p><p>　　（4）. 實現(xiàn)示教編程及在線修改程序；</p><p><b>　　4.2 實現(xiàn)方法</b></p><p>　　以模塊化程序設計思想為指導，以預期要實現(xiàn)的功能作為各個模塊，設計控制軟件。</p><p>　　從圖3.1可以看出，工控機

56、通過數(shù)據(jù)采集控制 。編程的任務其實就是用計算機控制數(shù)據(jù)采集卡使之發(fā)出或獲取一系列數(shù)字量、模擬量。</p><p>　　研華公司的數(shù)據(jù)采集卡驅動程序中，附帶許多與板卡相關的函數(shù)和數(shù)據(jù)結構以供使用，極大的方便了程序編寫。</p><p>　　本文采用了Visual C++作為編程工具。</p><p>　　4.2.1實時顯示各個關節(jié)角及運動范圍控制 </p&

57、gt;<p>　　在BOOL CRobotDlg::OnInitDialog()函數(shù)中，</p><p>　　設置定時器SetTimer(1, gwScanTime, NULL)，</p><p>　　然后在void CRobotDlg::OnTimer(UINT nIDEvent)函數(shù)中，</p><p>　　通過調用bool CRobotDlg::

58、position_now(USHORT ka1_chan)，采樣電位器輸出電壓，通過前面的電位器標定函數(shù)，換算出各個關節(jié)的角度，并顯示出來。</p><p>　　在void CRobotDlg::OnChangeAngle?Edit()函數(shù)中（?表示1，2，3，4，5），</p><p>　　將換算出的角度與該關節(jié)預設的運動范圍作比較，看其是否在此區(qū)間內，否則彈出警告對話框，并且自動停止該

59、關節(jié)的運動。</p><p>　　4.2.2直流電機的伺服控制</p><p>　　對于大功率的直流電機，一般采用PWM控制來調節(jié)運行速度，這樣可以提高電路及電機的運行效率，而本文中的電機功率并不是很大，為方便期間，采用了線性控制方法來調速。</p><p>　　以關節(jié)1為例，與該模塊相關的函數(shù)有OnZ1Button(), OnF1Button(), OnT1But

60、ton()，它們分別表示用來控制電機的正轉、反轉和停止，其中電機的運行速度靠輸入的電壓值調節(jié)；另外一個函數(shù)OnRun1Button()是用來實現(xiàn)電機的位置伺服控制，在預定的關節(jié)角范圍內，電機可以運行到任何一輸入的位置停止。</p><p>　　4.2.3電機的自鎖</p><p>　　前面在2.7節(jié)中講到該機器人關節(jié)上未裝制動器，所以必須通過軟件程序實現(xiàn)關節(jié)的自鎖，尤其是肩關節(jié)和肘關節(jié)的自

61、鎖。</p><p>　　解決思路：大臂和小臂在電機運轉時不會由于重力而掉落，在電機停止的時候卻會下落，因為電機一旦停止，就失去了驅動力矩，因此若想讓大臂和小臂停止在預定位置，應該在此位置給關節(jié)電機施加一個電壓，讓它擔負起大臂或小臂，而不讓其由于重力而下落。但是，在不同的位置，重力對大臂或小臂的力矩不同，應提供給電機的電壓也不同，如何選取電機的電壓呢？</p><p>　　提供給電機的電壓

62、小了，不足以抵抗重力的力矩；提供給電機的電壓大了，會使電機轉動，使大臂或小臂上升；所以，最好能通過程序來自適應選擇這個制動電壓，方法有多種，下面是本文的設計過程。</p><p>　　在調用在OnT2Button()或OnT3Button()函數(shù)時，先給電機一個0電壓，使電機失去驅動力矩，同時調用position_now(USHORT ka1_chan)函數(shù)獲得此刻的關節(jié)位置，然后延時一段時間比如0.1s，再給電

63、機一個小電壓，形成一個小的制動力矩，通過采樣此刻位置看其是否能使關節(jié)制動；如果不能，則使該電壓值按照一定的步長線性增加，以增大制動力矩；這通過一個while()循環(huán)實現(xiàn)，如果采樣位置不再減小，則表示大臂或小臂已停止下落，可跳出循環(huán)。</p><p><b>　　下圖為程序流程圖：</b></p><p>　　4.2.4示教編程及在線修改程序</p>&l

64、t;p>　　設計方法：當機器人停止在某個位置時，可以記錄下在該位置所對應的一組關節(jié)角，這一組關節(jié)角用一個結構體存儲</p><p>　　struct position</p><p>　　float Voltage1;</p><p>　　float Voltage2;</p><p>　　float Voltage3;</p&g

65、t;<p>　　float Voltage4;</p><p>　　float Voltage5;</p><p>　　struct position *next;</p><p>　　記錄的位置同時顯示在列表框中，記錄位置不超過1000個。</p><p>　　為了便于對這些位置作修改，本文采用鏈表來動態(tài)存儲這些結構體。<

66、;/p><p>　　當記錄結束以后，就可以運行剛才記錄的一系列位置了，由于采用鏈表結構存儲程序，所以取用這些程序很方便，只需用一個指針從鏈表首部開始取程序，逐行運行，至到鏈表末尾即可。</p><p>　　程序運行的時候，機器人各個關節(jié)同時運動，工作效率高；正在運行的那行程序，以高亮狀態(tài)顯示。</p><p>　　另外，對于記錄的位置可以做刪除、清空等操作。</p

67、><p><b>　　第5章 總結</b></p><p>　　5.1 所完成的工作</p><p>　　對實驗平臺的改造 </p><p>　　本文利用的是報廢的焊接機器人，要改造成送料機器人，不但要對末端執(zhí)行機構進行重新設計，還要重新布線。</p><p>　　對關節(jié)軸電位器進行重新標定

68、 </p><p>　　由于標定電壓不同，標定曲線和所得的函數(shù)關系就不同，本文選用的是10v電壓。</p><p>　　設計端子板電路及驅動電路 </p><p>　　端子板是計算機、板卡控制信號端與機器人電路端的“橋梁”，承擔著信號調理、驅動放大等任務。</p><p>　　控制軟件的設計 </p><p>

69、　　軟件是機器人的“大腦思維”，軟件的設計就是將人的意志賦予機器人的“大腦”。</p><p><b>　　5.2 設計經(jīng)驗</b></p><p>　?。?） 底座設計成長方體不合理</p><p>　　當腰關節(jié)在不同的位置時，肩關節(jié)運動的下限不同，不便于編程；最好將底座設計成圓柱體，并且下面帶有法蘭支撐。</p><p&

70、gt;　?。?） 最好安裝機械制動裝置</p><p>　　僅依靠程序來實現(xiàn)制動并不可靠，例如突然掉電，將無法制動。</p><p>　?。?） 電機上應安裝放電回路</p><p>　　電機相當于一個線圈，在電機啟動或者停止瞬間，會產(chǎn)生很高的感應電動勢，很可能會對電路中的元器件造成破壞，所以要加上穩(wěn)壓或者續(xù)流元件。</p><p>　?。?

71、） 電位器輸出電壓會在一定范圍內會有無規(guī)則的波動</p><p>　　由于電位器材料電阻率分布的不均勻以及電刷滑動時接觸電阻的無規(guī)律變化，會引起所謂的“滑動噪聲”。這導致電位器反饋電壓并不準確。</p><p>　?。?） 關節(jié)角的方向及電位器的安裝</p><p>　　關節(jié)角最好符合關節(jié)角坐標系，并且電位器輸出電壓最好隨關節(jié)角的增大而增大，這樣便于編程。</

72、p><p>　　通過虛擬場景和網(wǎng)絡，也可以進一步實現(xiàn)對機器人的遠程監(jiān)測和控制。</p><p>　　還可以嘗試在原有實驗平臺上加上視覺反饋。</p><p>　　控制界面如果用LabView設計，可能會更方便些。</p><p>　　通過進一步完善控制方式和控制結構，可以將控制系統(tǒng)的軟件嵌入到嵌入式系統(tǒng)上去。</p><p&g

73、t;<b>　　參考文獻</b></p><p>　　[1] Craig, John J. Introduction to robotics. 北京 機械工業(yè)出版社，2006 </p><p>　　[2] Basilio Bona and Aldo Curatella. Identification of Industrial Robot Parameter

74、s for Advanced Model-Based Controllers Design Proceedings of the 2005 IEEE</p><p>　　International Conference on Robotics and Automation. Barcelona, Spain, April 2005</p><p>　　[3] 索羅門采夫. 工業(yè)機器

75、人圖冊. 北京 機械工業(yè)出版社，1993 </p><p>　　[4] 周伯英. 工業(yè)機器人設計. 北京 機械工業(yè)出版社，1995</p><p>　　[5] 郭洪紅 賀繼林 田宏宇 席巍. 工業(yè)機器人技術. 西安電子科技大學出版社，2006</p><p>　　[6] 三浦宏文. 機電一體化實用手冊. 科學出版社 OHM社，2001</

76、p><p>　　[7] 陳國聯(lián) 王建華 夏建生. 電子技術. 西安交通大學出版社，2002</p><p>　　[8] 沈裕康 嚴武升 楊庚辰. 電機與電器. 北京理工大學出版社，2002</p><p>　　[9] 羅建軍 朱丹軍 顧剛 劉路放. 大學C++程序設計教程. 北京：高等教育出版社，2004</p><p>