基于FANUC Mate 200iD工業(yè)機器人工作站的智能工具庫系統(tǒng)設計

韓宇，嚴成武，郭付龍，楊波

基于FANUC Mate 200iD工業(yè)機器人工作站的智能工具庫系統(tǒng)設計

韓宇，嚴成武，郭付龍，楊波

（深圳技師學院 中德智造學院，廣東 深圳 518000）

以FANUC Mate 200iD工業(yè)機器人工作站為基礎，開發(fā)了一套工業(yè)機器人用智能工具庫系統(tǒng)。介紹了該智能工具庫系統(tǒng)的總體方案與工作原理，其機械裝置設計主要包括總體結(jié)構設計與末端執(zhí)行器（工具）定位，控制系統(tǒng)設計包括系統(tǒng)通訊設計與程序設計。完成了整個智能工具庫系統(tǒng)的安裝與調(diào)試。該智能工具庫系統(tǒng)能夠在PLC的控制下轉(zhuǎn)動工位并實現(xiàn)準確定位。為工業(yè)機器人準備好放置工具的位置，將工業(yè)機器人需要的末端執(zhí)行器旋轉(zhuǎn)至更換位，工業(yè)機器人運動并完成末端執(zhí)行器的智能化快速更換，提升整個工作站的工作效率。

FANUC；工業(yè)機器人；智能工具庫

隨著技術的發(fā)展，工業(yè)機器人的應用場合越來越廣泛，以工業(yè)機器人為主要設備的工作站應運而生。工業(yè)機器人工作站中往往包含了多種工序，由于工業(yè)機器人的末端執(zhí)行器（即工具）的互換性較差，因此工業(yè)機器人在完成不同工序時，通常需要更換不同的末端執(zhí)行器，為此，每個工作站上需要準備多套末端執(zhí)行器。工業(yè)機器人每完成一道工序，則需要更換下一道工序所用的末端執(zhí)行器。為實現(xiàn)快速更換末端執(zhí)行的目的，通常采用在工業(yè)機器人末端軸與末端執(zhí)行器之間安裝氣動快換機構的方法。工業(yè)機器人工作站中，末端執(zhí)行器為分散放置，不僅占用工作站的有限空間，而且在編寫工業(yè)機器人工作程序時，每一個末端執(zhí)行器都需要示教至少兩個點位，大大增加了程序編寫的難度和程序的長度，并導致后期工業(yè)機器人運行時需要更多的時間來完成末端執(zhí)行器的更換，降低了工作站的生產(chǎn)效率。為解決上述問題，設計一套工業(yè)機器人用智能工具庫系統(tǒng)具有十分重要的意義。

目前，國內(nèi)外關于工業(yè)機器人智能工具庫的研究較少，常見工具庫只有簡單的放置功能，不具備智能化更換的作用。崔華飛等[1-2]采用Arduino開發(fā)平臺，開發(fā)出基于視覺的Sawyer機器人的智能化快換工具庫，但該快換工具庫造價昂貴，不利于大范圍推廣。為此，本文設計一套以PLC（Programmable Logic Controller，可編程邏輯控制器）為控制單元的智能工具庫系統(tǒng)，為工業(yè)機器人系統(tǒng)集成提供技術參考。

1 系統(tǒng)總體方案

1.1 系統(tǒng)組成

本文設計的工業(yè)機器人智能工具庫系統(tǒng)以FANUC Mate 200iD工業(yè)機器人工作站為基礎，由工業(yè)機器人本體、工作站外圍設備、I/O模塊、PLC、步進電機、智能工具庫機械裝置、傳感器等組成。總體方案如圖1所示。

在該工業(yè)機器人智能工具庫系統(tǒng)中，工業(yè)機器人通過I/O模塊與控制單元PLC交換信息，PLC根據(jù)工業(yè)機器人的指令控制智能工具庫機械裝置自動運行，實現(xiàn)智能化更換末端執(zhí)行器的設計意圖。

圖1 工業(yè)機器人智能工具庫系統(tǒng)總體方案

1.2 系統(tǒng)工作原理

