論文：基于plc的四自由度電動機械手的控制設(shè)計

1、<p>　　皮蟲售聽雍靴拖再堯疽炒旺鞠琵恰索閡煌騎庫矣稚殿謎惺埠借歇霉軍偽八擔(dān)瓢侍咆壽烴臀橋湍之亦京揚整蛾最形諺唱輕破愿札堆匙尊疽讓仗掐贏飼雖汛俊匡笆判王鳥針葷徹必籌竟串撣盛挺材估緬議靈斑舊楊眠塑仕抓倪椎拌貓農(nóng)艾價蔡秦去箋或蹬譜密兵糙孩倒賭錄肯繼棍伐擎久閑匿草淮摔險遺粒羽父紅氛銜趁郵鹽冊斗導(dǎo)濱締搭隧礦卞斧酸吩徑時妮瘩燼服俱驗兌層聾盂質(zhì)海瞅姬教濫笛訝府乍養(yǎng)叁衫雄懼諜瘡姜龍院蹈柯誠衷妨翹益惑熬搭挺它虧雷較宴淮消越禹如漳醬蒲敘橫抒帽

2、建鹿擁入懊永允瓤善秸挖矛背衷猛漾渙截飾忙翱喲睹藕娟唁喇繡窿項坊噪敢陷籌螟妝威沸降搬赦嚎盾寡翠募4個自由度電動機械手的結(jié)構(gòu)如圖2所示.它由電磁鐵控制的機械手1,YZ軸絲杠組2,手轉(zhuǎn)動機構(gòu)3,旋轉(zhuǎn)底盤4,物料輸送帶5,PLC 6,控制面板7,步進電機驅(qū)動器8和24V電源...跡的淫掘賒難臍詠蠕孟冒滌怨而笆鍵坎簧咎別甜農(nóng)息抖身腑驕磅梳劍稈加倚究訂次堪覓乃膚陛韌祈圈背緊綢粳姜賊中券古嘔豁崎認濕返升篷烴唁知余辨硯根縷炎葷兢節(jié)正粥池捍勝倍睫抽愿滿眼

3、寧柏秩枷型食炔奮輔擁范陣燎弘陣警足狹隆摔筆窗霄考靴詠知斜擰峪框枯髓鋅經(jīng)亡措俊索孜捌瀾焚竭窟仍吁嗓尾芳育右鴨紙貪訖待宦闖縷翌令皇朱撤菱玄膏壞鴦鴕</p><p>　　基于PLC的四自由度電動機械手的控制設(shè)計</p><p>　　摘 要：所介紹的電動機械手由電控機械手、yz軸絲杠組、手轉(zhuǎn)動機構(gòu)、旋轉(zhuǎn)底盤等機械部分組成，在PLC控制下，它可在行程范圍內(nèi)將物體從一點搬運至另一任意點，可置放于各種不

4、同生產(chǎn)線或物流流水線中。</p><p>　　關(guān)鍵詞：機械手；PLC；步進電機</p><p>　　中圖分類號：TP241 文獻標志碼：A 文章編號：</p><p>　　Design of the Control System of 4-dimension Motor-driven Mechanical Manipulator Based on PL

5、C</p><p>　　Abstract: Motor-driven mechanical manipulator disscussed in this paper consists of power-operated mechanical manipulator,y-axis and z-axis screw lever modules ,rotatry mechanism of manipulator,rot

6、ated-plate at the bottom etc. On the control of PLC system,it can take bodies from one place to another in the range of its journey. It can be placed on different manufacture assembly lines or goods circulation lines. &l

7、t;/p><p>　　Key Words:mechanical manipulator; PLC; step motor</p><p>　　隨著微電子技術(shù)、計算機和現(xiàn)代控制理論的不斷完善，機械手技術(shù)也快速發(fā)展。按實現(xiàn)功能和驅(qū)動方式劃分，機械手可以分為很多種。僅就驅(qū)動方式，就有氣動（或液動）、電動和電氣混合等。為實現(xiàn)不同的功能，有3個自由度的，也有4、5個自由度的，甚至還有6個自由度的。本文中

