999国内精品永久免费视频,色偷偷9999www,亚洲国产成人爱av在线播放,6080亚洲人久久精品,欧美超高清xxxhd

1 引言

某醋廠灌裝生產(chǎn)線要求裝箱機(jī)器人每次抓住48瓶醋按照一定的運(yùn)動(dòng)軌跡放在兩個(gè)箱子里，由于之前的系統(tǒng)老化經(jīng)常發(fā)生故障滿(mǎn)足不了新的生產(chǎn)要求。本文采用了德國(guó)公司生產(chǎn)的同步伺服電機(jī)、伺服放大器開(kāi)發(fā)了一套新的基于PFOFIBUS的裝箱機(jī)器人控制系統(tǒng)并配備了西門(mén)子觸摸屏提供了良好的人機(jī)界面。使系統(tǒng)具有開(kāi)放性、實(shí)時(shí)性強(qiáng)，運(yùn)行和維護(hù)成本低，智能化和自動(dòng)化程度高等優(yōu)點(diǎn)，大大提高了生產(chǎn)率。

2 裝箱機(jī)器人工作原理

灌裝生產(chǎn)線上的機(jī)器人運(yùn)行在一個(gè)“∩”型的軌道上，如圖1所示。在軌道的兩端各有一個(gè)硬限位開(kāi)關(guān)，保證運(yùn)行的安全性。機(jī)器人有4種運(yùn)行模式尋參考點(diǎn)、自學(xué)習(xí)、手動(dòng)、自動(dòng)。自動(dòng)運(yùn)行模式中，機(jī)器人根據(jù)瓶子是否OK、箱子是否OK，信號(hào)自動(dòng)往復(fù)運(yùn)行于抓瓶子、放瓶子位置。抓瓶子過(guò)程中，如果瓶子OK，機(jī)器人就直接走向抓瓶位置，否則機(jī)器人將先走向平衡位置，然后等待直到瓶子。在此過(guò)程中機(jī)器人先高速運(yùn)行，在脫離speed3區(qū)時(shí)，起動(dòng)箱子傳送帶，在進(jìn)入 speed1區(qū)時(shí)，由高速轉(zhuǎn)為低速，同時(shí)停止瓶子傳送帶。放瓶子過(guò)程和抓瓶過(guò)程相似，但是由于此時(shí)機(jī)器人負(fù)重，運(yùn)行分成3段速度，分別是speed1區(qū)低速，脫離該區(qū)起動(dòng)瓶子傳送帶；speed2高速；speed3再低速，進(jìn)入該區(qū)停止箱子傳送帶。自學(xué)習(xí)模式用于每次換瓶子學(xué)習(xí)抓、放瓶位置學(xué)習(xí)后位置存儲(chǔ)在伺服放大器里，直到下次換瓶手動(dòng)一般用于排除故障。機(jī)器人的抓頭是真空吸盤(pán)式，通過(guò)控制電磁閥實(shí)現(xiàn)抓、放瓶子。系統(tǒng)運(yùn)行中，采集現(xiàn)場(chǎng)的一系列光電信號(hào)，配合機(jī)器人運(yùn)行，同時(shí)還驅(qū)動(dòng)一些現(xiàn)場(chǎng)設(shè)備如導(dǎo)向斗、擋箱、箱子傳送帶、瓶子傳送帶。

圖1 裝箱機(jī)器人工作原理示意圖

3 系統(tǒng)的硬件組成

根據(jù)灌裝生產(chǎn)線的工藝流程和控制要求我們采用了PROPFIBUS解決方案。整個(gè)系統(tǒng)由DP主站從站及現(xiàn)場(chǎng)設(shè)備組成如圖2所示，PROFIBUS主站采用 SIMATIC系列的CPU模塊。它帶有通訊口具有強(qiáng)大的處理能力并集成總線接口裝置。從站有伺服放大器通過(guò)總線接口DFP與總線相連，另外現(xiàn)場(chǎng)設(shè)備采用 ET現(xiàn)場(chǎng)模塊，通過(guò)IM接口模塊與總線連接。同時(shí)還選用了西門(mén)子TP觸摸屏可以顯示機(jī)器人運(yùn)行狀態(tài)、設(shè)置參數(shù)和手動(dòng)操作是良好的人機(jī)界面。