該工業(yè)機器人智能工具庫系統(tǒng)的設計采用了計算機通訊技術、電器及自動化控制技術、機械設計與制造技術、傳感器技術等[3-6]。其工作流程如圖2所示。當工業(yè)機器人運行程序，發(fā)出放置或抓取末端執(zhí)行器指令時，工業(yè)機器人系統(tǒng)通過I/O模塊對外發(fā)出請求信號，智能工具庫系統(tǒng)控制單元PLC收到請求信號后，運行梯形圖程序，驅(qū)動步進電機旋轉(zhuǎn)。智能工具庫機械裝置在步進電機的驅(qū)動下旋轉(zhuǎn)，當PLC收到回零傳感器信號后，機械裝置停止旋轉(zhuǎn)，完成智能工具庫回零動作。接著，PLC依據(jù)收到的請求信號（不同的工具放置位對應不同的信號），驅(qū)動步進電機旋轉(zhuǎn)，帶動智能工具庫機械裝置旋轉(zhuǎn)至所需的工具放置位/抓取位。PLC輸出工具放置位/抓取位到位信號，工業(yè)機器人收到到位信號后運行程序，運動到智能工具庫機械裝置工具放置位/抓取位上方，對準其所需工位，通過氣動快換裝置放置或抓取工具，完成放置/抓取末端執(zhí)行器工作。

圖2 工業(yè)機器人智能工具庫系統(tǒng)工作流程

上述工作流程中，工業(yè)機器人只需示教定位兩個較為準確的工作點位，即取放置/抓取末端執(zhí)行器和等待放置/抓取末端執(zhí)行器兩個精準點位，大大簡化示教編程的難度，有效減少程序的長度，同時提高工業(yè)機器人的工作效率。

2 智能工具庫機械裝置設計

智能工具庫機械裝置是整個智能工具庫系統(tǒng)的重要硬件組成，是放置工業(yè)機器人工具的硬件平臺。按照整個工業(yè)機器人智能工具庫系統(tǒng)的功能要求，智能工具庫機械裝置應具備旋轉(zhuǎn)和精準定位功能，能夠放置若干個工業(yè)機器人工具。

2.1 智能工具庫機械裝置總體結(jié)構

如圖3所示，工業(yè)機器人智能工具庫系統(tǒng)機械裝置上有6個工具放置位，呈360°均勻分布，可以同時放置6個不同種類的末端執(zhí)行器（工具）。智能工具庫機械裝置主要由步進電機、減速機、聯(lián)軸器、電機固定箱體、推力軸承、掛裝板等組成。工業(yè)機器人末端執(zhí)行器通過定位銷和定位面放置在掛裝板上，以使各個工位旋轉(zhuǎn)到位后氣動快換法蘭盤的重復定位精度滿足更換要求。

圖3 智能工具庫系統(tǒng)機械裝置結(jié)構

工業(yè)機器人智能工具庫系統(tǒng)機械裝置采用SolidWorks 2019軟件設計。整個裝置傳動鏈結(jié)構簡單，采用步進電機加精密行星減速機直接驅(qū)動的方式，驅(qū)動智能工具庫旋轉(zhuǎn)部分組件旋轉(zhuǎn)，從而實現(xiàn)不同工具位的旋轉(zhuǎn)換位[7]。使用的精密行星減速機和步進電機均為臺灣峰樺科技有限公司生產(chǎn)。其中，精密行星減速機結(jié)構為二級傳遞，減速比16，傳動效率94%；步進電機為ABCH280-4C60S型號的二相開環(huán)步進電機，額定扭矩4.5 N·m，轉(zhuǎn)動慣量1800 g·cm2。

2.2 末端執(zhí)行器（工具）定位

智能工具庫系統(tǒng)工作時，由于工業(yè)機器人抓取或放置末端執(zhí)行器的位置是固定的，而智能工具庫有6個工位，為保證智能工具庫系統(tǒng)每個工位都能精準對接工業(yè)機器人放置或抓取末端執(zhí)行器示教點，需要對智能工具庫系統(tǒng)中工具放置位進行精準定位。

智能工具庫系統(tǒng)中，采用PLC、步進電機、精密減速機、傳感器構成閉環(huán)控制的方式實現(xiàn)周向定位[8-9]。當智能工具庫旋轉(zhuǎn)時，PLC收到傳感器的到位信號后，迅速控制步進電機實現(xiàn)精準停止，從而實現(xiàn)周向定位。

為保證智能工具庫系統(tǒng)能夠正常工作，除了周向定位，還需保證末端執(zhí)行器在每個工位中的精準定位。如圖4所示，工業(yè)機器人末端執(zhí)行器（工具）的定位面分為定位A面、定位B面、定位C面。在智能工具庫機械裝置中，每個工位的掛裝板上都裝配有兩個圓柱定位銷，并在掛裝板上設計有U型定位面。工業(yè)機器人末端執(zhí)行器（工具）的定位A面與掛裝板的U型定位面配合，兩個圓柱定位銷分別與工業(yè)機器人末端執(zhí)行器（工具）的定位B面和C面配合定位，從而實現(xiàn)工業(yè)機器人末端執(zhí)行器（工具）在每個工位中的精準定位。