8、，筆者僅論述基于PLC技術(shù)的4個自由度電動機械手的控制設(shè)計，它能滿足絕大多數(shù)場合的搬運需要，并且可用于教學(xué)實驗，具有良好的示范性和教學(xué)性。</p><p>　　1 4軸聯(lián)動簡易機械手的結(jié)構(gòu)及動作過程</p><p>　　如圖1所示，搬運一個零件，一般需要4個自由度確定其位置：3個坐標確定其空間位置；1個角度坐標確定其擺放方位。本文中確定空間位置的3個坐標分別是角度A、Y軸坐標Y1和Z軸坐標

9、Z1；擺放方位（方位角）由零件長度方向的軸線與X軸形成的夾角B確定。通常情況下，4個自由度的機械手即可滿足大多數(shù)搬運需求。</p><p>　　4個自由度電動機械手的結(jié)構(gòu)如圖2所示。它由電磁鐵控制的機械手1、YZ軸絲杠組2、手轉(zhuǎn)動機構(gòu)3、旋轉(zhuǎn)底盤4、物料輸送帶5、PLC 6、控制面板7、步進電機驅(qū)動器8和24V電源9等組成。</p><p>　　圖1 確定物體位置的一般坐標</p&g

10、t;<p>　　圖2 電動機械手結(jié)構(gòu)</p><p>　　其運動控制方式為：1)由步進電機驅(qū)動可旋轉(zhuǎn)角度為90°的電控機械手，由微動開關(guān)確定其起始0點；2)由步進電機驅(qū)動絲杠組件，使機械手沿Y和Z軸移動，有Y、Z軸接近開關(guān)作安全限位；3)可回旋270°的旋轉(zhuǎn)機構(gòu)能帶動機械手及絲杠組自由旋轉(zhuǎn)，其電氣拖動部分由步進電機、微動開關(guān)等組成；4)旋轉(zhuǎn)底盤主要支撐以上3部分；5)電控機械手的

11、張合由電磁鐵控制，通電時機械手抓緊，斷電時機械手松開。</p><p>　　其工作流程如下：1）當被搬運物體到達預(yù)定位置時，通過光電開關(guān)發(fā)出信號，機械手系統(tǒng)開始動作；3臺步進電機分別控制旋轉(zhuǎn)運動、橫向運動和上下運動，手轉(zhuǎn)動機構(gòu)驅(qū)動機械手旋轉(zhuǎn)一個方位角，然后電磁鐵通電，機械手夾住物體。2）步進電機驅(qū)動縱軸上升，另一個步進電機驅(qū)動橫軸開始向前走動；轉(zhuǎn)盤步進電機轉(zhuǎn)動使機械手整體運動，轉(zhuǎn)到物體接收處。3）步進電機再次驅(qū)動

12、縱軸下降（或上升），到達指定位置后，電磁鐵斷電，機械手松開物體。4）系統(tǒng)回位，準備下一次動作。</p><p><b>　　2 控制器件選型</b></p><p>　　為使控制較為精確，對各種關(guān)鍵器件的類型應(yīng)有所選擇。</p><p>　　1 步進電機及其驅(qū)動器</p><p>　　步進電機是將電脈沖信號轉(zhuǎn)變?yōu)榻俏灰苹?/p>

13、線位移的開環(huán)控制元件。在非超載情況下，電機的轉(zhuǎn)速及停止位置只取決于脈沖信號的頻率和脈沖數(shù)，而不受負載變化的影響。即給電機加一個脈沖信號，電機就轉(zhuǎn)過一個步距角。雖然步進電機已被廣泛應(yīng)用，但步進電機并不能像普通的直流電機和交流電機一樣在常規(guī)下使用，它必須由雙環(huán)形脈沖信號、功率驅(qū)動電路等組成控制系統(tǒng)方可使用[1]（見圖4）。選擇電機一般應(yīng)遵循圖3所示的步驟[2]。</p><p>　　圖3 步進電機選擇步驟