圖2 系統(tǒng)的硬件構(gòu)成

4 系統(tǒng)的通訊設(shè)計(jì)

SEW系列伺服放大器都集成有兩種標(biāo)準(zhǔn)的串口DP和DR，但是這種串口通信速度相對(duì)較慢實(shí)時(shí)性差。因此我們加了接口卡。PROFIBUS是目前最成功的現(xiàn)場(chǎng)總線之一，得到了廣泛的應(yīng)用。主站通過(guò)不斷給從站發(fā)請(qǐng)求報(bào)文含有控制和設(shè)置信息從站接受報(bào)文，解析地址并與自己的站地址進(jìn)行比較，如果是發(fā)給自己的信息則在規(guī)定的時(shí)間內(nèi)發(fā)響應(yīng)報(bào)文含有狀態(tài)信息等。在此過(guò)程伺服放大器還監(jiān)控通訊，如果通訊失敗，伺服放大器將觸發(fā)一個(gè)過(guò)時(shí)響應(yīng)，通知主站重發(fā)信息。響應(yīng)和請(qǐng)求報(bào)文的格式如圖3、圖4所示。

請(qǐng)求報(bào)文和響應(yīng)報(bào)文的格式相似，是以不同的起始字符來(lái)區(qū)分，請(qǐng)求報(bào)文是十六進(jìn)制“02”，響應(yīng)報(bào)文是“1D”。通過(guò)不斷循環(huán)地與伺服放大器交換過(guò)程數(shù)據(jù)來(lái)對(duì)伺服放大器進(jìn)行控制。而協(xié)議數(shù)據(jù)單元的格式很多由報(bào)文中的數(shù)據(jù)類(lèi)型決定�？紤]到本系統(tǒng)的特點(diǎn)，我們采用一個(gè)控制字加兩個(gè)過(guò)程數(shù)據(jù)的結(jié)構(gòu)，請(qǐng)求報(bào)文的數(shù)據(jù)協(xié)議由3個(gè)字組成，后兩個(gè)字是32位的定位位置，控制字的定義如,5所示，其中低字節(jié)的定義是固定的，高字節(jié)是由用戶(hù)定義的。

圖5 控制字的定義

同樣的響應(yīng)報(bào)文的數(shù)據(jù)協(xié)議也是有個(gè)3字，后兩個(gè)字是32位的實(shí)際位置，可以在人機(jī)界面上顯示。狀態(tài)字的定義如圖6所示，其中低字節(jié)是固定的高字節(jié)是由用戶(hù)定義的。

圖6 狀態(tài)字的定義

5 系統(tǒng)軟件設(shè)計(jì)

系統(tǒng)的軟件主要包括兩部分：PLC軟件和SEW伺服軟件。PLC編程語(yǔ)言為STEP7，是西門(mén)子公司開(kāi)發(fā)用于—的編程語(yǔ)言�？梢栽赪INDOWS環(huán)境下實(shí)現(xiàn)，有硬件配置和參數(shù)設(shè)置，編程，通信協(xié)議，測(cè)試、啟動(dòng)和維護(hù)、操作、診斷等功能。SEW有專(zhuān)用的MOVITOOLS軟件提供設(shè)置參數(shù)、診斷、IPOS程序編譯器等功能。伺服系統(tǒng)構(gòu)成速度、位置雙閉環(huán)控制如圖7所示。由于機(jī)器人運(yùn)行在“∩”軌道上各段受力不同，為了平衡受力，抓、放瓶過(guò)程分成多段速度。位置、速度調(diào)節(jié)器都是PI調(diào)節(jié)，為了消除抓、放瓶過(guò)程中可能出現(xiàn)的抖動(dòng)，采用在不同的速度段引人不同的PI參數(shù)。

