李庭貴

（瀘州職業(yè)技術(shù)學院，瀘州 646005）

0 引言

步進電機是一種將電脈沖轉(zhuǎn)換為角位移或直線運動的執(zhí)行設(shè)備。在非超載的情況下，電機轉(zhuǎn)速和停止位置只取決于脈沖信號的頻率和脈沖數(shù)，而不受負載變化的影響，因此步進電機廣泛應(yīng)用于精密控制場合[1]。

自動化立體倉庫也稱立庫，是在不直接進行人工參與的情況下自動地存儲和取出物料的系統(tǒng)，采用高層貨架存儲貨物，用專門的倉儲作業(yè)設(shè)備進行貨物出入庫作業(yè)。其具體功能是：在接收工位接收送料單元送來的工件，按照工件信息而自動運送至相應(yīng)倉位，并將工件推入立體倉庫指定位置存儲。

1 系統(tǒng)總體設(shè)計

1.1 系統(tǒng)結(jié)構(gòu)設(shè)計

立體倉庫存儲系統(tǒng)主要由PLC控制模塊、步進驅(qū)動模塊、絲桿驅(qū)動模塊、工件推出模塊、立體倉庫、氣源處理組件等部件組成。系統(tǒng)結(jié)構(gòu)示意圖如圖1所示。

1.2 精確定位原理

PLC每發(fā)出一個脈沖，步進電機轉(zhuǎn)動一個步距角度，X軸步進電機帶動X軸絲桿做左右直線運動或Z軸步進電機帶動Z軸絲桿做上下直線運動，實現(xiàn)載物臺的上、下、左、右運動。通過控制X軸、Z軸步進電機的脈沖個數(shù)，就可以控制載物臺在X軸、Z軸上移動的距離，實現(xiàn)載物臺在X—Z軸平面的精確定位，從而把物體放到倉庫的指定位置。當PLC輸出5000個脈沖時，平移距離為3.125cm（平移距離=步距角×脈沖個數(shù)×螺距/360o），輸出脈沖為10000時平移距離理論值為6.25cm。

2 系統(tǒng)硬件設(shè)計

2.1 PLC控制模塊

立體倉庫精確定位存儲控制系統(tǒng)選用西門子S7-200系列的CPU 224 CN作為控制器。它有24個I/O點（14輸入點，10個輸出點出），具有體積小、功能強、性價比高等優(yōu)點，而且具有高速脈沖輸出（PTO）功能，可以驅(qū)動步進電機運動。

系統(tǒng)硬件控制接線圖如圖2所示。

2.2 步進驅(qū)動模塊

步進驅(qū)動模塊由步進電機和步進驅(qū)動器組成。倉庫立體存儲系統(tǒng)有兩套步進驅(qū)動模塊，分別控制X軸、Z軸的絲桿運動。

圖1 立體倉庫精確定位存儲控制系統(tǒng)結(jié)構(gòu)示意圖

圖2 立體倉庫存儲系統(tǒng)硬件控制接線圖

步進驅(qū)動器接收PLC發(fā)出的高速脈沖信號及方向電平信號，并將這些信號轉(zhuǎn)換成驅(qū)動步進電機的信號。步進電機旋轉(zhuǎn)方向由方向電平控制；步進電機旋轉(zhuǎn)速度由脈沖信號的頻率控制；步進電機旋轉(zhuǎn)角度由脈沖信號的數(shù)目控制。

選用四相步進電機42J1834-810，與之配套的驅(qū)動器選用美國IMS公司生產(chǎn)的M415B細分型步進電機驅(qū)動器，其細分功能使步進電機運轉(zhuǎn)精度提高，振動減小，雜訊降低，且具有光隔離信號輸入（抗干擾），靜止時電流減半，電源接反保護功能等優(yōu)點。

42J1834-810 步進電機步距角為1.8o，即在無細分的條件下，200個脈沖使步進電機轉(zhuǎn)一圈（200×1.8=360o）。通過驅(qū)動器設(shè)置細分精度，最高可以達到12800個脈沖電機轉(zhuǎn)一圈。步進電機驅(qū)動器M415B細分設(shè)定由撥碼開關(guān)SW4、SW5、SW6設(shè)定，如表1所示。設(shè)置SW4=ON、SW5= OFF、SW6=ON，細分設(shè)置為800步數(shù)/圈，即800個脈沖使步進電機轉(zhuǎn)一圈，此時步距角為（800×0.45=360o）。

步進電機傳動組件采用聯(lián)軸器直接帶動螺旋絲杠轉(zhuǎn)動，螺旋絲杠的螺距為5mm，即步進電機每轉(zhuǎn)動一周，載物臺位移5mm。通過控制載物臺在X-Z軸平面的運動，從而把工件運送到倉庫的指定位置。

步進電機驅(qū)動器M415B輸出相電流設(shè)定由撥碼開關(guān)SW1、SW2、SW3設(shè)定，如表2所示。設(shè)置SW1=OFF、SW2=ON、SW3=OFF，輸出相電流為1.05A。

表1 步進電機驅(qū)動器M415B細分設(shè)定表

表2 步進電機驅(qū)動器M415B輸出相電流設(shè)定表

