機(jī)器人在空調(diào)壓縮機(jī)堆垛中的應(yīng)用

雷豐順

摘要：目前國內(nèi)空調(diào)行業(yè)壓縮機(jī)的搬運(yùn)堆垛，由于工序復(fù)雜，基本都是人工搬運(yùn)堆垛。在“機(jī)器換人”的大趨勢下，如何用機(jī)器人來實(shí)現(xiàn)全自動(dòng)搬運(yùn)堆垛是自動(dòng)控制系統(tǒng)中的關(guān)鍵技術(shù)。本文介紹了一種利用機(jī)器人配合伺服夾具和視覺來實(shí)現(xiàn)針對空調(diào)壓縮機(jī)搬運(yùn)堆垛全自動(dòng)化生產(chǎn)的方法，重點(diǎn)闡述了其工藝控制原理，伺服控制以及機(jī)器人和PLC的程序設(shè)計(jì)。

關(guān)鍵詞：機(jī)器人；伺服夾具；壓縮機(jī)；PLC

1引言

在生產(chǎn)效率和產(chǎn)品質(zhì)量并舉的今天，空調(diào)壓縮機(jī)仍然采用人工搬運(yùn)，勞動(dòng)量大，工時(shí)多，無法保證碼垛質(zhì)量。同時(shí)行業(yè)“用工荒”、“高成本”等因素交織疊加在一起，壓縮了企業(yè)的盈利空間。促使企業(yè)在轉(zhuǎn)型升級中尋找新出路，市場將重新洗牌?！皺C(jī)器換人”已是大勢所趨。針對企業(yè)的需求，設(shè)計(jì)了一套伺服驅(qū)動(dòng)的夾具，通過Profibus DP總線與機(jī)器人，視覺進(jìn)行數(shù)據(jù)交互，實(shí)現(xiàn)壓縮機(jī)的高速精確堆垛的控制系統(tǒng)。

2硬件配置及控制思路

2.1硬件配置

電氣控制硬件配置如圖1所示，機(jī)器人選用的是ABB IRB6640-235。夾具由三臺(tái)Bonfiglioli的伺服驅(qū)動(dòng)器和伺服電機(jī)及兩臺(tái)用變頻器驅(qū)動(dòng)的普通電機(jī)以及氣缸組成，另外采用基恩士的視覺數(shù)據(jù)采集進(jìn)行精確定位，可編程控制器采用西門子$7317-2 PN/DP雙以太網(wǎng)帶DP接口，人機(jī)界面采用西門子的MP277系列10英寸TFT液晶顯示觸摸屏。編程軟件采用STEP7 V5.5版本和Wincc Flexible 2008 SP4版本。觸摸屏和PLC之間的通訊采用SIMATIC NET工業(yè)以太網(wǎng)形式，PLC與SEW伺服驅(qū)動(dòng)之間采用profibus DP總線通訊方式，基恩士視覺和PLC之間采用profinet實(shí)時(shí)以太網(wǎng)的通訊方式。

2.2控制思路

空調(diào)壓縮機(jī)的堆垛工藝要求先搬運(yùn)一個(gè)木底托板到搬運(yùn)位置，再取一個(gè)底層定位泡沫放置在木托板上面。再從傳輸帶上把壓縮機(jī)一個(gè)一個(gè)搬運(yùn)到泡沫固定孔，一層堆10到30個(gè)，第一層堆好后，再取一塊中間層的定位泡沫套在第一層上面，再從傳輸帶上把壓縮機(jī)一個(gè)一個(gè)搬運(yùn)到第二層的泡沫固定孔，第二層堆完后，再取一個(gè)頂部的泡沫放上去。根據(jù)工藝要求，設(shè)計(jì)的夾具上的伺服驅(qū)動(dòng)由三部分組成，兩個(gè)旋轉(zhuǎn)伺服進(jìn)行壓縮機(jī)角度的控制，一個(gè)平移驅(qū)動(dòng)控制兩個(gè)壓縮機(jī)間的間距。每個(gè)旋轉(zhuǎn)伺服下端配氣缸，控制壓縮機(jī)的抓取和放置。通過左右兩側(cè)的變頻驅(qū)動(dòng)控制勾板機(jī)構(gòu)對木托板和泡沫板進(jìn)行抓取好放置。與控制相關(guān)的數(shù)據(jù)傳輸至觸摸屏顯示。并將控制參數(shù)做成配方。通過建立不同的配方參數(shù)給不同型號的產(chǎn)品，從而實(shí)現(xiàn)一鍵切換，快速更換不同型號產(chǎn)品生產(chǎn)。

3定位控制計(jì)算原理

3.1基本數(shù)據(jù)和計(jì)算公式

兩個(gè)壓縮機(jī)的間距是靠平移伺服驅(qū)動(dòng)實(shí)現(xiàn)的。采用絕對位移的線性運(yùn)動(dòng)，下面是一些關(guān)鍵參數(shù)的計(jì)算。

外部軸一個(gè)周期是：25mm

要求的精度是：±1/100mm

脈沖當(dāng)量△S=25mm/（1/100mm）=2500，即1unit=0.01mm

設(shè)置參數(shù)1115Feed Constant為2500

速比

把參數(shù)1116設(shè)定為100，參數(shù)1117設(shè)定為1975

抓取和放置壓縮機(jī)的角度是通過兩個(gè)旋轉(zhuǎn)伺服進(jìn)行精確定位的，360°一個(gè)周期，要求的精度是：±1/10°

脈沖當(dāng)量，把參數(shù)1115設(shè)置為3600

速比

把參數(shù)1116設(shè)定為245，參數(shù)1117設(shè)定為18