圖7伺服雙閉環(huán)控制系統(tǒng)

每次系統(tǒng)開(kāi)機(jī)時(shí)裝箱機(jī)器人(http://www.cartoner.com.cn/)控制系統(tǒng)都會(huì)按照上一次的抓、放瓶位置進(jìn)行正常運(yùn)行。但當(dāng)瓶子的大小、形狀改變時(shí)，需要重新確定抓瓶放瓶的精確位置。自學(xué)習(xí)模式就是在每次換瓶時(shí)學(xué)習(xí)抓瓶放瓶的位置一次以后，系統(tǒng)就能自動(dòng)記住學(xué)習(xí)出的位置，直到再次換瓶子。點(diǎn)動(dòng)中當(dāng)按下“抓瓶點(diǎn)確認(rèn)”鍵，程序首先判斷當(dāng)前位置是否在自學(xué)習(xí)區(qū)域，如在即把當(dāng)前位置記下并在觸摸屏上顯示成功信息，如不在則在觸摸屏上顯示不在區(qū)域，并繼續(xù)點(diǎn)動(dòng)等待再次確認(rèn)。隨后繼續(xù)點(diǎn)動(dòng)以相似方式學(xué)習(xí)放瓶位置，學(xué)習(xí)完成自動(dòng)退出自學(xué)習(xí)模式。其流程如圖8所示。

圖8自學(xué)習(xí)模式流程圖

自動(dòng)模式流程圖見(jiàn)圖9。在自動(dòng)運(yùn)行模式中機(jī)器人根據(jù)瓶子是否OK、箱子是否OK信號(hào)自動(dòng)往復(fù)運(yùn)行于抓瓶子、放瓶子位置，不OK則到平衡位置等待直到。抓瓶子過(guò)程中，如果瓶子OK，機(jī)器人就直接走向抓瓶位置，否則機(jī)器人將先走向平衡位置，然后等待直到瓶子。在此過(guò)程中機(jī)器人先變PI參數(shù)，高速運(yùn)行在進(jìn)入 speed2區(qū)時(shí)，起動(dòng)箱子傳送帶在進(jìn)入speed1區(qū)時(shí)，由高速轉(zhuǎn)為低速，并變PI參數(shù)，同時(shí)停止瓶子傳送帶當(dāng)?shù)轿恍盘?hào)到則抓瓶。放瓶子過(guò)程分成3段速度，先是低速并變PI參數(shù)，當(dāng)進(jìn)入speed1區(qū)低速起動(dòng)瓶子傳送帶并變PI參數(shù)；speed3區(qū)再低速停止箱子傳送帶并變參數(shù)。

6 結(jié)束語(yǔ)

本系統(tǒng)成功地開(kāi)發(fā)了一套基于PROFIBUS現(xiàn)場(chǎng)總線的裝箱機(jī)器人控制系統(tǒng)。選擇了功能強(qiáng)大的伺服放大器和SEW伺服電機(jī)，增量式編碼器（旋轉(zhuǎn)變壓器）使機(jī)器人定位準(zhǔn)確�，F(xiàn)場(chǎng)執(zhí)行設(shè)備和主控通過(guò)總線通訊使系統(tǒng)實(shí)時(shí)性強(qiáng)提高了系統(tǒng)可靠性。西門(mén)子觸摸屏可以方便地顯示系統(tǒng)運(yùn)行狀態(tài)設(shè)置參數(shù)和操作。系統(tǒng)自安裝以來(lái)運(yùn)行良好抓、放瓶子過(guò)程平穩(wěn)無(wú)抖動(dòng)大大提高了灌裝生產(chǎn)線的自動(dòng)化水平。

參考文獻(xiàn)：