PLC在倉庫碼垛機(jī)中的設(shè)計應(yīng)用(已讀)

1、目錄摘要第一章 緒論 11.1自動化立體倉庫的概述 11.1.1自動化立體倉庫的組成 11.1.2自動化立體倉庫的優(yōu)點 21.1.3自動化立體倉庫的發(fā)展 21.2 碼垛機(jī)的概述 21.2.1碼垛機(jī)的發(fā)展 31.2.2碼垛機(jī)研究技術(shù)的現(xiàn)狀 3第二章 碼垛機(jī)控制系統(tǒng)的硬件設(shè)計 42.1控制技術(shù)要求和系統(tǒng)總體設(shè)計42.2碼垛機(jī)的位置控制52.2.1定位控制62.2.2認(rèn)址檢測方式 62.2.3認(rèn)址方式確認(rèn) 72.2.4碼垛機(jī)速度曲線分析 82.3 PLC及資源配置 82.3.1S7-200系列PLC概述 92.3.2CPU型號選擇 92.3.3PLC模塊選擇 102.4碼垛機(jī)變頻調(diào)速系統(tǒng)設(shè)計 112

2、.4.1變頻器選型 112.4.2水平方向變頻調(diào)速系統(tǒng)設(shè)計 112.4.3垂直方向變頻調(diào)速系統(tǒng)設(shè)計 132.5碼垛機(jī)貨叉控制系統(tǒng)設(shè)計142.6安全檢測傳感器的應(yīng)用152.7通信方案的確定162.8輸入輸出點的分配16第三章 碼垛機(jī)程序控制設(shè)計 183.1碼垛機(jī)自檢和復(fù)位/歸位程序203.1.1碼垛機(jī)自檢程序 203.1.2碼垛機(jī)復(fù)位/歸位程序 213.2自動方式下的碼垛機(jī)運行控制 213.2.1初始化程序設(shè)計 223.2.2運行方式選擇程序 233.2.3自動控制中的尋址定位233.3手動方式下的碼垛機(jī)運行控制 253.3.1手動控制中的尋址定位程序 253.3.2手動方式下的貨叉運行控制 2

3、63.4步進(jìn)電機(jī)驅(qū)動程序 27結(jié)束語 28致 謝29附 錄30參考資料 32PLC在倉庫碼垛機(jī)中的設(shè)計應(yīng)用271.2.2碼垛機(jī)技術(shù)的研究現(xiàn)狀按現(xiàn)行機(jī)械行業(yè)標(biāo)準(zhǔn)，有軌巷道式碼垛機(jī)分類方式很多，如按支承方式、用途、控制方式、結(jié)構(gòu)、運行軌跡等分類。無論何種類型的碼垛機(jī)一般都由水平行走機(jī)構(gòu)、起升機(jī)構(gòu)、載貨臺及貨叉機(jī)構(gòu)、機(jī)架和電氣設(shè)備等基本部分組成。體現(xiàn)碼垛機(jī)動態(tài)性能優(yōu)劣的指標(biāo)主要有：運行速度、提升速度、貨叉速度、平穩(wěn)性、認(rèn)址精度等。隨著科學(xué)技術(shù)的不斷進(jìn)步，自動化立體倉庫的技術(shù)水平和倉儲機(jī)械設(shè)備的動態(tài)性能也在不斷提高。例如，碼垛機(jī)的運行驅(qū)動己由20世紀(jì)70年代的子母電動機(jī)改為變頻調(diào)速，速度由550m/m

4、in提升至4160m/min，國外小載重量的碼垛機(jī)最高可達(dá)300m/min；提升驅(qū)動己由20世紀(jì)70年代的雙速電動機(jī)改進(jìn)為變頻調(diào)速，速度由416m/min提升至025m/min；貨叉運行也由單速電動機(jī)驅(qū)動改進(jìn)為變頻調(diào)速，速度由8m/min提升至435m/min；在碼垛機(jī)自動控制方面還采用閉環(huán)控制變頻調(diào)速系統(tǒng)、Profibus總線控制等先進(jìn)技術(shù)。盡管如此，目前國產(chǎn)碼垛機(jī)的運行速度最高仍保持在160m/min；提升速度在080m/min；貨叉速度一直保持在030m/min；認(rèn)址采用光電探測，精度不足，認(rèn)址出錯率高。第二章 碼垛機(jī)控制技術(shù)的硬件設(shè)計2.1控制技術(shù)要求和系統(tǒng)總體設(shè)計（1）本系統(tǒng)中碼垛機(jī)

