基于PLC的三自由度機(jī)械手控制系統(tǒng)設(shè)計(jì)與實(shí)現(xiàn)

機(jī)械手在最上面、最右邊，底盤(pán)轉(zhuǎn)至光接近開(kāi)關(guān)X3處且?jiàn)A緊裝置松開(kāi)時(shí)稱(chēng)系統(tǒng)處于原點(diǎn)狀態(tài)。X10為手動(dòng)控制按鈕，按下該按鈕后，可以進(jìn)行按鍵開(kāi)關(guān)X20～X27對(duì)應(yīng)的手動(dòng)操作。X11～X15分別為自動(dòng)方式中的回原點(diǎn)、單步、單周期和連續(xù)工作方式按鈕，按下其中的某一個(gè)按鈕，再按起動(dòng)按鈕X0，該工作方式的動(dòng)作就會(huì)自動(dòng)執(zhí)行。步進(jìn)電機(jī)只有在有脈沖信號(hào)(Y0)和方向信號(hào)(Y2或Y3)輸入時(shí)才會(huì)轉(zhuǎn)動(dòng)，Y6，Y7選擇將脈沖信號(hào)Y0送至哪個(gè)步進(jìn)電機(jī)。Y5控制送氣電磁閥，實(shí)現(xiàn)夾緊裝置的夾緊與松開(kāi)。Y10，Y11控制底盤(pán)直流電機(jī)的正反轉(zhuǎn)。
2．2 軟件設(shè)計(jì)
在選擇單步、單周期和連續(xù)工作方式前，系統(tǒng)應(yīng)當(dāng)處于原點(diǎn)狀態(tài)。如果不滿(mǎn)足這一條件，可以選擇回原點(diǎn)工作方式，該工作方式依次執(zhí)行以下操作：向上運(yùn)動(dòng)至上限位x1→向右運(yùn)動(dòng)至右限位X2→順時(shí)針轉(zhuǎn)動(dòng)至光接近開(kāi)關(guān)X3→夾緊裝置松開(kāi)。
機(jī)械手自動(dòng)工作方式的順序功能圖如圖3所示。機(jī)械手手臂的運(yùn)動(dòng)速度由輸入步進(jìn)電機(jī)的脈沖頻率控制，機(jī)械手下降及左行的距離由脈沖數(shù)控制，脈沖頻率和脈沖數(shù)可以根據(jù)工業(yè)現(xiàn)場(chǎng)的實(shí)際情況在程序中設(shè)定，具有可重復(fù)操作性。

本系統(tǒng)采用的是PLC梯形圖順序編程的方法。其中以PLSY脈沖輸出指令輸出脈沖，用MOV指令設(shè)定脈沖個(gè)數(shù)，指定脈沖輸出完后，指令執(zhí)行完成標(biāo)志M8029置1。由于PLSY指令只能使用一次，而系統(tǒng)中兩個(gè)步進(jìn)電機(jī)均需要脈沖輸入，設(shè)計(jì)中采用兩個(gè)外部繼電器解決了該問(wèn)題。將Y0輸出的脈沖同時(shí)接至兩個(gè)繼電器動(dòng)觸點(diǎn)，兩繼電器的常開(kāi)觸點(diǎn)分別與兩塊步進(jìn)電機(jī)驅(qū)動(dòng)器的脈沖輸入端相連，Y6，Y7接到兩繼電器的控制端，這樣就可以通過(guò)Y6，Y7來(lái)控制步進(jìn)電機(jī)的脈沖輸入。

3 系統(tǒng)的MCGS組態(tài)環(huán)境
MCGS是為工業(yè)過(guò)程控制和實(shí)時(shí)監(jiān)測(cè)領(lǐng)域服務(wù)的通用計(jì)算機(jī)系統(tǒng)軟件，具有功能完善，操作簡(jiǎn)便，可視性好，可維護(hù)性強(qiáng)的突出特點(diǎn)。圖4為三自由度機(jī)械手系統(tǒng)工作時(shí)的MCGS組態(tài)環(huán)境界面，它包括主界面、手動(dòng)工作方式界面和自動(dòng)工作方式界面。

4 結(jié) 語(yǔ)
經(jīng)調(diào)試，步進(jìn)電機(jī)的運(yùn)轉(zhuǎn)無(wú)抖動(dòng)和失步現(xiàn)象發(fā)生，機(jī)械手系統(tǒng)處于良好的運(yùn)行狀態(tài)。三自由度機(jī)械手系統(tǒng)實(shí)現(xiàn)的只是三個(gè)自由度方向上的運(yùn)動(dòng)，根據(jù)工業(yè)生產(chǎn)的實(shí)際需要，可以對(duì)其進(jìn)一步改進(jìn)，在夾緊裝置肘部添加腕回轉(zhuǎn)控制裝置，就能使之成為四自由度機(jī)械手控制系統(tǒng)。在條件允許的情況下，也可以采用觸摸屏代替MCGS組態(tài)環(huán)境對(duì)機(jī)械手系統(tǒng)進(jìn)行控制，這樣占用空間小，人機(jī)交互界面直觀(guān)，操作更方便。