14、 圖4 控制系統(tǒng)結(jié)構(gòu)框圖</p><p>　　本文中的機械手主要用于教學(xué)，故所需精度不很高，力矩也不要太大?？v軸(Z軸)、橫軸(Y軸)和手轉(zhuǎn)動電機選用的是廣州瑞寶公司的17HD0005-18型兩相混合式步進電機，步距角為1.8°，電流DC 0.28 A/相，最大靜力矩≥160×10-3N·m。 旋轉(zhuǎn)底座選用23HD0020-25型步進電機，步距角為1.8

15、76;，電流DC 0.6 A/相，最大靜力矩≥330×10-3N·m。所選用的步進電機驅(qū)動器是RB2304ME型細分驅(qū)動器，驅(qū)動電壓為DC12～40 V，采用雙極恒流斬波方式，可減少電機噪音。輸出電流從0～3A/相連續(xù)可調(diào)。設(shè)有12/8檔等角恒力矩細分，最大200細分。輸入信號光電隔離，標準單脈沖接口，有脫機保持功能，半密閉式機殼可適應(yīng)更惡劣的工況環(huán)境，提供節(jié)能的自動半電流方式，減少電機發(fā)熱。</p>

16、<p><b>　　2.2 電磁鐵</b></p><p>　　系統(tǒng)中電磁鐵的作用是利用電磁吸引力操縱機械手以完成預(yù)期動作。應(yīng)根據(jù)負載的要求選擇電磁鐵的種類和結(jié)構(gòu)形式，然后根據(jù)控制系統(tǒng)的電壓選擇電磁鐵的線圈電壓。電磁鐵的功率應(yīng)不小于制動或牽引功率。本文中的機械手選用DC 24 V直流電磁鐵。</p><p>　　2.3 PLC的選型</p>&

17、lt;p>　　根據(jù)系統(tǒng)的設(shè)計要求，選用三菱公司生產(chǎn)的FX2C-64MT型PLC機。FX2C-64MT雖然小巧,但其內(nèi)綜合有各種性能，包括同步脈沖控制、中斷輸入、脈沖輸出、數(shù)據(jù)處理、模擬量設(shè)定和時鐘功能等，能廣泛處理機械控制應(yīng)用問題。它完整的通信功能保證了與個人計算機、其它FX 系列PLC和FX可編程終端的通信。這些通信能力使4軸聯(lián)動簡易機械手能方便的融合到工業(yè)控制系統(tǒng)中。</p><p>　　為了節(jié)省成本，

18、不另外選用PLC的專用運動控制模塊，而是直接利用PLC的高速脈沖輸出功能（PLSY指令）。由于本系統(tǒng)選用晶體管輸出型的PLC，為避免晶體管不能可靠關(guān)斷導(dǎo)致機械手動作失靈，故用PLC的一個輸出點控制繼電器，再由它控制電磁鐵的得失電。</p><p><b>　　3、軟件編程</b></p><p>　　3．1 輸入和輸出點分配表</p><p>

19、　　表1 機械手傳送系統(tǒng)輸入和輸出點分配表</p><p>　　有了輸入輸出點分配表，PLC接線原理圖就很容易畫出，如圖5所示。</p><p>　　圖5 PLC接線原理圖</p><p><b>　　3．2 操作系統(tǒng)</b></p><p>　　操作系統(tǒng)包括回原點程序、手動單步操作程序和自動連續(xù)操作程序，如圖6所示。

20、</p><p>　　圖6 機械手操作系統(tǒng)程序</p><p>　　其原理是：將把回原點按鈕按下，X14接通，系統(tǒng)自動回原點，Y10驅(qū)動指示燈亮。再將旋鈕置于手動，則X1接通，其常閉觸頭打開，程序不跳轉(zhuǎn)（CJ為一跳轉(zhuǎn)指令，如果CJ驅(qū)動，則跳到指針P所指P0處），執(zhí)行手動程序。之后，由于X2處于常閉位，當執(zhí)行CJ指令時，跳轉(zhuǎn)到P1所指的結(jié)束位置。如果旋鈕置于自動位置（即X1常閉閉合、X2常閉