5、運行機(jī)構(gòu)由水平運行的行走機(jī)構(gòu)，垂直運行的起升機(jī)構(gòu)及取送貨的伸叉機(jī)構(gòu)三部分組成。水平部分運動電機(jī)和垂直部分運動電機(jī)分別采用220W的三相交流異步電動機(jī)和200W的單相交流異步電動機(jī)，由西門子S7-200PLC通過變頻器進(jìn)行控制。伸叉機(jī)構(gòu)電機(jī)采用兩相混合式步進(jìn)電機(jī)，由西門子S7-200通過步進(jìn)電機(jī)驅(qū)動器進(jìn)行控制。由碼垛機(jī)運行機(jī)構(gòu)特點及工作要求可知，能否保證碼垛機(jī)的穩(wěn)定工作，關(guān)鍵在碼垛機(jī)的三維位置移動定位的精確性。主要技術(shù)指標(biāo)和和主要設(shè)計參數(shù)碼垛機(jī)運行的速度范圍：水平方向：2m/min360m/min；垂直方向：2m/min80/min；貨叉：2m/min60/min （2）本文碼垛機(jī)的控制方式有自

6、動和手動控制。 手動方式通過碼垛機(jī)的轉(zhuǎn)換開關(guān)及按鈕控制碼垛機(jī)水平和提升運動及貨叉伸縮。同時運動速度也可以手動選擇。手動操作時，系統(tǒng)應(yīng)給予相應(yīng)的警示信號，同時系統(tǒng)將解除大部分的保護(hù)控制。手動操作主要用于安裝、調(diào)試和排除故障。 單機(jī)自動用人機(jī)界面對碼垛機(jī)進(jìn)行全自動的控制，控制系統(tǒng)根據(jù)用戶輸入的參數(shù)進(jìn)行全自動的取送貨動作。界面操作時，應(yīng)具備對貨物的單送、單取操作。人機(jī)界面應(yīng)具備實時顯示設(shè)備運行工況，故障及歷史故障查詢等功能。（3）在本文設(shè)計的碼垛機(jī)控制系統(tǒng)中上位機(jī)完成的只是數(shù)據(jù)輸入和傳送，主要的控制任務(wù)是由PLC來完成。 作業(yè)命令處理：確定作業(yè)狀態(tài)時自動還是手動；確定作業(yè)指令是存貨入庫還是取貨出庫；

7、確定作業(yè)地址包括列地址和層地址。 位置技術(shù)及判斷：沿著碼垛機(jī)的行進(jìn)方向和載貨臺的升降方向設(shè)置認(rèn)址片，PLC通過檢測認(rèn)址片來判斷碼垛機(jī)位置和載貨臺的位置，每經(jīng)過一個認(rèn)址片，PLC的高速計數(shù)器就自動計數(shù)一次，前進(jìn)加一，后退減一，上升加一，下降減一。到達(dá)預(yù)定位置后，碼垛機(jī)停車。 速度調(diào)整和準(zhǔn)確停車：根據(jù)碼垛機(jī)和目標(biāo)位置的距離，PLC輸出速度調(diào)整的控制信號給變頻器，通過變頻器控制電機(jī)的轉(zhuǎn)速，在停車之前先把碼垛機(jī)的運行速度降低到低速檔，使碼垛機(jī)以低速接近目標(biāo)位置，保證碼垛機(jī)的穩(wěn)定性。 作業(yè)任務(wù)的順序邏輯控制：按照入庫、出庫的作業(yè)順序，確定各輸出點的得電狀態(tài)，完成作業(yè)順序的邏輯控制。 安全保護(hù)：水平行走、

8、載貨臺升降及貨叉的伸縮等都有限位保護(hù)。 PLC還有工作故障報警功能。本系統(tǒng)由上位監(jiān)控級與直接控制級組成。監(jiān)控級對通訊、流程進(jìn)行控制，并進(jìn)行實時圖像顯示，直接控制級是由PLC(可編程序控制器)組成的控制系統(tǒng)對各設(shè)備進(jìn)行單機(jī)自動操作。采用組態(tài)系統(tǒng)建立監(jiān)控界面，同時將運行系統(tǒng)的狀態(tài)反饋到監(jiān)控計算機(jī)。碼垛機(jī)采用西門子公司的S7-200型PLC控制，與變頻器結(jié)合對碼垛機(jī)進(jìn)行變頻調(diào)速。系統(tǒng)結(jié)構(gòu)拓?fù)鋱D如圖2.1所示。監(jiān)控計算機(jī)碼垛機(jī)貨叉控制系統(tǒng)碼垛機(jī)水平變頻系統(tǒng)碼垛機(jī)縱向變頻系統(tǒng)碼垛機(jī)貨叉運行機(jī)構(gòu)碼垛機(jī)水平運行機(jī)構(gòu)碼垛機(jī)縱向運行機(jī)構(gòu)碼垛機(jī)限位保護(hù)系統(tǒng)碼垛機(jī)貨物檢測系統(tǒng) S7-200 PLC碼垛機(jī)縱向認(rèn)址系統(tǒng)

