采摘機械手伺服控制系統(tǒng)電氣自動化設(shè)計——基于PLC控制器

尤向陽

(1.三門峽職業(yè)技術(shù)學(xué)院,河南 三門峽 472000；2.河南科技大學(xué) 應(yīng)用工程學(xué)院，河南 三門峽 472000)

0 引言

目前，大部分地區(qū)的水果采收方法還是采用人工采摘方式，效率低，勞動強度大，安全性較差，極大地制約了水果產(chǎn)業(yè)化、商品化的發(fā)展，而如果引入采摘機器人對果實進行采收，將極大地提高果實的采摘效率。在果實成熟季節(jié)，一些果實的體積較大，在設(shè)計采摘機械手時可以將其設(shè)計成爪形的卡盤，然后用電動刀具切割枝干來完成摘取。但是，在摘取過程中，由于很多果實較為柔軟，容易破碎，因此需要對采摘機械末端進行精確的控制。為了保證切割刀具和爪的協(xié)同工作，需要引入一種高效的控制系統(tǒng)。本次將PLC可編程控制器引入到采摘機械手的伺服控制系統(tǒng)中，以期提高控制系統(tǒng)的自動化程度和精度。

1 電機伺服系統(tǒng)及其在采摘機械手控制過程中的應(yīng)用

電機伺服系統(tǒng)主要分為兩類：一是DC直流伺服系統(tǒng)；二是AC交流伺服系統(tǒng)。其中，AC又可以分為異步電機和同步電機伺服系統(tǒng)。電氣伺服系統(tǒng)的應(yīng)用非常廣泛，原因是電氣伺服系統(tǒng)控制方便，驅(qū)動能源較為普及，沒有污染，且設(shè)備的維護容易。近年來，隨著電子技術(shù)和計算機技術(shù)的發(fā)展，電氣伺服系統(tǒng)也有了較大的進步，應(yīng)用前景越來越廣闊。

交流伺服電機共分為兩種形式：一是同步型；二是感應(yīng)型。同步型電機采用永磁體，也叫無刷直流伺服電機，具有直流電機的各種優(yōu)點，但不接觸換向部件，需要編碼器來實現(xiàn)；感應(yīng)型電機是指籠型感應(yīng)電動機，可以對轉(zhuǎn)矩分量和激勵分量同時控制，也具有直流電機的各種優(yōu)點。

伺服系統(tǒng)一共分為4部分，包括定位模塊、誤差放大模塊、執(zhí)行部件和被控對象。其利用全封閉無刷結(jié)構(gòu)，具有結(jié)構(gòu)緊湊、外形小、質(zhì)量輕、散熱效果好、可靠性高、運行平穩(wěn)等特點。由于其性能好、容量高，應(yīng)用越來越廣泛。伺服系統(tǒng)采用SPWM(脈寬調(diào)制變頻)變頻調(diào)速，觸發(fā)器電路是脈沖波，這些脈沖波可以調(diào)脈寬，進而改變電路的電壓。如按照正弦規(guī)律調(diào)頻，就是SPWM變頻調(diào)速。其原理如圖1所示。

圖1 SPWM變頻的工作原理圖

在進行變頻調(diào)速時，如果想要輸出正弦波電壓，可以采用一系列幅值不變的矩形脈沖來等效，在相同時間內(nèi)正弦波圍城的面積和矩形波面積相同即可。等效的精確程度和單位時間內(nèi)脈沖的數(shù)量有關(guān)，想要獲取較高的精度，可以加大單位時間內(nèi)脈沖的個數(shù)。本次采摘機械手的設(shè)計過程中，將采用伺服電機系統(tǒng)，并利用PLC可編程控制器對采摘動作進行控制，以提高采摘機械手的自動化程度和控制精度。

2 基于PLC的電氣自動化控制系統(tǒng)設(shè)計

為了實現(xiàn)采摘機器人采摘機械手的自動化作業(yè)，需要采用相關(guān)硬件和自動化程度來控制機械手的執(zhí)行末端。作業(yè)時，首先通過傳感器對果實信息進行采集，并利用相關(guān)處理程序根據(jù)果實的大小和顏色來判斷果實的成熟度，成功識別果實成熟度后給PLC發(fā)送采摘或者不采摘命令。如果不采摘，則繼續(xù)下一個果實目標(biāo)的識別；如果采摘，PLC在接受到信號之后驅(qū)動伺服電機的驅(qū)動器，對采摘目標(biāo)進行采摘。其總體的控制原理如圖2所示。

圖2 系統(tǒng)控制原理圖

