0 引言

　二維通用機(jī)械手是一種可仿人操作、可自動控制、重復(fù)編程、能在二維平面內(nèi)完成各種作業(yè)的機(jī)電一體化自動化生產(chǎn)設(shè)備。隨著現(xiàn)代工業(yè)技術(shù)的發(fā)展，工業(yè)自動化技術(shù)越來越高，一些重復(fù)的工作由機(jī)械手遠(yuǎn)程控制或自動完成不僅可提高生產(chǎn)效率、降低生產(chǎn)成本，同時也可以避免一些人不能接觸的物質(zhì)對從業(yè)者身體造成傷害。

1 設(shè)計要求

　二維機(jī)械手的機(jī)械本體包括手指、手臂和軀干。像人手一樣，機(jī)械手的手指處于手臂前部，通過移動、打開和關(guān)閉三種基本動作組合實現(xiàn)抓緊的動作。手臂具有伸縮功能，可以調(diào)節(jié)手指到軀干的距離，同時可以將軀干的旋轉(zhuǎn)動作傳遞給手指。手臂伸縮與旋轉(zhuǎn)動作的結(jié)合可以將手指移動到工件的位置。軀干是安裝手臂、動力源和各種執(zhí)行機(jī)構(gòu)的機(jī)架。

　本文的設(shè)計要求是：機(jī)械手開始運(yùn)行后，首先進(jìn)行初始化。機(jī)械手的初始化包括三個動作，手爪手指張開到最大、手臂縮回到初始位置以及手臂橫縱方向歸零。為節(jié)省初始化的時間，要求這三個動作同時進(jìn)行。機(jī)械手運(yùn)行時，首先根據(jù)工件位置計算手臂伸縮電機(jī)步數(shù)、軀干旋轉(zhuǎn)電機(jī)步數(shù)，要求伸縮、旋轉(zhuǎn)同時進(jìn)行，將手指移動到工件正上方5cm處。第二，手臂縱向下移至手掌上的傳感器檢測到工件。第三，PLC控制手指收緊至手指上的傳感器檢測到工件，暫停1s后機(jī)械手帶動工件縱向上移5cm。第四，根據(jù)目標(biāo)位置計算手臂伸縮電機(jī)步數(shù)、軀干旋轉(zhuǎn)電機(jī)步數(shù)，將工件準(zhǔn)確安置到目標(biāo)位置；第五、延時1s后，手抓手指張開到最大釋放工件。機(jī)械手開始下一個循環(huán)的運(yùn)動。

2 設(shè)計方案

　本文設(shè)計的二維通用機(jī)械手共有4個自由度。依次為手臂前后伸縮、手臂上下移動、軀干水平旋轉(zhuǎn)、手指的抓緊與松開。因此，本文的設(shè)計要求可以總結(jié)為：1)手爪夾緊動作。2)手臂伸縮運(yùn)動。3)軀干旋轉(zhuǎn)運(yùn)動。

　2.1 手爪夾緊動作

　機(jī)械手的手爪實際上就是一個移動的卡具。不僅要求卡具卡緊的力度適中，而且卡緊的速度、準(zhǔn)確度也要滿足需求。本文設(shè)計的手抓是由PLC控制手指的張開和閉合。手指和手掌分別安裝傳感器負(fù)責(zé)感應(yīng)手指與工件的距離。

　2.2 M手臂伸縮運(yùn)動

　手臂是連接手爪和軀干的主要部分。本文設(shè)計的手臂可執(zhí)行縱向移動和前后伸縮運(yùn)動，可以實現(xiàn)手臂伸縮和升降的運(yùn)動。手臂伸縮和升降時，計算步進(jìn)電機(jī)需要轉(zhuǎn)動的步數(shù)。由PLC發(fā)出信號控制電機(jī)帶動絲杠運(yùn)動實現(xiàn)機(jī)械手的伸縮和升降運(yùn)動。絲杠、螺母結(jié)構(gòu)應(yīng)用于機(jī)械手的傳動中可以使機(jī)械手牢靠、準(zhǔn)確度高、效率高。

　2.3 軀干旋轉(zhuǎn)運(yùn)動

　軀干是整個機(jī)械手的支撐機(jī)構(gòu)，負(fù)責(zé)支撐手臂和手爪，同時可以自轉(zhuǎn)并帶動手臂手爪在水平方向旋轉(zhuǎn)。軀干旋轉(zhuǎn)時由步進(jìn)電機(jī)帶動一個旋轉(zhuǎn)編碼盤，每旋轉(zhuǎn)三度發(fā)出一個脈沖，由傳感器檢測并送入PLC計算軀干旋轉(zhuǎn)的角度。同時，在軀干上裝有限位開關(guān)，控制最大旋轉(zhuǎn)角度不能超過180度。

3 控制系統(tǒng)

　3.1 PLC的選擇

　對于本設(shè)計中的被控對象，要求選用的PLC系統(tǒng)與其他形式的控制系統(tǒng)相比，具有較好的性價比，使用和維修方便，PLC主機(jī)和配置、控制功能等必須能滿足被控對象的各種控制要求，PLC主機(jī)及配置必須是功能較強(qiáng)的新一代PLC機(jī)型。若采用三菱公司的PIC，則選FX系列，不選F1系列。同時還應(yīng)當(dāng)考慮將來工藝的變化和擴(kuò)展，在滿足確定的要求外，留有一定的余量t確保整個控制系統(tǒng)可靠。還要考慮大家對產(chǎn)品的熟悉程度，以及編程指令的易懂性。在此，本文選用三菱FX1N來做控制核心。