9、碼垛機(jī)水平認(rèn)址系統(tǒng)圖2.1 系統(tǒng)結(jié)構(gòu)圖2.2碼垛機(jī)位置控制由碼垛機(jī)的作業(yè)流程分析，碼垛機(jī)是由水平運行機(jī)構(gòu)、縱向起升機(jī)構(gòu)和貨叉伸縮機(jī)構(gòu)三部分組成的，水平運行機(jī)構(gòu)和垂直起升機(jī)構(gòu)使碼垛機(jī)到達(dá)目標(biāo)位置，貨叉伸縮機(jī)構(gòu)完成存取貨任務(wù)。要完成對碼垛機(jī)自動控制系統(tǒng)的設(shè)計，首先要保證碼垛機(jī)能夠準(zhǔn)確到達(dá)目標(biāo)位置，所以在設(shè)計碼垛機(jī)自動控制系統(tǒng)時，關(guān)鍵在于準(zhǔn)確可靠的認(rèn)址和定位保證碼垛機(jī)準(zhǔn)確無誤的定位在目標(biāo)貨位。另外為了提高存取效率和保證碼垛機(jī)的穩(wěn)定性，必須對碼垛機(jī)三個機(jī)構(gòu)的速度進(jìn)行合理有效的控制，其中速度位置檢測是碼垛機(jī)自動控制系統(tǒng)的關(guān)鍵部分。碼垛機(jī)速度位置控制的實現(xiàn)方法如圖2.2所示，控制系統(tǒng)由PLC控制器、調(diào)速系

10、統(tǒng)、編碼器、認(rèn)址片和認(rèn)址器組成，實現(xiàn)位置和速度的雙閉環(huán)控制。M調(diào)速系統(tǒng)認(rèn)址器控制器輸入編碼器速度檢測 位置檢測 圖2.2 碼垛機(jī)位置速度控制框圖2.2.4碼垛機(jī)速度曲線分析常見的速度運行曲線有三種，分別為三角形與梯形速度曲線、拋物線與直線形速度曲線、正弦形速度曲線。本文采用最常用的梯形速度曲線。如圖2.4所示，梯形速度曲線碼垛機(jī)以加速度啟動加速，當(dāng)勻加速到最大運行速度時，保持該速度運行一段時間，再以勻減速運行，直到零速?？俊?VABCS1S2S3S圖2.4 梯形速度曲線2.3.3PLC的模塊選型由于S7-200-CPU226的集成24輸入/16輸出不能滿足設(shè)計的要求，所以又選用了EM221擴(kuò)展

11、模塊和EM235擴(kuò)展模塊，正好滿足設(shè)計的需要。所選模塊型號如表2-2所示。表2-2 擴(kuò)展模塊選型表系列號類別描述選型型號數(shù)量EM221輸入擴(kuò)展模塊DI166ES7221-1BH22-0XA01EM235輸入/輸出擴(kuò)展模塊AI4/AO16ES7235-0KD22-0XA02由于CPU226的輸入點只有24個，不能滿足設(shè)計的輸入點的需要，所以加入一個EM221模塊，該模塊有16個數(shù)字輸入點，總體上可以滿足系統(tǒng)輸入的要求。另外加入兩個EM235模擬量輸入/輸出模塊是為控制水平和垂直運行的交流電機(jī)。系統(tǒng)總體結(jié)構(gòu)圖如2.5所示：圖2.5 系統(tǒng)總體結(jié)構(gòu)圖2.4碼垛機(jī)變頻調(diào)速系統(tǒng)設(shè)計為了實現(xiàn)碼垛機(jī)的準(zhǔn)確定位

12、，提高存取效率和保證碼垛機(jī)的穩(wěn)定性，必須對碼垛機(jī)三個機(jī)構(gòu)的速度進(jìn)行合理有效的控制，由于水平和垂直運行電機(jī)分別采用三相交流異步電動機(jī)和單相交流異步電動機(jī)，所以對這兩個方向的速度控制采用閉環(huán)變頻調(diào)速控制。2.4.1變頻器的選型（1） 變頻器的概念變頻器的工作原理是通過改變交流電頻率方式實現(xiàn)交流電的控制。變頻器的電路一般由整流、中間直流環(huán)節(jié)、逆變和控制4個部分組成。整流部分為三相橋式不可控整流器，逆變部分為IGBT三相橋式逆變器，且輸出為PWM波形，中間直流環(huán)節(jié)為濾波、直流儲能和緩沖無功率。（2） 變頻器的選型本文根據(jù)綜合考慮選擇西門子MM440變頻器，MM440型使用PID控制器，具PID微調(diào)等功