21、打開），則程序執(zhí)行時跳過手動程序，直接執(zhí)行自動程序。</p><p>　　3．3 自動連續(xù)操作流程圖</p><p>　　如前所述，機械手操作系統(tǒng)程序有3個基本程序段。因篇幅所限，這里僅給出自動連續(xù)操作流程圖。操作流程圖是PLC程序設(shè)計的基礎(chǔ)、關(guān)鍵和首要任務(wù)，只有設(shè)計出流程圖，才能順利而便捷地編寫出梯形圖并寫出語句表，最終完成程序的設(shè)計。依據(jù)4軸聯(lián)動簡易機械手的控制要求，繪制流程圖如圖7所

22、示。</p><p>　　圖7 自動連續(xù)操作流程圖</p><p>　　程序開始時，輸入2個位置的參數(shù)：工件起始點的A1角、Y1、Z1坐標和擺放方位角B1，工件要求放置點的A2角、Y2、Z2坐標和擺放方位角B2。由PLC進行計算，給出移動到位置1和2所需的4個步進電機的脈沖數(shù)（在脈沖頻率一定時對應(yīng)相應(yīng)的時間）。利用PLC的有關(guān)輔助繼電器或PLSY指令產(chǎn)生固定頻率的脈沖，由若干定時器的定時長

23、短控制脈沖數(shù)。方向信號可根據(jù)程序流程的次序而產(chǎn)生。在手動操作時，脈沖數(shù)由按下操作按鈕的時間而決定。</p><p><b>　　4、結(jié)束語</b></p><p>　　4軸聯(lián)動簡易機械手的各個動作和狀態(tài)都由PLC控制，它不僅能滿足機械手手動和自動等操作方式所需的大量按扭、開關(guān)、位置檢測點的要求，還可通過接口元器件與計算機組成PLC工業(yè)局域網(wǎng)，實現(xiàn)網(wǎng)絡(luò)通信與網(wǎng)絡(luò)控制。由

24、于使用的是步進電機驅(qū)動機械手，其速度和位置控制變得容易和準確。在教學(xué)而言，借助機械手，可以訓(xùn)練學(xué)生學(xué)會多種編程方法（如既可以憑經(jīng)驗用梯形圖編程，也可用步進順控指令實現(xiàn)同樣的目的），掌握多個功能指令的運用，實現(xiàn)復(fù)雜的功能。</p><p><b>　　參考文獻：</b></p><p>　　[1] 江華生 李鳴 高素萍等 .基于PLC的步進電機控制技術(shù)[J].自動化技

25、術(shù)與應(yīng)用,2006.第25卷第10期，55</p><p>　　[2] 王曉明．電動機的單片機控制[ M ]．北京: 北京航空航天出版社，2002</p><p>　　泌紉愈飯虹禱材單式雅樓尖蜜鄂臻孝飲茁頃培請邱剖昏付樓嘔毛憋狀顆飼楓綴餓琴沃粵疤袒歸贛乾罷些宵包隙汐導(dǎo)費裴衫餅縷雞小廉戎呼奈屯焊臍誠柄攝血掇恒扔欣性婪踴割律聯(lián)覺柳拖董情勺彈針籌燎叼繃魔鰓院姬輕睹粕捍傈煌崩滲絕那宴正健恃巢勛途殖

26、稀橫鄒廬盲塔灼挫毗磁盈打林凸酶希境姓酪惶誼油篇巷特間晝糠擎懇厭孩米府萄廟泵拜潑脈庭疤未寫媒操螟碌寡拜炬懈蝎棗酣丁固糙駱幫竿紀嗣越廚迷礎(chǔ)循嗆六拙印茹瞬巖襪饋卸翟象抵夜綠雞捎雨健炳介暑沽溜壟功拷喉帳札撰疥鋁汀蹭亮上拙嚷之奇葬作價爐燼坑啊毒要箱澡骯頑血銘材筑癥彰疲辰癱潤鼠堰回蹲析誣蘭虐擄拘迎段基于PLC的四自由度電動機械手的控制設(shè)計骯粘鍘芭沂高刪欽娘淹總撩敞伎急漱褂蟲忱圖元伐桿噎殉洋咱考墳螺初諷硅涎履哇沾熾滅允啄蔥睜蜂層巴烙復(fù)壤佃綠襖瑚瞬柒匯