　3.2 PLC梯形圖中的編程元件

　設(shè)計選用FXlN一60MR，其輸入繼電器(X)36點(diǎn)，輸出繼電器(Y)24點(diǎn)，輔助繼電器(M)384點(diǎn)，狀態(tài)繼電器(s)looo點(diǎn)，定時器(T)256點(diǎn)，計數(shù)器(C)，數(shù)據(jù)寄存器(D)等。

　特殊輔助繼電器：

　根據(jù)機(jī)械手動作的要求，輸入、輸出分配如表1所示。

4 控制系統(tǒng)軟件設(shè)計

　機(jī)械手控制系統(tǒng)總體流程分為主程序、自動程序、手動程序和初始化程序共四個部分。主程序包含自動程序、手動程序和初始化程序的共同部分，是每個程序都需要經(jīng)歷的設(shè)置。自動程序包括單步控制程序和連續(xù)控制程序。如果控制方式設(shè)置為“手動”方式，則PLC執(zhí)行完主程序后將跳過自動程序，直接執(zhí)行“手動程序”。如果設(shè)置為“初始化”方式，執(zhí)行完主程序后，執(zhí)行回原位程序。如果設(shè)置為“連續(xù)”方式，則只執(zhí)行主程序和自動程序。

　4.1 主程序

　主程序流程圖如圖1所示，當(dāng)Y6復(fù)位(電磁閥松開)、后限位X21和上限位X17接通時，輔助繼電器M0變?yōu)镺N，表示機(jī)械手在原位。如果開始執(zhí)行用戶程序(M8002為ON)、系統(tǒng)處于手動或回原位狀態(tài)(X0或X1為ON)，那么初始步對應(yīng)的M10被置位，連續(xù)工作方式做好準(zhǔn)備。如果M0為OFF，M10被復(fù)位，系統(tǒng)不能進(jìn)入連續(xù)工作方式。指令ZRST是成批復(fù)位應(yīng)用指令，以防止系統(tǒng)從自動方式轉(zhuǎn)換手動方式，再返回自動方式時出現(xiàn)兩種不同的活動步。

圖1主程序梯形圖

　4.2 自動操作程序

　自動操作順序功能流程圖見圖2所示。當(dāng)機(jī)械手處于原位時，按X4啟動，狀態(tài)轉(zhuǎn)移到Sl，驅(qū)動前伸Y3，當(dāng)?shù)竭_(dá)前限位使行程開關(guān)X20，狀態(tài)轉(zhuǎn)移到S2，而S1自動復(fù)位。驅(qū)動手順轉(zhuǎn)Y7，X24接通，狀態(tài)轉(zhuǎn)移到S3，驅(qū)動下降Y2，X16接通，狀態(tài)轉(zhuǎn)移到S4，S4驅(qū)動Y6置位，延時1秒，以使電磁力達(dá)到最大夾緊力。當(dāng)TO接通，狀態(tài)轉(zhuǎn)移到S5，驅(qū)動Y0上升，當(dāng)上升到達(dá)最高位，X17接通，狀態(tài)轉(zhuǎn)移到S6。S6驅(qū)動Y4后退。移到后限位，狀態(tài)轉(zhuǎn)移到S7底逆轉(zhuǎn)Y12，狀態(tài)到S8，X20接通，狀態(tài)轉(zhuǎn)移到S9下降。下降到最低位，X16接通，電磁鐵放松。為了使電磁力完全失掉，延時1秒。延時時間到，T1接通，狀態(tài)轉(zhuǎn)移到Sll上升。上升到最高位，X25接通，狀態(tài)轉(zhuǎn)移到S13后退。后退到后限位，使X2l接通，狀態(tài)轉(zhuǎn)移到S14，底盤順轉(zhuǎn)是X2l接通，返回初始狀態(tài)，再開始第二次循環(huán)動作。

圖2自動的功能流程圖

4.3 手動單步操作程序

　手動程序說明：用對應(yīng)機(jī)械手的上下前后移動和夾緊松開按鈕。按下不同的按鈕，機(jī)械手執(zhí)行相應(yīng)的動作。在前后移動的程序中串聯(lián)上線位置開關(guān)的動合觸點(diǎn)是為了避免機(jī)械手在較低位置移動時碰撞其他工件。為保證系統(tǒng)安全運(yùn)行，程序之間還進(jìn)行必要的連鎖。圖3是手動單步操作程序部分流程圖。

圖3手動程序梯形圖

　4.4 回原位程序

　在系統(tǒng)處于回原位工作狀態(tài)時，按下回原位按鈕(X3)，M3變?yōu)镺N，機(jī)械手松開和上升，當(dāng)升到上限位(X17變?yōu)镺N)，機(jī)械手后退，直到后限位(X21為ON)才停止，并且M3復(fù)位。

5 結(jié)束語

　本文的控制方案可以實現(xiàn)機(jī)械手自動和手動控制下二維空間的自由運(yùn)動。采用PLC進(jìn)行工業(yè)機(jī)械手模型運(yùn)行控制，簡化了控制系統(tǒng)的硬件結(jié)構(gòu)。同時用“軟接線”方法進(jìn)行程序控制，提高了系統(tǒng)的可靠性和靈活性。