13、能，MM440可用于矢量控制，可以實現(xiàn)高性能的應(yīng)用，帶內(nèi)置制動單元，可以快速制動。MM440變頻器各項參數(shù)指標(biāo)如下：輸入電壓：3相380VAC，50Hz。輸入電流：2.8A。輸出功率：0.75KW。輸出電壓：3相(0-380)VAC可調(diào)。輸出頻率：(0-650)Hz可調(diào)。輸出電流：2.1。輸出控制：變頻器由微機(jī)處理器控制絕緣柵雙極型晶體管(IGBT)的脈沖寬度調(diào)制頻率，實現(xiàn)輸出電壓、頻率可調(diào)?？刂谱饔茫?，矢量轉(zhuǎn)矩、光電編碼器反饋的速度控制等。數(shù)字量輸入：6路帶隔離的數(shù)字量輸入。數(shù)字量輸出：8路繼電器輸出。模擬量輸入：2路(010) 模擬量輸入。模擬量輸出：2路(020) 模擬量輸出。通訊接口：

14、RS485通訊、USS協(xié)議。操作功能：AOP盤、BOP控制盤、電位器與外接端子操作。2.4.2水平方向變頻調(diào)速系統(tǒng)設(shè)計水平行走電機(jī)采用220W的三相交流異步電動機(jī)，運行速度要求為2m/min360m/min，系統(tǒng)采用轉(zhuǎn)速閉環(huán)控制方式。S7-200PLC的模擬量輸出信號作為MM440變頻器的模擬量輸入，來控制變頻器輸出頻率和輸出電壓的變化，從而控制三相異步電動機(jī)的運行；電動機(jī)轉(zhuǎn)速由光電編碼器檢測并反饋到PLC得高速計數(shù)口I1.4和I1.5，構(gòu)成閉環(huán)變頻調(diào)速系統(tǒng)。系統(tǒng)方框圖如圖2.6所示，為速度給定量，為PLC輸出的控制量，為變頻器輸出電壓，為被控量，控制算法為PID。擾動三相異步電動機(jī)（負(fù)載系統(tǒng)

15、）變頻器主電路（IGBT逆變器） PLC控制器（PID算法）- 光電編碼器反饋圖2.6 PLC變頻調(diào)速閉環(huán)系統(tǒng)結(jié)構(gòu)圖（1）運用指令系統(tǒng)中的PID指令，偏差信號按照PID算法計算出控制量，用傳送指令輸出電壓控制量到變頻器的模擬量輸入AIN1口。（2）運用指令系統(tǒng)中的HDEF、HSC指令，進(jìn)行高速計數(shù)中斷程序設(shè)計，高速計數(shù)器設(shè)為HSC0和模式9，增計數(shù)，實時采集并存儲光電編碼器反饋的A、B兩相正交脈沖數(shù)。（3）在上位機(jī)監(jiān)控系統(tǒng)中，實時測取系統(tǒng)各參數(shù)和輸出特性，并能在上/下位機(jī)進(jìn)行系統(tǒng)控制。（4）采用模塊化程序結(jié)構(gòu)設(shè)計出控制程序，包括主程序、子程序和中斷程序。采用帶傳感器矢量控制閉環(huán)調(diào)速，能滿足像碼

16、垛機(jī)這樣動態(tài)特性要求較高，并且在低頻時輸出高轉(zhuǎn)矩以及轉(zhuǎn)速精度要求較高的場合。由于碼垛機(jī)在工作過程中是頻繁啟動和停車的，在高速運行的狀態(tài)下還要求碼垛機(jī)能夠快速精準(zhǔn)地停在目的地，因此在制動方面采用了動能制動，將電動機(jī)運行在發(fā)電狀態(tài)下所回饋的能量消耗在制動電阻中，從而達(dá)到快速停車的目的。變頻器參數(shù)設(shè)定如表2-3所示。 表2-3 變頻器參數(shù)設(shè)定參數(shù)號 設(shè)定值 功能說明P0003 3 專家模式，使能讀/寫所有參數(shù) P0004 0全參數(shù) P0700 2 外部按鈕或上位機(jī)啟動/停止系統(tǒng) P1000 2上位機(jī)或PLC程序給定設(shè)定 P1300 1帶磁通電流的V/f控制方式 P2010 6通訊波特率設(shè)為9600

17、P2011 0MM440變頻器通訊地址2.4.3垂直方向變頻調(diào)速系統(tǒng)設(shè)計垂直運行電動機(jī)采用200W的單向交流異步電動機(jī)，運行速度要求為2m/min80m/min。垂直方向變頻調(diào)速系統(tǒng)與水平方向變頻調(diào)速系統(tǒng)結(jié)構(gòu)相似，但是由于單相異步電動機(jī)和三相異步電動機(jī)有所區(qū)別，所以垂直變頻調(diào)速系統(tǒng)和水平變頻調(diào)速系統(tǒng)也有不同的地方。從結(jié)構(gòu)上看單相異步電動機(jī)與三相籠型異步電動機(jī)相似，其轉(zhuǎn)子也為籠型，只是釘子繞組為單相工作繞組，但通常為起動的需要，定子上除了工作繞組外，還設(shè)有起動繞組，它的作用是產(chǎn)生起動轉(zhuǎn)矩，一般只在起動時接入，當(dāng)轉(zhuǎn)速達(dá)到70%80%的同步轉(zhuǎn)速時，由離心開關(guān)將其從電源自動切除，所以正常工作時只有工作

