潘平盛
廣東理工學(xué)院工業(yè)自動化系，廣東肇慶 526040
摘要：為滿足工業(yè)生產(chǎn)要求和提高企業(yè)的生產(chǎn)效率，設(shè)計(jì)了一種新型的工業(yè)生產(chǎn)線自動化搬運(yùn)碼垛機(jī)械手及控制系統(tǒng)。介紹了碼垛機(jī)械手結(jié)構(gòu)及檢測柜平臺的設(shè)計(jì)與安裝、機(jī)械末端氣動控制系統(tǒng)、電力控制系統(tǒng)。提出觸摸屏作為上位機(jī)，以PLC作為控制器，三位五通換向電磁閥、伺服電機(jī)、氣缸為驅(qū)動設(shè)備的電氣機(jī)械手控制方法，重點(diǎn)講解了氣動回路、控制系統(tǒng)的硬件組成以及PID參數(shù)對控制伺服電機(jī)影響。最后，對整個電氣控制系統(tǒng)回路進(jìn)行調(diào)試和實(shí)驗(yàn)。實(shí)驗(yàn)數(shù)據(jù)表明：該電氣控制系統(tǒng)設(shè)計(jì)合理，能夠達(dá)到企業(yè)的生產(chǎn)要求。
關(guān)鍵詞：自動化生產(chǎn)線；控制系統(tǒng)；氣動回路；PLC
1引言
隨著經(jīng)濟(jì)的不斷發(fā)展、人民美好生活對物質(zhì)提高了要求，特別是對飲食和衣著方面。因此，提高生產(chǎn)技術(shù)至關(guān)重要，而在工業(yè)生產(chǎn)中，機(jī)械手具有穩(wěn)定性高、操作簡單、以及高效率等特點(diǎn)，很好的適應(yīng)在特殊場合和工作環(huán)境中，廣泛應(yīng)用在工業(yè)、食品、醫(yī)療等領(lǐng)域[1-2]。目前，我國碼垛機(jī)械手控制系統(tǒng)上取得很大突破和研究。例如：文獻(xiàn)[3]研究的玻璃檢測機(jī)氣動系統(tǒng)設(shè)計(jì)，設(shè)計(jì)了一種氣動控制的玻璃檢測機(jī)機(jī)械臂，并闡述了其工作原理；文獻(xiàn)[4]設(shè)計(jì)了鋼化玻璃碎片快速檢測裝置，對裝置結(jié)構(gòu)和控制系統(tǒng)進(jìn)行了優(yōu)化，實(shí)驗(yàn)數(shù)據(jù)也能很好地驗(yàn)證其檢測效果；文獻(xiàn)[5]對板材下料自動拾取機(jī)器人控制系統(tǒng)進(jìn)行的設(shè)計(jì)，利用Simulink對機(jī)器人結(jié)構(gòu)進(jìn)行了分析和仿真。
設(shè)計(jì)的碼垛機(jī)械手是一種直角坐標(biāo)式機(jī)械手，執(zhí)行裝置是伺服電機(jī)和氣缸。機(jī)械手末端的夾取通過氣缸的伸縮來完成，而X、Y、Z三個方向的運(yùn)動通過伺服電機(jī)的旋轉(zhuǎn)來帶動滾珠絲杠旋轉(zhuǎn)，從而實(shí)現(xiàn)前后、左右、上下直線運(yùn)動。碼垛機(jī)械手創(chuàng)新點(diǎn)和優(yōu)點(diǎn)在于：（1）X、Y、Z三個方向的運(yùn)動通過伺服電機(jī)帶動滾珠絲杠旋轉(zhuǎn)，運(yùn)動過程中負(fù)載能力強(qiáng)；（2）結(jié)構(gòu)簡單，占地面積小，降低生產(chǎn)成本。
2機(jī)械手平臺的搭建及系統(tǒng)控制要求
2.1機(jī)械手基本組成結(jié)構(gòu)
機(jī)械手主要由支架3.Y方向的移動臂、4.Z方向的升降臂、6.末端吸盤以及10.電機(jī)組成，如圖1所示。機(jī)械手主要安裝在傳輸線兩側(cè)，如圖2所示。左側(cè)是將傳輸線上產(chǎn)品抓取并放入檢測柜的每一層中，右側(cè)機(jī)械手平臺主要是將檢測完成的產(chǎn)品取出并放入傳輸線。產(chǎn)品檢測柜平臺，主要組成有多層架構(gòu)、產(chǎn)品檢測儀。其作用是將傳輸線上傳送過來的待檢產(chǎn)品進(jìn)行檢測。而多層架構(gòu)可以實(shí)現(xiàn)快速擺放并進(jìn)行檢測，提高檢測和抓取效率。
圖 1 碼垛搬運(yùn)機(jī)械手平臺
圖 2 自動化生產(chǎn)線碼垛柜平臺
2.2機(jī)械手控制要求
將待檢產(chǎn)品經(jīng)左側(cè)傳輸帶傳輸?shù)綑z測柜處，左側(cè)機(jī)械手將產(chǎn)品依次碼放在檢測柜的各層之間，待檢測完成后，右側(cè)機(jī)械手依次抓取并存放在右側(cè)傳輸帶中進(jìn)入下一道工序繼續(xù)加工處理。機(jī)械手抓取工步順序具體要求如下：
抓取工步要求：
（1）X、Y方向水平移動情況：X方向移動是靠導(dǎo)滾珠絲杠完成的，而Y方向移動是靠導(dǎo)軌系統(tǒng)完成的，兩者都是由PLC脈沖輸出位置控制功能驅(qū)動伺服放大器控制伺服電機(jī)精確定位。
（2）變頻調(diào)速：控制過程中采用變頻器進(jìn)行調(diào)速，便于控制機(jī)械臂前后、左右、上下運(yùn)動。
（3）整個碼垛搬運(yùn)過程可以由兩種操作方式完成搬運(yùn)動作：
自動循環(huán)操作：按下啟動按鈕，機(jī)械手按照人為設(shè)定的控制程序連續(xù)完成碼垛搬運(yùn)工作，直到按下停止按鈕，否則搬運(yùn)工作一直進(jìn)行；
手動操作：在設(shè)計(jì)過程中，末端吸盤吸取、X方向前后移動、Y方向左右移動、Z方向升降等8個動作步設(shè)置8個按鈕，分別控制機(jī)械手運(yùn)動。
（4）末端吸盤吸附和松開、X方向移動、Y方向移動、Z方向升降等運(yùn)動能實(shí)現(xiàn)精確定位，且每個動作相互之間必須有互鎖作用。
（5）機(jī)械手末端真空吸盤必須氣密性良好。
3氣動回路設(shè)計(jì)
3.1氣動回路基本組成
氣動回路組成包括：氣源裝置、介質(zhì)、執(zhí)行元件、控制元件、輔助部分[7]。機(jī)械手末端氣動原理圖，如圖3所示。主要由過濾器、調(diào)壓閥、電磁閥、換向閥、夾持氣缸組成。
電磁鐵動作順序，如表1所示。首先，當(dāng)工件到達(dá)指定位置時，三位五通電磁換向閥左側(cè)YV1、換向閥YV3同時得電，處理后的氣體快速進(jìn)入，使得機(jī)械手末端吸盤實(shí)現(xiàn)碼垛吸附；其次，當(dāng)機(jī)械手運(yùn)動到碼垛指定擺放位置時，三位五通電磁換向閥右側(cè)YV2、換向閥YV4同時得電，機(jī)械手末端實(shí)現(xiàn)碼垛松開，此時碼垛進(jìn)入傳送帶進(jìn)入下一道工序；最后，當(dāng)YV1、YV2、YV3、YV4同時都處于失電情況下，機(jī)械手末端吸盤處于原位保持，等待下一個命令啟動。
圖 3 機(jī)械手末端氣動原理圖
表 1 控制系統(tǒng)電磁閥動作順序表
3.2電氣元件選型
設(shè)計(jì)的機(jī)械手控制系統(tǒng)中主要相關(guān)元器件型號，如表2所示。
3.3機(jī)械末端夾取吸盤力計(jì)算
末端執(zhí)行機(jī)構(gòu)吸盤臂上安裝1個吸盤，如圖1所示。吸盤直徑為：
式中：G—碼垛重量，單位N；t—安全系數(shù)，當(dāng)水平吸附碼垛時t≥4；n—洗盤的個數(shù)，此時n=1；P—吸盤真空度，單位為MPa；R — 吸盤直徑，單位mm。
試驗(yàn)中，一塊碼垛的平均重力G=200N，單個吸盤直徑R= 160mm，因此在水平吸附吸附下，吸盤的真空度分別為：
4機(jī)械手控制系統(tǒng)設(shè)計(jì)
4.1系統(tǒng)硬件組成
機(jī)械手控制系統(tǒng)硬件組成包括：主控器PLC和外部輸入輸出設(shè)備。主控制器采用三菱PLC，包括電源、I/O、存儲器以及通訊端口；輸入設(shè)備包括傳感器、控制按鈕、控制面板以及觸摸屏；輸出設(shè)備主要包括電磁閥、變頻器、繼電器以及負(fù)載，例如報(bào)警燈，鳴笛等[8]。
4.2PLC編程
機(jī)械手控制系統(tǒng)主要有兩種控制模式：手動開關(guān)控制和觸摸屏控制。主控器三菱PLC上的I/O口作為輸入、輸出，控制著整個機(jī)械手動作。在手動控制情況下，需要8個開關(guān)控制著X、Y、Z方向的輸出伺服電機(jī)以及末端輸出夾取電磁換向閥，方便手動調(diào)試和檢修；在觸摸屏控制方式下，有單周期和自動循環(huán)選擇，通過點(diǎn)擊觸摸屏軟開關(guān)向觸摸屏輔助繼電器M發(fā)出命令，從而控制輸出線圈變化；其中M1作為單周期和自動循環(huán)選擇命令，M2為復(fù)位命令，M3為啟動命令，M0為等待搬運(yùn)狀態(tài)命令。機(jī)械手控制系統(tǒng)PLC的I/O分配，如表3所示。當(dāng)機(jī)械手系統(tǒng)初始化完成之后，在觸摸屏控制模式下，按下啟動按鈕M3時，機(jī)械手完成左移、右移、前進(jìn)、后退、上升、下降、夾取、松開等多個工序，控制流程圖，如圖4所示。
圖 4 機(jī)械手功能流程圖
4.3伺服電機(jī)控制模型
機(jī)械手控制系統(tǒng)分為：傳輸模塊和搬運(yùn)模塊。皮帶輪傳輸和搬運(yùn)機(jī)械手X、Y、Z方向移動主要通過控制伺服電機(jī)，機(jī)械手才能夠完成左移、右移、前進(jìn)、后退、上升、下降、夾取、松開等多個工序。因此，伺服電機(jī)控制的研究對機(jī)械手的運(yùn)動位置和速度具有重要的意義。伺服電機(jī)的物理模型，如圖5所示。
圖 5 伺服電機(jī)物理模型
中：Ua—電樞輸入電壓（V）；Ra—電樞阻值（H）；La—電樞電感（H）；ia—電樞電感（A）；Uq—電樞電感（V）；J—轉(zhuǎn)動慣量；θ—轉(zhuǎn)角（rad）；B—粘性阻尼系數(shù)（N.m.s）；Tg—電機(jī)電磁轉(zhuǎn)矩（N.m）。
根據(jù)牛頓第二定律及基爾霍夫定律[9]，對圖6示意圖列出方程組：（3）
經(jīng)過來普拉斯變換法，消除中間變量，得到傳遞函數(shù)為：
（4）
其中，J=3.23，B=3.51，Ra=4.00，La=2.75，Kt=Ke=0.03。
5觸摸屏界面建立及樣機(jī)實(shí)驗(yàn)
5.1建立觸摸屏界面
機(jī)械手控制系統(tǒng)監(jiān)控建立在工業(yè)組態(tài)基礎(chǔ)上，設(shè)計(jì)中我們采用MCGS的TPC1162Hi觸摸屏作為本次試驗(yàn)的監(jiān)控設(shè)備，在MCGS中建立搬運(yùn)機(jī)械手變量和PLC變量，并且將兩者變量相互建立關(guān)系，最終得到系統(tǒng)聯(lián)機(jī)界面監(jiān)測，如圖6所示。
5.2仿真結(jié)果和分析
將整個控制系統(tǒng)線路連接之后，設(shè)置電機(jī)驅(qū)動器不同的PID參數(shù)，如表4所示。通過操作上位機(jī)，測試出在不同PID參數(shù)下機(jī)機(jī)械設(shè)計(jì)與制造No.410Apr.2020械手運(yùn)行狀態(tài)（包括平穩(wěn)程度、達(dá)到平穩(wěn)狀態(tài)所需要的時間），如表4所示。利用Matlab仿真實(shí)驗(yàn)得出電機(jī)趨于穩(wěn)定運(yùn)行狀態(tài)的最優(yōu)參數(shù)，且Matlab仿真PID控制方式下的階躍響應(yīng)曲線，如圖7所示[10-11]。
圖 7 PID 控制階躍響應(yīng)圖
對比P、PI、PD、PID控制參數(shù)表表4和PID控制方式下的仿真曲線圖7，可以看出：
（1）PID控制方式下，系統(tǒng)快速趨于穩(wěn)定狀態(tài)，所需要的時間最小。
（2）對比P、PI、PD、PID控制方式下，系統(tǒng)的平穩(wěn)度從波動、微波動、相對平穩(wěn)、穩(wěn)定等狀態(tài)逐步趨于穩(wěn)定。
（3）PID控制的響應(yīng)曲線在輸出值沒有達(dá)到穩(wěn)定狀態(tài)之前，系統(tǒng)沒有出現(xiàn)振蕩現(xiàn)象。
（4）PID控制輸出響應(yīng)曲線達(dá)到穩(wěn)定的時間為0.008s，響應(yīng)速度比P、PI、PD控制明顯提高，且沒有靜態(tài)誤差。
因此，碼垛機(jī)械手X、Y、Z方向電機(jī)控制系統(tǒng)采用PID控制，PID控制比P、PI、PD控制其性能明顯提高，超調(diào)較小，穩(wěn)定時間快，具有更好的動態(tài)性能。
6 結(jié)論
設(shè)計(jì)的機(jī)械手是一種直角坐標(biāo)式機(jī)械手，執(zhí)行裝置是伺服電機(jī)和氣缸：
（1）以碼垛搬運(yùn)機(jī)械手為研究對象，設(shè)計(jì)了其自動化控制系統(tǒng)，介紹了機(jī)械手結(jié)構(gòu)圖、氣動回路、電機(jī)控制、系統(tǒng)硬件組成、以及 PLC的 I/O分配；
（2）建立控制電機(jī)模型，利用組態(tài)王軟件建立人機(jī)交互按界面，通過Matlab仿真不斷調(diào)節(jié) PID參數(shù)，得出P、PI、PD、PID控制下的伺服電機(jī)最優(yōu)控制參數(shù)和階躍響應(yīng)圖。實(shí)驗(yàn)數(shù)據(jù)結(jié)果表明，PID控制下其性能明顯提高，超調(diào)較小，穩(wěn)定時間快，具有更好的動態(tài)性能，能夠滿足設(shè)計(jì)要求。
參考文獻(xiàn)
［1］計(jì)時明，黃希歡．工業(yè)機(jī)器人技術(shù)的發(fā)展與應(yīng)用［J］．機(jī)電信息，2015（6）：1-13．
［2］駱敏舟，方?。I(yè)機(jī)器人技術(shù)發(fā)展及其應(yīng)用［J］．機(jī)械制造與自動化，2015（2）：1-13．
［3］徐寶文，陳珂．玻璃檢測機(jī)氣動系統(tǒng)控制［J］．液壓與氣動，2014（10）： 89-90．
［4］邴智剛，吳淳杰，陳鋒．鋼化玻璃碎片快速檢測裝置的設(shè)計(jì)及實(shí)驗(yàn)［J］． 化工管理，2017（5）：59-61．
［5］王從宏，萬熠，王桂森．板材下料自動拾取機(jī)器人控制系統(tǒng)設(shè)計(jì)［J］．實(shí)驗(yàn)室研究與探索，2017（4）：64-65．
［6］張強(qiáng)．料桶提升加料機(jī)構(gòu)的研究與設(shè)計(jì)［D］．南京：南京理工大學(xué)，2012．
［7］席文清，周傳俊，王志東．一種利用直線型氣缸代替擺動型氣缸的機(jī)構(gòu)［J］．金屬加工，2015（4）：40-41．
［8］李攀，昌希武，顏高彥．基板上片機(jī)的機(jī)電一體化控制系統(tǒng)［J］．中國高新技術(shù)企業(yè)，2013（17）：64-65．
［9］陳建明．自動控制理論［M］．哈爾濱：電子工業(yè)出版社，2009：52-55．
［10］石文昭．PID 控制系統(tǒng)的設(shè)計(jì)以及 MATLAB 仿真［J］．電子技術(shù)與軟件工程，2016（21）：109-110．
［11］Kayoko Hayashi，Toru Yamamoto.Closed-loop data-oriented design of a PID controller［J］.IFAC Proceedings Volumes，2012（23）.
［12］付瑞玲，樂麗琴．基于 MATLAB/Simulink 的 PID 參數(shù)整定［J］．工業(yè)控制計(jì)算機(jī)，2013（8）：75-76．
聚砜醫(yī)療干粉吸入...
塑料包裝材料的減...
汽車功能鍵觸摸蓋I...
高性能注塑聚丙烯...