系統(tǒng)主要由5部分組成，包括傳感器、遙控器、PLC控制器、伺服電機驅(qū)動器及伺服電機。作業(yè)過程中，如果遇到特殊情況，采摘機器人操作人員還可以通過遙控器對其進行遠程控制，驅(qū)動按鈕直接安裝在遙控器上，遙控器接受驅(qū)動命令后發(fā)動給PLC控制器，PLC直接驅(qū)動伺服電機驅(qū)動器來完成相關(guān)動作。伺服電機的控制，原理如圖3所示。

伺服電機在控制時，需要采用專門的驅(qū)動器。包括脈沖發(fā)生單元、保護單元和功率驅(qū)動單元等，驅(qū)動器和功率驅(qū)動單元直接通過耦合來實現(xiàn)，控制單元利用微機控制實現(xiàn)。采摘機械手的軟件控制設(shè)計流程如圖4所示。

圖3 伺服電機控制原理圖

圖4 軟件設(shè)計流程

為了實現(xiàn)采摘機械手的精確采摘，采用軟件編程的控制方式。在機械手到達待采摘的果實位置后，首先利用機械手進行抓取，啟動收割機刀具，利用收割刀具將果實的枝柄割斷，再進行取果操作。這個自動化采摘過程采用反饋調(diào)節(jié)的方式，如果抓取不成功，則重新定位抓??；如果割刀沒有一次性將枝柄割斷，則繼續(xù)切割；取果后，采摘機械手重新恢復(fù)到待采摘點，進行下一次采摘操作。

伺服電機的PLC控制程序可以通過梯形語言來進行編制，控制程序在上位機中編制、調(diào)試和編譯后，即可下載到 PLC 中。圖5為伺服電機的控制程序。其中，Y0表示輸出脈沖信號，Y1和Y2表示方向和脫機信號，STOP表示脈沖停止信號。在進行編制和調(diào)試時，可以首先安裝西門子系列PLC進行編程調(diào)試，最后改用在實際采用的PLC芯片上。

圖5 伺服電機控制梯形圖

3 采摘機器人果實自動化采摘系統(tǒng)測試

采摘機械手通過PLC編程和伺服電機控制，可以實現(xiàn)自動化采摘作業(yè)。為了完成采摘機器人的電氣系統(tǒng)測試，還需要設(shè)計硬件系統(tǒng)和軟件操作界面，進一步對其性能進行驗證。

圖6為采摘機械手作業(yè)過程的示意圖。進行測試時，需要設(shè)計硬件系統(tǒng)來對各種信息進行采集。系統(tǒng)通過PLC核心控制器完成相關(guān)的采摘動作，同時通過人機界面對測試數(shù)據(jù)進行監(jiān)測。硬件系統(tǒng)的框架結(jié)構(gòu)如圖7所示。

在測試系統(tǒng)上安裝有遠程按鈕，可以對采摘機械手進行各種遠程操控。采摘機器人的核心控制器采用PLC控制器，系統(tǒng)安裝有人機界面，可以實現(xiàn)作業(yè)數(shù)據(jù)的采集和監(jiān)測。最后，PLC通過執(zhí)行部件，如接觸器、繼電器和指示燈驅(qū)動電機完成相關(guān)的動作。其硬件參數(shù)如表1所示。

表1 測試系統(tǒng)硬件參數(shù)表

續(xù)表1

為了保證各器件協(xié)調(diào)工作，采用PLC集中控制的方式，設(shè)置各種硬件的接口。本次采用PLC是三菱公司的PLC產(chǎn)品，其實物圖如圖8所示。

圖6 采摘機械手示意圖

圖7 實驗測試硬件系統(tǒng)設(shè)計圖

圖8 PLC控制器實物圖

PLC控制器可以完成接受指令、發(fā)出控制指令等功能，實現(xiàn)自動化采摘過程。在進行采摘作業(yè)測試時，主要對采摘成功率和采摘破損率進行了測試，結(jié)果如表2所示。

表2 采摘成功率和破損率

測試結(jié)果表明：采用PLC控制系統(tǒng)后，除了具有較高的自動化水平外，成功采摘率較高，果實破損率較低，能夠滿足高精度采摘的需求。

4 結(jié)論

為了提高采摘機器人機械手的采摘準(zhǔn)確率和采摘精度，將PLC可編程控制器引入到了采摘機械手的伺服控制系統(tǒng)中，從而提高了采摘機械手各部件的協(xié)同作業(yè)水平及機械手作業(yè)的效率。為了驗證PLC控制系統(tǒng)的可靠性，對采摘機械手進行了試驗測試，結(jié)果表明：采摘機械手具有較高的采摘準(zhǔn)率，且果實的破損率也較低，從而驗證了PLC可編程控制器在采摘機器人伺服控制系統(tǒng)中使用的可行性，對于提高采摘機械手的采摘精度和效率具有重要的意義。