18、繞組在電源上運行。但也有一些電容或電阻電動機(jī)，在運行時將起動繞組接于電源上，這實質(zhì)上相當(dāng)于一臺兩相電機(jī)，但由于它接在單相電源上，故稱為單相異步電動機(jī)。圖2.7是電容分組式單相異步電動機(jī)原理圖。圖2.7 電容分組式單相異步電動機(jī)原理圖1 工作繞組；2起動繞組K離心式開關(guān)；C電容器 單相異步電動機(jī)的突出特點是沒有啟動轉(zhuǎn)矩和固定的轉(zhuǎn)向。為此要設(shè)置啟動裝置，以及電機(jī)中產(chǎn)生一個與主磁場在空間和時間上不同相得磁場，從而形成一定大小的旋轉(zhuǎn)磁場以產(chǎn)生啟動轉(zhuǎn)矩。單相交流電動機(jī)的變頻調(diào)速與三相交流電動機(jī)的變頻調(diào)速不同，將單相220V輸入、三相輸出的變頻器的三個輸出端子（U、V、W），接任意兩端。輸出單相變頻調(diào)速電

19、源在輸出端上串上一個足夠電感量的電感，用于隔離電動機(jī)電容對變頻器的危害作用（同時對變頻器的高載波率起到一定的濾波作用），并保護(hù)電動機(jī)電容，此電路只適用于小功率單相電容運轉(zhuǎn)式和罩極式電動機(jī)，不適用于帶離心開關(guān)的單相電動機(jī)。另外，變頻器的輸出電壓和電動機(jī)的輸出電壓相匹配，變頻器要留有足夠的容量（應(yīng)比電動機(jī)的使用功率大三倍）。串聯(lián)的電感要有足夠的電感量和通過電流的流量，電感的磁性材料應(yīng)與變頻器的載波率相匹配。變頻器和單相電容式運轉(zhuǎn)電動機(jī)的接線如圖2.8所示。圖2.8 變頻器與單相電容式運轉(zhuǎn)電動機(jī)的接線圖2.7通信方案的確定為了控制無人運轉(zhuǎn)碼垛機(jī)，必須向碼垛機(jī)發(fā)送運轉(zhuǎn)和作業(yè)的信息。一個指令執(zhí)行完了之后

20、，必須從碼垛機(jī)向地面發(fā)送響應(yīng)信號，即確認(rèn)信號，之后才能執(zhí)行下一個指令。碼垛機(jī)的信息傳遞順序是：碼垛機(jī)首先接受的作業(yè)信息是從什么地方取貨，之后把它存入什么貨位。碼垛機(jī)控制盤在收到作業(yè)信息之后向地面控制盤發(fā)出響應(yīng)信息。碼垛機(jī)根據(jù)作業(yè)信息進(jìn)行作業(yè)。作業(yè)完了之后，向地面發(fā)出“作業(yè)結(jié)束”信息。這樣把一系列作業(yè)進(jìn)行完了之后，成為等待下一個作業(yè)信息的待機(jī)狀態(tài)。串行通信中最常用的物理層協(xié)議為RS-232C和RS-485。本文采用RS-485標(biāo)準(zhǔn)。主要基于以下兩點考慮：（1） RS-232C接口標(biāo)準(zhǔn)只能用于點對點的通信，而RS-485能實現(xiàn)多點對多點的通信。RS-485允許平衡電纜上連接32個發(fā)送器/接收器。立

21、體倉庫控制系統(tǒng)要求監(jiān)控系統(tǒng)和3臺碼垛機(jī)控制系統(tǒng)連接，要求物理層的協(xié)議必須支持一點對多點的通信。（2） RS-485采用差動發(fā)送/接收，所以共模抑制比高，抗干擾能力強(qiáng)。立體倉庫的工作環(huán)境較惡劣，熱、電、磁等干擾信號較多，要求通信網(wǎng)絡(luò)的抗干擾能力較強(qiáng)，才能保證數(shù)據(jù)的正確接收。RS-485標(biāo)準(zhǔn)除上述優(yōu)點外，還具有傳輸速率高、傳輸距離遠(yuǎn)等優(yōu)點。由于PLC帶有串行通信接口，只需用RS-485總線分別連接到計算機(jī)即可，可見系統(tǒng)的構(gòu)建十分簡單。當(dāng)需要增加新設(shè)備時，只需要將新設(shè)備也連接到計算機(jī)，系統(tǒng)的擴(kuò)展也較容易。為了利用計算機(jī)帶有的RS-232接口與下層的各個模塊通信，在計算機(jī)上需要安裝232-485轉(zhuǎn)換器