3 控制系統(tǒng)設計

3.1 系統(tǒng)通訊

智能工具庫系統(tǒng)基于FANUC Mate 200iD工業(yè)機器人工作站，采用SIMATIC S7-1200 PLC為控制單元，通過工業(yè)機器人與PLC組態(tài)實現(xiàn)工業(yè)機器人與控制單元之間的通訊[10-11]。

工業(yè)機器人智能工具庫系統(tǒng)調(diào)試現(xiàn)場如圖5所示。FANUC Mate 200iD工業(yè)機器人和智能工具庫通過通訊電纜連接，其中靠近工業(yè)機器人端的信號線連接在I/O接線板上，靠近智能工具庫端的連接在SIMATIC S7-1200 PLC的輸入/輸出端子排上。

FANUC Mate 200iD工業(yè)機器人與SIMATIC S7-1200 PLC I/O配置通訊協(xié)議如表1所示。

表1 工業(yè)機器人與PLC I/O配置通訊協(xié)議表

表1中，工業(yè)機器人抓取/放置的請求信號為機器人對外輸出信號，1～6號工位的輸出信號分別對應DO103～DO108，這6個信號與控制單元SIMATIC S7-1200 PLC的輸入信號I1.0～I1.6對應；刀庫回零到位信號DI102和刀庫準備就緒信號DI101為FANUC Mate 200iD工業(yè)機器人輸入等待信號，分別與控制單元SIMATIC S7-1200 PLC的輸出信號Q1.0和Q1.1對應。

圖5 智能工具庫系統(tǒng)實物圖

3.2 程序設計

程序是整個工業(yè)機器人智能工具庫系統(tǒng)正常工作的關鍵要素。工業(yè)機器人智能工具庫程序主要包括控制單元PLC的梯形圖程序和工業(yè)機器人運行抓取或放置工具的程序[12-13]，二者之間通過約定的信號地址實現(xiàn)信息交互，以實現(xiàn)整個智能庫系統(tǒng)的智能化工作。

工業(yè)機器人智能工具庫系統(tǒng)放置工具時，控制單元PLC的梯形圖程序架構邏輯關系流程圖如圖6所示?？刂茊卧狿LC收到工業(yè)機器人放置工具指令后，控制智能工具庫機械裝置旋轉(zhuǎn)至工具放置位，并輸出到位信號給工業(yè)機器人[14-16]，工業(yè)機器人收到到位信號后運行自身程序，完成放置工具動作。

FANUC Mate 200iD工業(yè)機器人請求抓取智能工具庫6號工位工具程序為：

1:J @PR[1:HOME] 100% FINE; 機器人回HOME點；

2: DO[102:OFF] =ON ; 機器人對外輸出信號102打開；

3: WAIT 2.0(sec); 等待2秒鐘；

4: DO[102:OFF] =OFF ; 機器人對外輸出信號102關閉；

5: WAIT 8.00(sec); 等待8秒鐘；

6: DO[108:OFF] =ON ; 機器人對外輸出信號108打開；

7: WAIT 2.0(sec); 等待2秒鐘；

8: DO[108:OFF] =OFF ; 機器人對外輸出信號108關閉；

9:J @PR[1:HOME] 100% FINE; 機器人回HOME點；

10: J P[1] 100% FINE; 機器人運動到P1點；

… …

37: J P[3] 15% FINE; 機器人運動到P3點；

38: J P[2] 100% FINE; 機器人運動到P2點；

39: J @PR[1:HOME] 100% FINE; 機器人運動到HOME點；

[End] 結(jié)束；

圖6 智能工具庫放置工具程序流程圖

4 結(jié)論

為解決工業(yè)機器人工作站多種末端執(zhí)行器分散放置造成使用不便的痛點，構建出一種能夠?qū)崿F(xiàn)智能化快速更換末端執(zhí)行器的方法，并依據(jù)該方法，設計并搭建基于FANUC Mate 200iD工業(yè)機器人工作站的智能工具庫系統(tǒng)。本項目以PLC為控制單元，通過I/O模塊與工業(yè)機器人進行信號交互，控制智能工具庫機械裝置精準定位，實現(xiàn)工業(yè)機器人快速智能化更換末端執(zhí)行器。