圖3 立體倉庫存儲系統(tǒng)氣動控制原理圖

表3 立體倉庫精確定位存儲系統(tǒng)I/O端口分配表

2.3 絲桿驅(qū)動模塊

絲桿驅(qū)動模塊是將步進電機輸出的旋轉(zhuǎn)運動轉(zhuǎn)換成直線往復(fù)運動，兩套絲桿驅(qū)動模塊成90度垂直安裝，形成一個X-Z軸的平面運動系統(tǒng)。在兩個絲桿驅(qū)動模塊上均設(shè)有一個零點，用以校正位置及提供一個位置參考點。同時為了防止絲杠驅(qū)動模塊過沖而產(chǎn)生機械物理損傷，在絲桿驅(qū)動模塊的極限位置均裝有碰撞保護開關(guān)，用來防止絲桿驅(qū)動模塊過沖。

2.4 工件推出模塊

工件推出模塊采用氣動控制系統(tǒng)作為執(zhí)行機構(gòu)，1A為雙作用氣缸，1B1和1B2為磁感應(yīng)式接近開關(guān)，判斷氣缸的運動位置。1Y1為兩位五通電磁換向閥控制雙作用氣缸的運動，立體倉庫存儲系統(tǒng)的氣動控制原理圖如圖3所示。

3 系統(tǒng)軟件設(shè)計

3.1 I/O口分配

立體倉庫精確定位存儲控制系統(tǒng)的PLC I/O口分配表如表3所示。

3.2 程序設(shè)計

軟件采用模塊化設(shè)計方法，主要由主程序、Q0.0（控制X軸電機）輸出脈沖子程序、Q0.1（控制Z軸電機）輸出脈沖子程序等模塊組成。

3.2.1 主程序設(shè)計

主程序首先檢測絲杠的運動方向，裝入脈沖串值，然后調(diào)用Q0.0（控制X軸電機）輸出脈沖子程序、Q0.1（控制Z軸電機）輸出脈沖子程序，并判斷脈沖串輸出是否完成，最后判斷定位是否完成。主程序流程圖如圖4所示。

3.2.2 Q0.0、Q0.1輸出脈沖子程序設(shè)計

表4 多段PTO操作的包絡(luò)表設(shè)置

圖4 主程序流程圖

S7-200CPU提供兩個高速脈沖輸出點（Q0.0和Q0.1），通過PLC編程控制脈沖的周期（頻率）和個數(shù)，利用脈沖輸出指令（PLS），通過PTO編程，可在高速脈沖輸出點（Q0.0和Q0.1）上控制脈沖串輸出，從而驅(qū)動步進電機運動。

圖5 Q0.0（控制X軸）輸出脈沖子程序流程圖

圖6 Q0.1（控制Z軸）輸出脈沖子程序流程圖

PTO編程步驟：1）設(shè)置PTO/PW控制字；2）寫入周期值；3）寫入脈沖串計數(shù)值；4）連接中斷事件、中斷服務(wù)程序，允許中斷；5）執(zhí)行PLS指令，對PTO進行編程。

設(shè)置PTO控制字（允許PTO多段操作模式）和設(shè)置多段PTO操作包絡(luò)表，控制Q0.0、Q0.1輸出脈沖串，如表4所示。

通過PLC的Q0.0輸出脈沖串，控制X軸步進電機運動，Q0.0（控制X軸）輸出脈沖子程序流程圖如圖5所示。

通過PLC的Q0.1輸出脈沖串，控制Z軸步進電機運動，Q0.1（控制Z軸）輸出脈沖子程序流程圖如圖6所示。

4 結(jié)束語

詳細介紹了本系統(tǒng)的總體結(jié)構(gòu)、硬件設(shè)計和軟件設(shè)計。側(cè)重闡述了采用西門子S7-200系列的 CPU-224 PLC，輸出PTO脈沖信號控制X—Z軸平面的M415B步進電機驅(qū)動器，驅(qū)動步進電機42J1834-810運動，從而帶動X—Z軸平面的絲桿轉(zhuǎn)動，推動載物臺上、下、左、右移動，實現(xiàn)了載物臺在X—Z軸平面的精確定位控制，把物體存儲到立體倉庫的指定位置。實踐表明，該系統(tǒng)運行穩(wěn)定流暢，效果良好。

本系統(tǒng)以自動化立體倉庫為研究對象，其方法、原理和技術(shù)可擴展到機械、冶金、化工、航空航天、電子、醫(yī)藥、食品加工、煙草、印刷、配送中心、機場、港口等行業(yè)，具有一定的工程實際意義和實用價值，具有廣闊的應(yīng)用前景。

[1] 黃會雄.一種智能視頻監(jiān)控體系結(jié)構(gòu)設(shè)計方案[J].微計算機信息,2007,6-1:115-117.

[2] 章國華,蘇東.典型生產(chǎn)線原理、安裝與調(diào)試(西門子PLC版本)[M].北京:北京理工大學出版社,2009.

[3] 陶權(quán),韋瑞錄.PLC控制系統(tǒng)設(shè)計、安裝與調(diào)試[M].北京:北京理工大學出版社,2009.