22、。2.8輸入輸出點的分配碼垛機(jī)控制系統(tǒng)采用的PLC是S7-200 CPU226，總共使用了所有的24個輸入點和11個輸出點，具體I/O點分配如表2-4所示碼垛機(jī)控制系統(tǒng)使用擴(kuò)展I/O模塊EM221，其I/O分配表如表2-5 。擴(kuò)展模塊EM235是模擬量4輸入/1輸出模塊，在本文所設(shè)計的控制系統(tǒng)中，只用到兩個擴(kuò)展模塊EM235的輸出通道MO、VO，接變頻器MM440的端口3和4。表2-4 PLC（CPU226）輸入輸出I/O點分輸入部分輸出部分I0.0十六進(jìn)制顯示鍵盤值1位Q0.0機(jī)械手控制脈沖I0.1鍵盤值2位Q0.1機(jī)械手方向改變I0.2鍵盤值3位Q0.2升降臺上升I0.3鍵盤值4位Q0.3

23、升降臺下降I0.4機(jī)械手到位限位Q0.4小車向前運動I0.5機(jī)械手回位限位Q0.5小車向后運動I0.6貨臺是否有物Q0.6存物指示燈I0.7自動/手動（1/0）Q0.7取物指示燈I1.0小車前限Q1.1BCD輸出顯示BCD碼1位I1.1小車后限Q1.2BCD碼2位I1.2升降臺上限Q1.3BCD碼3位I1.3升降臺下限Q1.4BCD碼4位I1.4層尋址1Q1.5小車停止向前運動I1.5層尋址2Q1.6小車停止向后運動I1.6列尋址1Q2.0手動時層到位指示燈I1.7列尋址2Q2.1手動時列到位指示燈表2-5 EM 221模塊I/O點分配1水平左限位I3.09縱向認(rèn)址下對準(zhǔn)I4.02水平右限位I

24、3.110左端歪斜傳感器I4.13垂直上限位I3.211右端歪斜傳感器I4.24垂直下限位I3.312左探有貨傳感器I4.35水平前對準(zhǔn)I3.413右探有貨傳感器I4.46水平認(rèn)址計數(shù)I3.514低速按鈕I4.57縱向認(rèn)址上對準(zhǔn)I3.615中速按鈕I4.68縱向認(rèn)址計數(shù)I3.716高速按鈕I4.7第三章 碼垛機(jī)程序控制設(shè)計S7-200可編程控制器主要使用STEP7-Micro/WIN32編程軟件進(jìn)行編程和其它一些相關(guān)處理。STEP7-Micro/WIN 32編程軟件是基于Windows的應(yīng)用軟件，由西門子公司專為SIMATIC S7-200系列可編程控制器設(shè)計開發(fā)，功能強(qiáng)大，主要由用戶用來開發(fā)

25、控制程序，同時也可以實時監(jiān)控用戶程序執(zhí)行狀態(tài)。它提供三種編輯器來創(chuàng)建你的程序：梯形圖、語句表和功能塊圖。用任何一種程序編寫程序，都可以用另外一種程序編輯器來瀏覽和編輯，但要遵守一些輸入規(guī)則。語句表編輯器按照文本語言的形式顯示程序，此編輯器允許你輸入指令助記條款來創(chuàng)建你的控制程序。本文設(shè)計的碼垛機(jī)控制系統(tǒng)采用手動和自動兩種操作方式，其中自動又有自動入庫和自動出庫兩種工作狀態(tài)。（1）自動：由操作員在下層控制臺輸入貨單，發(fā)出運行命令，碼跺機(jī)根據(jù)貨單和命令自動運行完成任務(wù)，實現(xiàn)甩手操作。（2）手動：由操作員親自駕駛碼跺機(jī)進(jìn)行取貨和放貨操作，其中可以操作貨叉的升降、伸縮，碼跺機(jī)的上升下降，前進(jìn)，后退操作

26、，來完成貨單任務(wù)。程序采用模塊化的方式進(jìn)行編寫，最后再將程序的各個部分集成為能完成完整功能的完整的程序。系統(tǒng)采用中間信號來實現(xiàn)對具體運行動作的控制，從而更準(zhǔn)確更安全的完成作業(yè);并采用指示燈在現(xiàn)場指示系統(tǒng)具體的工作狀態(tài)，并將工作信息寫入到內(nèi)存中，方便上位機(jī)對碼跺機(jī)系統(tǒng)的運行進(jìn)行實時的監(jiān)視。圖3.1是系統(tǒng)主程序流程圖向上位機(jī)上傳碼垛機(jī)狀態(tài)執(zhí)行送貨子程序執(zhí)行手動操作子程序碼垛機(jī)運行方式選擇開始系統(tǒng)上電取貨任務(wù)執(zhí)行取貨子程序送貨任務(wù)碼垛機(jī)自檢子程序.手動方式自動方式Y(jié)NNY圖3.1 主程序流程圖3.1碼垛機(jī)自檢和復(fù)位/歸位程序3.1.1碼垛機(jī)自檢程序碼垛機(jī)每次開機(jī)上電時，PLC系統(tǒng)通電，然后執(zhí)行用戶編

