三自由度機械手臂設(shè)計說明書

三自由度機械手臂設(shè)計說明書三自由度機械手臂設(shè)計說明書三自由度機械手臂設(shè)計說明書三自由度機械手臂設(shè)計說明書編制僅供參考審核批準(zhǔn)生效日期地址：電話：傳真:郵編:SHANDONGＵＮＩＶＥＲＳＩＴＹＯＦＴＥＣＨＮＯＬＯＧＹ課程設(shè)計說明書三自由度機械手臂設(shè)計學(xué)院：農(nóng)業(yè)工程與食品科學(xué)學(xué)院專業(yè)：農(nóng)業(yè)機械化及其自動化學(xué)生姓名：趙國06學(xué)生姓名：李繼飛00學(xué)生姓名：程小巖09指導(dǎo)教師：程衛(wèi)東2013年1月摘要在當(dāng)今大規(guī)模制造業(yè)中，企業(yè)為提高生產(chǎn)效率，保障產(chǎn)品質(zhì)量，普遍重視生產(chǎn)過程的自動化程度，工業(yè)機器人作為自動化生產(chǎn)線上的重要成員，逐漸被企業(yè)所認同并采用。工業(yè)機器人的技術(shù)水平和應(yīng)用程度在一定程度上反映了一個國家工業(yè)自動化的水平，目前，工業(yè)機器人主要承擔(dān)著焊接、噴涂、搬運以及堆垛等重復(fù)性并且勞動強度極大的工作，工作方式一般采取示教再現(xiàn)的方式。本文將設(shè)計一臺四自由度的工業(yè)機器人，用于給沖壓設(shè)備運送物料。首先，本文將設(shè)計機器人的底座、大臂、小臂和機械手的結(jié)構(gòu)，然后選擇合適的傳動方式、驅(qū)動方式，搭建機器人的結(jié)構(gòu)平臺；在此基礎(chǔ)上，本文將設(shè)計該機器人的控制系統(tǒng)，包括數(shù)據(jù)采集卡和伺服放大器的選擇、反饋方式和反饋元件的選擇、端子板電路的設(shè)計以及控制軟件的設(shè)計，重點加強控制軟件的可靠性和機器人運行過程的安全性，最終實現(xiàn)的目標(biāo)包括：關(guān)節(jié)的伺服控制和制動問題、實時監(jiān)測機器人的各個關(guān)節(jié)的運動情況、機器人的示教編程和在線修改程序、設(shè)置參考點和回參考點。目錄第1章緒論…………5機器人概述………………5第2章機器人實驗平臺介紹及機械手的設(shè)計……6自由度及關(guān)節(jié)……………6基座及連桿………………6基座………………6機械臂……………6機械手的設(shè)計……………6驅(qū)動方式…………………8傳動方式…………………9制動器……………………10第3章控制系統(tǒng)硬件………………11控制系統(tǒng)模式的選擇……………………11控制系統(tǒng)的搭建………11工控機……………12數(shù)據(jù)采集卡………12伺服放大器………13端子板……………14電位器及其標(biāo)定…………………15電源………………16第4章控制系統(tǒng)軟件………………16預(yù)期的功能………………16實現(xiàn)方法…………………16實時顯示各個關(guān)節(jié)角及運動范圍控制…………16直流電機的伺服控制……………16電機的自鎖………16示教編程及在線修改程序……17第5章總結(jié)………………………18所完成的工作…………18設(shè)計經(jīng)驗………………18參考文獻…………20第1章緒論機器人概述在現(xiàn)代工業(yè)中，生產(chǎn)過程的機械化、自動化已成為突出的主題。化工等連續(xù)性生產(chǎn)過程的自動化已基本得到解決。但在機械工業(yè)中，加工、裝配等生產(chǎn)是不連續(xù)的。專用機床是大批量生產(chǎn)自動化的有效辦法；程控機床、數(shù)控機床、加工中心等自動化機械是有效地解決多品種小批量生產(chǎn)自動化的重要辦法。但除切削加工本身外，還有大量的裝卸、搬運、裝配等作業(yè)，有待于進一步實現(xiàn)機械化。機器人的出現(xiàn)并得到應(yīng)用，為這些作業(yè)的機械化奠定了良好的基礎(chǔ)。“工業(yè)機器人”（IndustrialRobot）：多數(shù)是指程序可變（編）的獨立的自動抓取、搬運工件、操作工具的裝置（國內(nèi)稱作工業(yè)機器人或通用機器人）。機器人是一種具有人體上肢的部分功能，工作程序固定的自動化裝置。機器人具有結(jié)構(gòu)簡單、成本低廉、維修容易的優(yōu)勢，但功能較少，適應(yīng)性較差。目前我國常把具有上述特點的機器人稱為專用機器人，而把工業(yè)機械人稱為通用機器人。簡而言之，機器人就是用機器代替人手，把工件由某個地方移向指定的工作位置，或按照工作要求以操縱工件進行加工。機器人一般分為三類。第一類是不需要人工操作的通用機器人，也即本文所研究的對象。它是一種獨立的、不附屬于某一主機的裝置，可以根據(jù)任務(wù)的需要編制程序，以完成各項規(guī)定操作。它是除具備普通機械的物理性能之外，還具備通用機械、記憶智能的三元機械。第二類是需要人工操作的，稱為操作機（Manipulator）。它起源于原子、軍事工業(yè)，先是通過操作機來完成特定的作業(yè)，后來發(fā)展到用無線電訊號操作機器人來進行探測月球等。工業(yè)中采用的鍛造操作機也屬于這一范疇。第三類是專業(yè)機器人，主要附屬于自動機床或自動生產(chǎn)線上，用以解決機床上下料和工件傳送。這種機器人在國外通常被稱之為“MechanicalHand”，它是為主機服務(wù)的，由主機驅(qū)動。除少數(shù)外，工作程序一般是固定的，因此是專用的。機器人按照結(jié)構(gòu)形式的不同又可分為多種類型，其中關(guān)節(jié)型機器人以其結(jié)構(gòu)緊湊，所占空間體積小，相對工作空間最大，甚至能繞過基座周圍的一些障礙物等這樣一些特點，成為機器人中使用最多的一種結(jié)構(gòu)形式，世界一些著名機器人的本體部分都采用這種機構(gòu)形式的機器人。第2章實驗平臺介紹及機械手的設(shè)計該設(shè)計的目的是為了設(shè)計一臺物料搬運機器人，利用現(xiàn)有已經(jīng)報廢的焊接機器人，本文的中結(jié)構(gòu)設(shè)計主要偏向于對原有機構(gòu)的改造和機械手的設(shè)計。自由度及關(guān)節(jié)該機器人具有三個自由度，即腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)，都為轉(zhuǎn)動關(guān)節(jié)；還有一個用于夾持物料的機械手?；斑B桿基座基座是整個機器人本體的支撐。為保證機器人運行的穩(wěn)定性，采用兩塊“Z”字形實心鑄鐵作支撐?；厦媸墙泳€盒子，所有電機的驅(qū)動信號和反饋信號都從中出入。接線盒子外面，有一個引入線出口和一個引出線出口。機械臂大臂長度230mm小臂長度240mm機械手的設(shè)計工業(yè)機器人的手又稱為末端執(zhí)行器，它使機器人直接用于抓取和握緊（吸附）專用工具（如噴槍、扳手、焊具、噴頭等）進行操作的部件。它具有模仿人手動作的功能，并安裝于機器人手臂的前端。由于被握工件的形狀、尺寸、重量、材質(zhì)及表面狀態(tài)等不同，因此工業(yè)機器人末端操作器是多種多樣的，大致可分為以下幾類：夾鉗式取料手吸附式取料手專用操作器及轉(zhuǎn)換器仿生多指靈巧手本文設(shè)計對象為物料搬運機器人，并不需要復(fù)雜的多指人工指，只需要設(shè)計能從不同角度抓取工件的鉗形指。手指是直接與工件接觸的部件。手指松開和夾緊工件，是通過手指的張開與閉合來實現(xiàn)的。該設(shè)計采用兩個手指，其外形如圖所示圖機械手手指形狀傳動機構(gòu)是向手指傳遞運動和動力，以實現(xiàn)夾緊和松開動作的機構(gòu)。根據(jù)手指開合的動作特點分為回轉(zhuǎn)型和平移形。本文采用回轉(zhuǎn)型傳動機構(gòu)。圖為初步設(shè)計的機械手機構(gòu)簡圖（只畫出了一半，另外一半關(guān)于中心線對稱）。圖機械手機構(gòu)簡圖在圖中，O為電機輸出軸，曲柄OA、連桿AB、滑塊B和支架構(gòu)成曲柄滑塊機構(gòu)；滑塊B、連桿BC、搖桿CE和支架構(gòu)成滑塊搖桿機構(gòu)。通過兩個機構(gòu)串聯(lián)，使電機最終驅(qū)動DE的來回擺動，從而實現(xiàn)手指的開合運動。圖中的黑線和藍線表示機構(gòu)運行的兩個極限位置。為便于手指的順利合攏，可以在兩個手指之間設(shè)置一個彈簧，這樣還可以提供適當(dāng)?shù)膴A緊力。另外，在選用電機的時候，要使電機的功率足以克服彈簧的收縮和張開，并且提供足夠加緊物體的力。驅(qū)動方式該機器人一共具有四個獨立的轉(zhuǎn)動關(guān)節(jié)，連同末端機械手的運動，一共需要五個動力源。機器人常用的驅(qū)動方式有液壓驅(qū)動、氣壓驅(qū)動和電機驅(qū)動三種類型。機器人驅(qū)動系統(tǒng)各有其優(yōu)缺點，通常對機器人的驅(qū)動系統(tǒng)的要求有：1）．驅(qū)動系統(tǒng)的質(zhì)量盡可能要輕，單位質(zhì)量的輸出功率要高，效率也要高；2）．反應(yīng)速度要快，即要求力矩質(zhì)量比和力矩轉(zhuǎn)動慣量比要大，能夠進行頻繁地起、制動，正、反轉(zhuǎn)切換；3）．驅(qū)動盡可能靈活，位移偏差和速度偏差要??；4）．安全可靠；5）．操作和維護方便；6）．對環(huán)境無污染，噪聲要??；7）．經(jīng)濟上合理，尤其要盡量減少占地面積?；谏鲜鲵?qū)動系統(tǒng)的特點和機器人驅(qū)動系統(tǒng)的設(shè)計要求，本文選用直流伺服電機驅(qū)動的方式對機器人進行驅(qū)動。表為選定的各個關(guān)節(jié)電機型號及其相關(guān)參數(shù)。表機器人驅(qū)動電機參數(shù)電機參數(shù)腰關(guān)節(jié)肩關(guān)節(jié)肘關(guān)節(jié)腕關(guān)節(jié)手爪型號MAXON2332MAXON2332MAXON2332MULTIPLEXSTELL-SERVOMULTIPLEXSTELL-SERVO額定電壓18v18v18v6v6v額定轉(zhuǎn)矩N·mN·mN·mN·mN·m最大轉(zhuǎn)矩·m·m·m額定轉(zhuǎn)速7980rpm7980rpm7980rpm5460rpm5460rpm最高轉(zhuǎn)速轉(zhuǎn)子慣量9200rpm·cm9200rpm·cm9200rpm·cm傳動方式由于一般的電機驅(qū)動系統(tǒng)輸出的力矩較小，需要通過傳動機構(gòu)來增加力矩，提高帶負載能力。對機器人的傳動機構(gòu)的一般要求有：（1）結(jié)構(gòu)緊湊，即具有相同的傳動功率和傳動比時體積最小，重量最輕；（2）傳動剛度大，即由驅(qū)動器的輸出軸到連桿關(guān)節(jié)的轉(zhuǎn)軸在相同的扭矩時角度變形要小，這樣可以提高整機的固有頻率，并大大減輕整機的低頻振動；（3）回差要小，即由正轉(zhuǎn)到反轉(zhuǎn)時空行程要小，這樣可以得到較高的位置控制精度；（4）壽命長、價格低。本文所選用的電機都采用了電機和齒輪輪系一體化的設(shè)計，結(jié)構(gòu)緊湊，具有很強的帶負載能力，但是不能通過電機直接驅(qū)動各個連桿的運動。為減小機構(gòu)運行過程的沖擊和振動，并且不降低控制精度，采用了齒形帶傳動。齒形帶傳動是同步帶的一種，用來傳遞平行軸間的運動或?qū)⒒剞D(zhuǎn)運動轉(zhuǎn)換成直線運動，在本文中主要用于腰關(guān)節(jié)、肩關(guān)節(jié)和肘關(guān)節(jié)的傳動。齒形帶傳動原理如圖所示。齒輪帶的傳動比計算公式為齒輪帶的平均速度為制動器制動器及其作用：制動器是將機械運動部分的能量變?yōu)闊崮茚尫?，從而使運動的機械速度降低或者停止的裝置，它大致可分為機械制動器和電氣制動起兩類。在機器人機構(gòu)中，學(xué)要使用制動器的情況如下：特殊情況下的瞬間停止和需要采取安全措施停電時，防止運動部分下滑而破壞其他裝置。機械制動器：機械制動器有螺旋式自動加載制動器、盤式制動器、閘瓦式制動器和電磁制動器等幾種。其中最典型的是電磁制動器。在機器人的驅(qū)動系統(tǒng)中常使用伺服電動機，伺服電機本身的特性決定了電磁制動器是不可缺少的部件。從原理上講，這種制動器就是用彈簧力制動的盤式制動器，只有勵磁電流通過線圈時制動器打開，這時制動器不起制動作用，而當(dāng)電源斷開線圈中無勵磁電流時，在彈簧力的作用下處于制動狀態(tài)的常閉方式。因此這種制動器被稱為無勵磁動作型電磁制動器。又因為這種制動器常用于安全制動場合，所以也稱為安全制動器。電氣制動器電動機是將電能轉(zhuǎn)換為機械能的裝置，反之，他也具有將旋轉(zhuǎn)機械能轉(zhuǎn)換為電能的發(fā)電功能。換言之，伺服電機是一種能量轉(zhuǎn)換裝置，可將電能轉(zhuǎn)換為機械能，同時也能通過其反過程來達到制動的目的。但對于直流電機、同步電機和感應(yīng)電機等各種不同類型的電機，必須分別采用適當(dāng)?shù)闹苿与娐贰１疚闹?，該機器人實驗平臺未安裝機械制動器，因此機器人的肩關(guān)節(jié)和軸關(guān)節(jié)在停止轉(zhuǎn)動的時候，會因為重力因素而下落。另外，由于各方面限制，不方便在原有機構(gòu)上添加機械制動器，所以只能通過軟件來實現(xiàn)肩關(guān)節(jié)和軸關(guān)節(jié)的電氣制動。采用電氣制動器，其優(yōu)點在于：在不增加驅(qū)動系統(tǒng)質(zhì)量的同時又具有制動功能，這是非常理想的情況，而在機器人上安裝機械制動器會使質(zhì)量有所增加，故應(yīng)盡量避免。缺點在于：這種方法不如機械制動器工作可靠，斷電的時候?qū)⑹ブ苿幼饔谩５?章控制系統(tǒng)硬件控制系統(tǒng)模式的選擇構(gòu)建機器人平臺的核心是建立機器人的控制系統(tǒng)。首先需要選擇和硬件平臺，控制系統(tǒng)硬件平臺對于系統(tǒng)的開放性、實現(xiàn)方式和開發(fā)工作量有很大的影響。一般常用的控制系統(tǒng)硬件平臺應(yīng)滿足：硬件系統(tǒng)基于標(biāo)準(zhǔn)總線機構(gòu)，具有可伸縮性；硬件結(jié)構(gòu)具有必要的實時計算能力；硬件系統(tǒng)模塊化，便于添加或更改各種接口、傳感器和特殊計算機等；低成本。到目前為止，一般機器人控制系統(tǒng)的硬件平臺可以大致分為兩類：基于VME總線（VersamodelEurocard由Motorola公司1981年推出的第一代32位工業(yè)開放標(biāo)準(zhǔn)總線）的系統(tǒng)和基于PC總線的系統(tǒng)。近年來，隨著PC機性能的快速發(fā)展，可靠性大為提高，價格卻大幅度降低，以PC機為核心的控制系統(tǒng)已廣泛被機器人控制領(lǐng)域所接受?；赑C機控制系統(tǒng)一般包括單PC控制模式，PC+PC的控制模式，PC+分布式控制器的控制模式，PC+DSP運動控制卡的控制模式，PC+數(shù)據(jù)采集卡的控制模式，由于基于采集卡的控制方式靈活，成本低廉，有利于本文設(shè)計中的廢物利用，在程序和算法上可以自主編制各類算法，適合本課題研究的需要。因此本文選定PC+數(shù)據(jù)采集卡的控制方式。控制系統(tǒng)的搭建圖控制系統(tǒng)框圖工控機在此選用研華工業(yè)控制機,主頻233MHz,內(nèi)存128兆，32位數(shù)據(jù)總線。底板有9個ISA插槽，4個PCI插槽，帶VGA顯示器。其性能價格比優(yōu)越，兼容性好，有利于軟硬件維護和升級。與普通個人計算機相比工業(yè)控制PC機有以下優(yōu)點：·芯片篩選要比一般個人計算機嚴(yán)格；·芯片驅(qū)動能力較強；·整機內(nèi)部結(jié)構(gòu)屬于工業(yè)加強型，具有較強的防震和抗干擾性能；·對環(huán)境（如溫度、濕度、灰塵等）的要求要比一般計算機低得多。數(shù)據(jù)采集卡在本設(shè)計中我們主要用到研華公司的PCL812PG和PCL726，其參數(shù)如下。PCL-812PG主要特點：16路單端12位模擬量輸入2路12位模擬量輸出采樣速率可編程，最快達30KHz帶DMA或中斷的A/D16路數(shù)字量輸出PCL-726主要特點：6路獨立D/A輸出12位分辨率雙緩沖D/A轉(zhuǎn)換器16路數(shù)字量輸入及16路數(shù)字量輸出多種電壓范圍：+/-10V，+/-5V，0—+5V，0—+10V和4—20mA電流環(huán)。伺服放大器在驅(qū)動系統(tǒng)設(shè)計過程中，主要是對伺服電機的驅(qū)動，本文中利用報廢機器人上的maxon電機驅(qū)動關(guān)節(jié)，因此同樣選用maxon伺服電機驅(qū)動器（maxonmotorcontrol4-Q-DCServoControlLSC30/2）進行驅(qū)動，如圖所示，這是專門針對maxon電機設(shè)計的伺服電機放大控制器，具有很強的控制功能和穩(wěn)定性，電源電壓12~30v之間，1、2接線端子接伺服電機，直接給電機供電，3，4接線端與電源相連，7、8接控制電壓，通過數(shù)據(jù)采集卡輸出的模擬電壓信號進入這兩個接線端來控制電機的轉(zhuǎn)速大小和正反轉(zhuǎn)，13、14接測速計（本文中未用），3、4、10之間是一個光耦合器，輸入“準(zhǔn)備好”信號。在伺服控制器前面，有5個旋鈕調(diào)節(jié)器涌來調(diào)節(jié)電機的五個參數(shù)，下邊有10個DIP開關(guān)，用來選擇控制器工作狀態(tài)。圖伺服放大器接線及其調(diào)節(jié)示意端子板不同的被測信號通過不同的傳送路線到采集卡，而采集卡在工控機機箱內(nèi)，不變直接連接到工業(yè)系統(tǒng)中的各種傳感器或執(zhí)行器。端子板的主要作用有兩個：①．端子板是采集卡與每一個信號調(diào)理電路或驅(qū)動裝置之間的電器連接部件，給每一路輸入、輸出信號提供單獨的信號線和地線，使每一路通道可單獨接通或斷開，系統(tǒng)檢修和排除故障時不必全部停止運行。②．將每一路信號經(jīng)過各自的傳送路線到達端子板后，可以根據(jù)各路信號和傳送路線的特點，在端子板上對各路信號進行簡單的調(diào)理，如經(jīng)電阻衰減、分流或經(jīng)過RC低通濾波后進入采集卡。圖所示為端子板電路圖端子板電路圖所示的電路圖中，為防止直流電機產(chǎn)生的噪聲影響電路的正常運行，使用了光電耦合器4N25。在機電一體化技術(shù)中，光電耦合電路是重要的接口電路。其中PCL-812PG通過五路數(shù)字量輸出來控制電機電路的通斷，PCL-726通過五路模擬量輸出來控制電機的正反轉(zhuǎn)和運行速度，另外PCL-812PG還負責(zé)采集五個電位器的電壓，以此將電機的運行角度反饋給計算機。電位器及其標(biāo)定電位器是一種可調(diào)電阻，也是電子電路中用途最廣泛的元器件之一。它對外有三個引出端，其中兩個為固定端，另一個是中心抽頭。轉(zhuǎn)動或調(diào)節(jié)電位器轉(zhuǎn)動軸，其中心抽頭與固定端之間的電阻將發(fā)生變化。本文采用的電位器是單圈的，也就是說各關(guān)節(jié)的運動角度小于360o，對于該機器人已經(jīng)足夠了。電位器安裝在機器人的各個關(guān)節(jié)輸出軸上，所以在關(guān)節(jié)角的運動范圍內(nèi)，電位計的輸出電壓和關(guān)節(jié)角是一一對應(yīng)的，存在著一定的函數(shù)關(guān)系。從理論上來講，電位器應(yīng)該是線性的測量元件，但由于電位器的滑動噪聲以及滑線電阻的工作過程中的磨損，這種函數(shù)關(guān)系并非理想的線性關(guān)系，而是存在一定的偏移。電位器的標(biāo)定就是根據(jù)在各個角度處測量的電壓值，擬合出一條直線，近似替代真實的函數(shù)關(guān)系。電源電位器和伺服放大器都需要一定的電壓，特別是電位計是在的條件下工作的，穩(wěn)定的電壓對于保證電位計反饋信號的真實性具有重大的影響；而伺服放大器是在12v~30v范圍內(nèi)工作的，電壓只要在此范圍內(nèi)即可。本文采用DH1715A-3型雙路穩(wěn)壓穩(wěn)流電源，可以提供0~32v電壓輸出和0~2A電流輸出。這里設(shè)定兩路電壓輸出：——供給伺服放大器運行，——保證電位計的正常工作。第4章控制系統(tǒng)軟件以上完成了機器人的本體設(shè)計和控制系統(tǒng)硬件的搭建，下面將通過設(shè)計控制軟件，使計算機通過數(shù)據(jù)采集卡有條不紊地向外部發(fā)送指揮信號，最終驅(qū)動機器人各個關(guān)節(jié)的運動，使之按照人的意愿“工作”。預(yù)期的功能（1）.實時顯示各個關(guān)節(jié)角，并且可以防止各個關(guān)節(jié)的運動角度超出預(yù)定的關(guān)節(jié)角范圍內(nèi)；（2）.實現(xiàn)直流電機的伺服控制；（3）.實現(xiàn)電機的自鎖；（4）.實現(xiàn)示教編程及在線修改程序；實現(xiàn)方法以模塊化程序設(shè)計思想為指導(dǎo)，以預(yù)期要實現(xiàn)的功能作為各個模塊，設(shè)計控制軟件。從圖可以看出，工控機通過數(shù)據(jù)采集控制。編程的任務(wù)其實就是用計算機控制數(shù)據(jù)采集卡使之發(fā)出或獲取一系列數(shù)字量、模擬量。研華公司的數(shù)據(jù)采集卡驅(qū)動程序中，附帶許多與板卡相關(guān)的函數(shù)和數(shù)據(jù)結(jié)構(gòu)以供使用，極大的方便了程序編寫。本文采用了VisualC++作為編程工具。實時顯示各個關(guān)節(jié)角及運動范圍控制在BOOLCRobotDlg::OnInitDialog()函數(shù)中，設(shè)置定時器SetTimer(1,gwScanTime,NULL)，然后在voidCRobotDlg::OnTimer(UINTnIDEvent)函數(shù)中，通過調(diào)用boolCRobotDlg::position_now(USHORTka1_chan)，采樣電位器輸出電壓，通過前面的電位器標(biāo)定函數(shù)，換算出各個關(guān)節(jié)的角度，并顯示出來。在voidCRobotDlg::OnChangeAngleEdit()函數(shù)中（表示1，2，3，4，5），將換算出的角度與該關(guān)節(jié)預(yù)設(shè)的運動范圍作比較，看其是否在此區(qū)間內(nèi)，否則彈出警告對話框，并且自動停止該關(guān)節(jié)的運動。直流電機的伺服控制對于大功率的直流電機，一般采用PWM控制來調(diào)節(jié)運行速度，這樣可以提高電路及電機的運行效率，而本文中的電機功率并不是很大，為方便期間，采用了線性控制方法來調(diào)速。以關(guān)節(jié)1為例，與該模塊相關(guān)的函數(shù)有OnZ1Button(),OnF1Button(),OnT1Button()，它們分別表示用來控制電機的正轉(zhuǎn)、反轉(zhuǎn)和停止，其中電機的運行速度靠輸入的電壓值調(diào)節(jié)；另外一個函數(shù)OnRun1Button()是用來實現(xiàn)電機的位置伺服控制，在預(yù)定的關(guān)節(jié)角范圍內(nèi)，電機可以運行到任何一輸入的位置停止。電機的自鎖前面在節(jié)中講到該機器人關(guān)節(jié)上未裝制動器，所以必須通過軟件程序?qū)崿F(xiàn)關(guān)節(jié)的自鎖，尤其是肩關(guān)節(jié)和肘關(guān)節(jié)的自鎖。解決思路：大臂和小臂在電機運轉(zhuǎn)時不會由于重力而掉落，在電機停止的時候卻會下落，因為電機一旦停止，就失去了驅(qū)動力矩，因此若想讓大臂和小臂停止在預(yù)定位置，應(yīng)該在此位置給關(guān)節(jié)電機施加一個電壓，讓它擔(dān)負起大臂或小臂，而不讓其由于重力而下落。但是，在不同的位置，重力對大臂或小臂的力矩不同，應(yīng)提供給電機的電壓也不同，如何選取電機的電壓呢提供給電機的電壓小了，不足以抵抗重力的力矩；提供給電機的電壓大了，會使電機轉(zhuǎn)動，使大臂或小臂上升；所以，最好能通過程序來自適應(yīng)選擇這個制動電壓，方法有多種，下面是本文的設(shè)計過程。在調(diào)用在OnT2Button()或OnT3Button()函數(shù)時，先給電機一個0電壓，使電機失去驅(qū)動力矩，同時調(diào)用position_now(USHORTka1_chan)函數(shù)獲得此刻的關(guān)節(jié)位置，然后延時一段時間比如，再給電機一個小電壓，形成一個小的制動力矩，通過采樣此刻位置看其是否能使關(guān)節(jié)制動；如果不能，則使該電壓值按照一定的步長線性增加，以增大制動力矩；這通過一個while()循環(huán)實現(xiàn)，如果采樣位置不再減小，則表示大臂或小臂已停止下落，可跳出循環(huán)。下圖為程序流程圖：調(diào)用調(diào)用OnT2Button()或OnT3Button()函數(shù)使電機電壓為0，并采樣此時位置，將電位器輸出值存放在fVoltage_former中使電機電壓為0，并采樣此時位置，將電位器輸出值存放在fVoltage_former中考慮到大臂或小臂上升時的慣性，循環(huán)采樣考慮到大臂或小臂上升時的慣性，循環(huán)采樣一直到采樣值fVoltage<=fVoltage_former跳出循環(huán)，表示大臂或小臂已經(jīng)開始下落了循環(huán)采樣一直到采樣值fVoltage>=fVoltage_former循環(huán)采樣一直到采樣值fVoltage>=fVoltage_former跳出循環(huán)，表示大臂或小臂已經(jīng)制動在自所位置了示教編程及在線修改程序設(shè)計方法：當(dāng)機器人停止在某個位置時，可以記錄下在該位置所對應(yīng)的一組關(guān)節(jié)角，這一組關(guān)節(jié)角用一個結(jié)構(gòu)體存儲 structposition floatVoltage1; floatVoltage2; floatVoltage3; floatVoltage4; floatVoltage5; structposition*next;記錄的位置同時顯示在列表框中，記錄位置不超過1000個。為了便于對這些位置作修改，本文采用鏈表來動態(tài)存儲這些結(jié)構(gòu)體。當(dāng)記錄結(jié)束以后，就可以運行剛才記錄的一系列位置了，由于采用鏈表結(jié)構(gòu)存儲程序，所以取用這些程序很方便，只需用一個指針從鏈表首部開始取程序，逐行運行，至到鏈表末尾即可。程序運行的時候，機器人各個關(guān)節(jié)同時運動，工作效率高；正在運行的那行程序，以高亮狀態(tài)顯示。另外，對于記錄的位置可以做刪除、清空等操作。第5章總結(jié)所完成的工作對實驗平臺的改造本文利用的是報廢的焊接機器人，要改造成送料機器人，不但要對末端執(zhí)行機構(gòu)進行重新設(shè)計，還要重新布線。對關(guān)節(jié)軸電位器進行重新標(biāo)定由于標(biāo)定電壓不同，標(biāo)定曲線和所得的函數(shù)關(guān)系就不同，本文選用的是10v電壓。設(shè)計端子板電路及驅(qū)動電路端子板是計算機、板卡控制信號端與機器人電路端的“橋梁”，承擔(dān)著信號調(diào)理、驅(qū)動放大等任務(wù)?？刂栖浖脑O(shè)計軟件是機器人的“大腦思維”，軟件的設(shè)計就是將人的意志賦予機器人的“大腦”。設(shè)計經(jīng)驗（1）底座設(shè)