機(jī)器人與PLC通過Profibus DP通訊實(shí)現(xiàn)數(shù)據(jù)交互實(shí)現(xiàn)夾具位置的控制。這里采用視覺在抓取前，先拍照，計(jì)算出與參考位置的角度和，X，Y，Z的位置值。通過Profinet以太網(wǎng)實(shí)時(shí)發(fā)給PLC，PLC處理完數(shù)據(jù)再發(fā)給機(jī)器人和伺服，依據(jù)上述位置數(shù)據(jù)調(diào)整到正確的位置。4定位控制的軟件設(shè)計(jì)

4.1機(jī)器人主要參數(shù)設(shè)置

下面列出的是一些機(jī)器人交互的關(guān)鍵數(shù)據(jù)。

通道參數(shù)：-Name"FUNCTION"-SignalType"GI"-Unit"PROFIBUS4"-UnitMap"224-239"

抓取點(diǎn)X坐標(biāo)：-Name"PICK_X"-SignalType"GI"-Unit"PROFIBUS4"-UnitMap"416-431"

抓取點(diǎn)Y坐標(biāo)：-Name"PICK_Y"-SignalType"GI"-Unit"PROFIBUS4"-UnitMap“432-447”

抓取點(diǎn)Z坐標(biāo)：-Name"PICK_Z"-SignalType"GI"-Unit"PROFIBUS4"-UnitMap"304-319"

機(jī)器人姿態(tài)：-Name"PostureNUM"-SignalType"GI"-Unit"PROFIBUS4"-UnitMap"96-111"

驅(qū)動(dòng)伺服信號：-Name"Q_SERVOPOS"-SignalType"DO"-Unit"PROFIBUS4"-UnitMap"22"

旋轉(zhuǎn)伺服1位置：-Name"T1_SERVOPOS"-SignalType"DO"-Unit"PROFIBUS4"-UnitMap"320-335"

旋轉(zhuǎn)伺服2位置：-Name"T2_SERVOPOS"-SignalType"DO"-Unit"PROFIBUS4"-UnitMap"336-351"

平移伺服位置：-Name"T2_SERVOPOS"-SignalType"DO"-Unit"PROFIBUS4"-UnitMap"352-367"

設(shè)置通訊方式為DP，地址為4：-Name"PROFIBUS4"-UnitType"DP_SLAVE_FA"-Bus"Profibus_FAl"-PB-Address 4

設(shè)置工具坐標(biāo)：TASK PERS tooldata tGripper：=[TRUE，[[0，0，950]，[1.0，0，0]]，[130，[0，0，250]，[1，0，0，0]，0，0，0]]

設(shè)置負(fù)載參數(shù)：TASK PERS loaddata IBOX：=[40，[0，0，800]，[1，0，0，0]，0，0，0]

4.2PLC程序設(shè)計(jì)

控制系統(tǒng)以PLC做主站，包含機(jī)器人，視覺，旋轉(zhuǎn)伺服1，旋轉(zhuǎn)伺服2和平移伺服共5個(gè)從站。

通過PQ和PI指令，實(shí)現(xiàn)從站和PLC主站之間的數(shù)據(jù)交互。

下面以從站伺服旋轉(zhuǎn)1為例給出交互數(shù)據(jù)的程序。伺服的P01通道設(shè)定為控制字2，P02通道設(shè)定為速度值，P03設(shè)定為位置，P11通道設(shè)為狀態(tài)字，P12通道設(shè)為實(shí)際位置，下面是伺服通道與PLC地址映射的程序。

LMW100//控制字，通過不同的位，進(jìn)行邏輯編程，實(shí)現(xiàn)控制伺服

TPQW100//對應(yīng)伺服的P01通道

LMWl02//速度，PLC給伺服的運(yùn)行速度

TPQW10//對應(yīng)伺服的P02通道

LMD10//位置，PLC給伺服的位置

TPQD104//對應(yīng)伺服的P03通道

LPIW100//伺服的狀態(tài)，對應(yīng)伺服的P11

TMW120//將讀出的狀態(tài)，寄存到MW120

LPID104//對應(yīng)伺服的P12，伺服的當(dāng)前位置值

TMD130//將伺服的當(dāng)前位置值寄存到MD130

在對機(jī)器人進(jìn)行配置時(shí)，使用16位（一個(gè)字）進(jìn)行通訊，西門子一個(gè)字中的兩個(gè)字節(jié)要倒轉(zhuǎn)一下。高字節(jié)變成低字節(jié)。這里以機(jī)器人的X坐標(biāo)通訊程序?yàn)槔?/p>

LMB300//PLC發(fā)給機(jī)器人的X坐標(biāo)值的低8位

TPQB301//對應(yīng)機(jī)器人X坐標(biāo)值通道的高8位

LMB301//PLC發(fā)給機(jī)器人的X坐標(biāo)值的高8位

TPQB300//對應(yīng)機(jī)器人×坐標(biāo)值通道的低8位

5結(jié)語

該套控制系統(tǒng)經(jīng)過反復(fù)調(diào)試，已經(jīng)在格力空調(diào)投入使用，在實(shí)際生產(chǎn)中經(jīng)過了嚴(yán)格的驗(yàn)證，精度控制在毫米級，精簡了企業(yè)的用工，簡化了企業(yè)的管理，提高了企業(yè)的生產(chǎn)效率，降低了耗材的損耗，實(shí)現(xiàn)了自動(dòng)化生產(chǎn)，解決了壓縮機(jī)生產(chǎn)中的一大瓶頸。

參考文獻(xiàn)：

[1]葉暉.工業(yè)機(jī)器人典型應(yīng)用案例精析[M]機(jī)械工業(yè)出版社

[2]廖常出.S7-300/400PLC應(yīng)用技術(shù)[M].機(jī)械工業(yè)出版社.