27、寫的功能模塊程序。PLC系統(tǒng)上電后，首先執(zhí)行圖3.2碼垛機(jī)自檢程序。碼垛機(jī)自檢子程序主要是判斷上次系統(tǒng)是否正常關(guān)機(jī)，如果屬于非正常關(guān)機(jī)，碼垛機(jī)有無不安全因素（貨叉是否在收叉位置，載貨臺上有無貨物，貨位位置是否正常等），如果存在不安全因素，碼垛機(jī)開始報警，等待故障處理。如果正常關(guān)機(jī)，則判斷碼垛機(jī)工作模式。在手動操作模式下，執(zhí)行手動操作子程序。在自動模式下，則由碼垛機(jī)機(jī)載控制柜上的觸摸屏操作下發(fā)作業(yè)任務(wù)。存在不安全因素?上次安全關(guān)機(jī)?故障報警，等待故障處理結(jié)束檢測貨叉位置及貨叉負(fù)載檢測安全關(guān)機(jī)標(biāo)志位開始YNNY圖3.2 碼垛機(jī)自檢子程序流程圖3.1.2碼垛機(jī)復(fù)位/歸位程序當(dāng)碼跺機(jī)在運行過程中出現(xiàn)錯

28、誤時(如認(rèn)址認(rèn)數(shù)器計數(shù)錯誤等)，若不及時糾正，就會使倉庫管理出現(xiàn)混亂，所以就需要系統(tǒng)能通過控制按鈕方便的恢復(fù)系統(tǒng)的部分?jǐn)?shù)據(jù)或設(shè)置，及時恢復(fù)系統(tǒng)的正常運行。根據(jù)不同錯誤的嚴(yán)重情況，設(shè)立系統(tǒng)歸位和系統(tǒng)復(fù)位兩種方式。碼跺機(jī)復(fù)位程序流程圖如圖3.3所示。當(dāng)按下歸位按鈕超過3s碼跺機(jī)開始在水平與垂直兩個方向同時以中速返回原位。當(dāng)碼跺機(jī)經(jīng)過強(qiáng)制限速點時，強(qiáng)制為低速，直到運動到原位停止。到達(dá)原位后，復(fù)位計數(shù)器；當(dāng)水平與垂直兩個方向均到達(dá)原位后，歸位動作完成。若重新啟動被按下超過3s，系統(tǒng)會執(zhí)行初始化程序，對系統(tǒng)的各個內(nèi)存區(qū)及自由端口進(jìn)行重新定義，同時，系統(tǒng)會啟動返回原位程序，以重新設(shè)定計數(shù)器的當(dāng)前值；若不需

29、要碼跺機(jī)歸位，則可以再松開重新啟動按鈕后，再短按一次重新啟動按鈕(小于3s)，就可停止系統(tǒng)回歸原位。歸位按鈕按下重啟信號啟動初化、歸位程序結(jié)束返回原位重啟信號定時到？計時時間到？NYYN到達(dá)原位/重啟按鈕按下？NY圖3.3 復(fù)位程序流程圖 3.2 自動方式下的碼垛機(jī)運行控制碼垛機(jī)執(zhí)行自動入庫作業(yè)的初始條件為碼垛機(jī)位于入庫口，升降臺位于最下位置，入庫臺車在碼垛機(jī)前進(jìn)方向的右邊，車上有貨物，碼垛機(jī)貨叉上無貨物。操作開始先在上位機(jī)的監(jiān)控界面上輸入待入庫目標(biāo)貨位的列、層數(shù)，選擇入庫動作，然后按下運行鍵，系統(tǒng)開始執(zhí)行入庫作業(yè)。于是碼垛機(jī)向入庫口的貨位伸叉,伸叉到位后貨叉向上托起，托到貨物后碼垛機(jī)收叉，然