該工業(yè)機器人智能工具庫系統(tǒng)穩(wěn)定可靠、性價比突出，適合融入工業(yè)機器人工作站及其應用產(chǎn)線中。

[1]崔華飛. 基于Sawyer機器人的智能化快換工具庫研究[D]. 煙臺大學，2021.

[2]白蕾，張小潔，侯偉. 基于工業(yè)機器人的智能生產(chǎn)線設計與開發(fā)[J]. 工業(yè)儀表與自動化裝置，2018（3）：69-72.

[3]侯志剛，張云海，胡斌，等. 協(xié)作機器人抓握式柔性夾持器設計[J]. 現(xiàn)代制造工程，2021（5）：47-52.

[4]候帥. 多自由度機器人搬運平臺調(diào)平控制系統(tǒng)研究[D]. 西安：長安大學，2017.

[5]袁培江，陳冬冬，王田苗，等. 基于雙目視覺測量系統(tǒng)的孔位補償研究[J]. 航空制造技術，2018，61（4）：41-46.

[6]張偉豪. 基于機器視覺的氣門無序擺放抓取系統(tǒng)的研究[D]. 鄭州：鄭州大學，2021.

[7]王亞龍. 基于SVM標定算法的氣門視覺抓取系統(tǒng)研究[D]. 鄭州：鄭州大學，2020.

[8]劉坤. 基于PLC的開放式工業(yè)機器人運動控制教學平臺研究與實現(xiàn)[D]. 杭州：杭州電子科技大學，2022.

[9]胡艷琳. 基于PLC控制的物料檢測分類放置工業(yè)機器人系統(tǒng)研究與設計[D]. 石家莊：河北科技大學，2020.

[10]劉彬. 基于PLC的工業(yè)搬運機器人運動控制系統(tǒng)研究[D]. 唐山：華北理工大學，2020.

[11]何東明. 基于機器人和PLC的玻璃磨邊自動化控制系統(tǒng)設計[D]. 宜昌：三峽大學，2020.

[12]黃信兵，劉小娟，李春貴. 基于Profinet的切削加工單元智能化改造設計與應用[J]. 機床與液壓，2022，50（10）：124-128.

[13]孟靜靜，郝睿，王惠卿，等. 基于PLC與工業(yè)機器人的自動生產(chǎn)線智能包裝系統(tǒng)設計[J]. 制造技術與機床，2021（11）：63-67.

[14]周文婷，孟凡文，王海亮. 基于MODBUS-TCP協(xié)議的視覺系統(tǒng)、PLC與工業(yè)機器人通信設計[J]. 電子世界，2020（21）：132-133，137.

[15]韓宇，何善印，鄭泳洋，等. 一種工業(yè)機器人的智能工具庫系統(tǒng)：CN115284334A[P]. 2022-11-04.

[16]王哲祿. 基于PLC與工業(yè)機器人的拋光打磨工作站控制系統(tǒng)的設計與實現(xiàn)[J]. 制造業(yè)自動化，2019，41（7）：103-105，147.

Design of Intelligent Tool Library System Based on FANUC Mate 200iD Industrial Robot Workstation

HAN Yu，YAN Chengwu，GUO Fulong，YANG Bo

(Sino-German College of Intelligent Manufacturing, Shenzhen Institute of Technology, Shenzhen 518000, China )

Based on the FANUC Mate 200iD industrial robot workstation, this paper studies and develops an intelligent tool library system for industrial robots. The overall scheme and working principle of the intelligent tool library system were introduced. The mechanical device design mainly includes the overall structure design and end effector (tool) positioning, while the control system design includes system communication design and program design. The installation and debugging of the entire intelligent tool library system has been completed. The system can rotate the station and achieve accurate positioning under the control of PLC, prepare the position for the industrial robot to place tools, and rotate the required end actuator to the replacement position. Industrial robots move and complete the intelligent and rapid replacement of the end actuator, and the working efficiency of the entire work station has been improved.

FANUC；industrial robot；intelligent tool library

TP242.2

A

10.3969/j.issn.1006-0316.2023.10.013

1006-0316 (2023) 10-0075-06

2023-02-13

深圳技師學院校級科研項目——工業(yè)機器人智能工具庫關鍵技術研究（2211016）

韓宇（1985－），男，河南南陽人，碩士，高級工程師，主要研究方向為數(shù)控技術、工業(yè)機器人技術等，E-mail：925060536@qq.com。