30、后貨叉托著貨物回到貨叉中位，貨叉停止，載著貨物的碼垛機(jī)向目的貨位移動，到達(dá)目的貨位之后檢測目標(biāo)貨位是否有貨，如無貨碼垛機(jī)向入庫目標(biāo)貨位伸叉，伸叉到位后貨叉下降，將貨物放到貨位上后碼垛機(jī)收叉，然后貨叉回到貨叉中位，貨叉停止，碼垛機(jī)返回到入庫口位置待命，準(zhǔn)備下一次作業(yè)。出庫的作業(yè)順序與入庫的作業(yè)順序類似。3.2.1初始化程序設(shè)計這段程序主要是對所需的計數(shù)器、寄存器進(jìn)行初始化復(fù)位。網(wǎng)絡(luò)1和2是對兩個計數(shù)器進(jìn)行復(fù)位，其中計數(shù)器C2是對輸入的倉庫號的列數(shù)進(jìn)行計數(shù)，C3是對輸入倉庫號的層數(shù)進(jìn)行計數(shù)。網(wǎng)絡(luò)3中VW100,VW102分別放置輸入的列數(shù)和層數(shù)，VB100中放置鍵盤的十六進(jìn)制輸入值。 3.2.2運

31、行方式選擇程序當(dāng)I0.7得電時，選擇自動方式，然后調(diào)用自動子程序（SBR_0），I0.7失電時，即選擇了手動運行方式，然后調(diào)用手動子程序（SBR_1）。3.2.3自動控制中的尋址定位自動控制子程序中的網(wǎng)絡(luò)，采用兩對光電開關(guān)來定位，當(dāng)兩對同時閉合時，說明已經(jīng)到達(dá)所到的列或?qū)?。網(wǎng)絡(luò)11，C2中的計數(shù)脈沖數(shù)和VW100中輸入的倉庫的列數(shù)進(jìn)行比較，相等時說明已經(jīng)到達(dá)列，小車停止前進(jìn)，到達(dá)列標(biāo)志M30.0。網(wǎng)絡(luò)12，C3中的計數(shù)脈沖數(shù)和VW102中輸入的倉庫的層數(shù)進(jìn)行比較，相等時說明已經(jīng)到達(dá)層，升降臺停止上升，到達(dá)層標(biāo)志M30.1。 網(wǎng)絡(luò)13中，當(dāng)列和層都到位時，調(diào)用步進(jìn)電機(jī)子程序，機(jī)械手前伸取/放貨物

32、。M30.2是取/放完成標(biāo)志，當(dāng)取放完成時，手臂縮回（如網(wǎng)絡(luò)14），并置動作完成標(biāo)志M30.3。3.3 手動方式下的碼垛機(jī)運行控制3.3.1手動控制中的尋址定位手動控制子程序中，手動運動時經(jīng)過每一列或?qū)訒r指示燈都會亮（網(wǎng)絡(luò)1中Q2.0Q2.1分別接層/列顯示燈），燈亮后才可以伸縮機(jī)械手臂（見網(wǎng)絡(luò)2中）。3.3.2手動方式下的貨叉運行控制手動方式下貨叉的運行控制是分步進(jìn)行的，貨叉的任何兩個動作均不聯(lián)動。程序流程圖如3.4所示。 圖3.4 手動方式貨叉運行程序圖3.4步進(jìn)電機(jī)驅(qū)動程序?qū)?6#85送給SMB67是設(shè)置PTO的控制字節(jié)，選擇PTO方式，時基為1us。然后設(shè)置周期為50us,脈沖數(shù)為70

33、000個。當(dāng)動作完成時，完成標(biāo)志M30.3置1，然后返回起點。結(jié)束語碼垛機(jī)是立體倉庫的主要輸送設(shè)備，同時也是提高整個倉庫運行效率的關(guān)鍵所在。本文設(shè)計了碼垛機(jī)的電控系統(tǒng)，針對碼垛機(jī)運行速度與認(rèn)址精度的要求，圍繞碼垛機(jī)運行系統(tǒng)的性能提升展開一系列的工作。同時本文主要完成了以下幾個方面的內(nèi)容：（1）依據(jù)設(shè)計立體倉庫的有關(guān)參數(shù)，對碼垛機(jī)電氣控制的硬件系統(tǒng)進(jìn)行了設(shè)計。采用了激光測距傳感器在水平方向認(rèn)址，提高了碼垛機(jī)的認(rèn)址精度及行系統(tǒng)的可靠性，為以后運行速度的提升奠定了基礎(chǔ)。同時在水平和垂直方向采用閉環(huán)控制方式，實現(xiàn)高速運行、換速平穩(wěn)、低速停準(zhǔn)的控制要求。簡單介紹了系統(tǒng)的通信協(xié)議和方式，并設(shè)置了相應(yīng)的安全保護(hù)措施。 （2）設(shè)計運行了系統(tǒng)在不同工作方式下的控制流程，應(yīng)用Step7編程軟件編寫了主要運行動作的PLC程序。PLC的運用及其程序的簡化，縮短了系統(tǒng)掃描周期，使碼垛機(jī)的控制運行更方便，動作更加簡單、準(zhǔn)確。但是盡管如此本設(shè)計系統(tǒng)還是存在很多需要改進(jìn)的地方，