王 靖,周 瑜,莊文密,吳嘯波,許興淼
WANG Jing,ZHOU Yu,ZHUANG Wen-mi,WU Xiao-bo,XU Xing-miao
(江蘇科技大學(xué) 電氣與信息工程學(xué)院,張家港 215600)
隨著國內(nèi)物流業(yè)以及制造業(yè)的不斷發(fā)展,物料以及貨品的運輸量也在急劇增長,并且對于智能化的要求也越來越高。傳統(tǒng)的人工分揀與搬運模式已不能滿足新形勢的要求,因此更加高效智能的貨品搬運處理方式逐漸成為了一個主流的研究方向[1]。利用先進的控制方式以及智能化的處理方案,可以在物流搬運這一環(huán)節(jié)進行突破與創(chuàng)新。
其中,以PLC為核心的控制系統(tǒng)憑借其穩(wěn)定性以及其對各種現(xiàn)場的適應(yīng)程度而被廣泛使用,并且以嵌入式技術(shù)為核心的智能系統(tǒng)可以對應(yīng)用現(xiàn)場的相關(guān)信息進行處理,比如圖像識別、狀態(tài)監(jiān)測、云端處理等。本文希望通過PLC與嵌入式技術(shù)的結(jié)合,保證搬運系統(tǒng)的承載能力與穩(wěn)定性的同時,加入智能化功能,使得系統(tǒng)更加人性化并且符合技術(shù)發(fā)展的潮流。
智能物料搬運系統(tǒng)主要由硬件部分的多維搬運平臺以及控制部分的西門子S7-200 PLC和負責(zé)進行信息智能化處理的STM32嵌入式系統(tǒng)組成,總體框圖如圖1所示。通過PLC作為搬運平臺運動的主控制器,設(shè)有自動、手動、調(diào)試三個模式以適應(yīng)用戶不同需求[2]。在手動模式下,搬運平臺在步進電機、絲桿以及電推桿等裝置的驅(qū)動下根據(jù)用戶按鈕指令進行前后滑動、左右平移以及上下升降等工作;在自動模式下,STM32通過外接攝像頭對貨物信息進行圖像提取與二值化處理后根據(jù)對不同特征值的判斷反饋不同信號給PLC從而驅(qū)動搬運平臺到達對應(yīng)位置、自動進行物料的收??;調(diào)試模式下,用戶可逐一測試步進電機、直流電機、電動推桿以及相關(guān)傳感器的工作狀態(tài),方便維護。
圖1 系統(tǒng)總體框圖
在本文設(shè)計的硬件系統(tǒng)中,以西門子S7-200 PLC作為控制器,主要實現(xiàn)搬運平臺的運動系統(tǒng)的控制,搬運平臺的機械結(jié)構(gòu)如圖2所示。在X軸方向采用步進電機驅(qū)動滾珠絲桿以可設(shè)定的速度轉(zhuǎn)動從而帶動平臺進行滑動,行程為2米;在Y軸方向通過直流電機的正反轉(zhuǎn)配合齒輪與齒條的嚙合實現(xiàn)左右雙向的伸縮,以進行兩側(cè)物料的取放;在Z軸方向上通過電動推桿以及氣彈簧的支撐實現(xiàn)平臺的上升與下降[3],以進行不同目標高度的物料的取放。同時,用于進行物料信息圖像識別的攝像頭固定在來料位置,通過STM32F103VET6處理器進行不同物料的特征值提取與處理。
圖2 搬運平臺機械結(jié)構(gòu)示意圖
本文設(shè)計選用西門子S7-200-224XP PLC,該機自帶兩個高速脈沖輸出口,符合系統(tǒng)設(shè)計中多段速控制步進電機的電氣需求。此外,該型號PLC自帶10點I/O信號輸出、14點輸入。根據(jù)系統(tǒng)控制要求,共需要X個數(shù)字量輸入點、Y個數(shù)字量輸出點以及Z個高速脈沖輸出點,具體輸入輸出分配如表1所示。
表1 輸入輸出分配表
采用時代超群57系列帶編碼器全閉環(huán)步進電機,帶有1000P的編碼器實現(xiàn)全面閉環(huán)來防止丟步。同時,運行過程中可實現(xiàn)最大轉(zhuǎn)矩4N.M,最高轉(zhuǎn)速2000轉(zhuǎn)。經(jīng)過研究對比,該電機采用了基于反饋編碼器的空間矢量電流控制算法和矢量平滑濾波技術(shù),對困擾傳統(tǒng)步進電機的低頻共振有很好的抵制作用。
滾珠絲桿主要功能是將旋轉(zhuǎn)運動轉(zhuǎn)換成線性運動,同時兼具高精度、可逆性和高效率的特點。機構(gòu)硬件結(jié)構(gòu)圖如圖3所示,通過聯(lián)軸器連接步進電機與絲桿,PLC脈沖輸出驅(qū)動電機以不同速度轉(zhuǎn)動后絲桿將轉(zhuǎn)動轉(zhuǎn)變?yōu)橹本€運動,帶動搬運平臺的前后滑動。此外,對于平臺行進的速度可由按鈕信號或者觸摸屏給定信號進行多段速調(diào)節(jié)。
圖3 滾珠絲桿傳動機構(gòu)結(jié)構(gòu)圖
采用24V/30W直流減速電機配合齒輪與齒條的嚙合來推動搬運平臺中的左右伸縮平板的運動。電機可實現(xiàn)無極調(diào)速,最大轉(zhuǎn)速為50r/min,并且通過正反向的控制即可實現(xiàn)雙向的伸縮,擴大搬運的范圍。此結(jié)構(gòu)示意圖如圖4所示,關(guān)鍵在于加裝在電機上的金屬齒輪與固定在平板下方的齒條的相對運動大大簡化了傳統(tǒng)的雙向伸縮的機械裝置。
圖4 電機及齒輪齒條傳動機構(gòu)結(jié)構(gòu)圖
根據(jù)設(shè)計要求并結(jié)合對目前市場應(yīng)用現(xiàn)狀的調(diào)研,搬運系統(tǒng)沒有采用傳統(tǒng)的氣缸推動方式,而是采用電動推桿進行上下推動、氣彈簧負責(zé)提供支撐的方式實現(xiàn)了搬運平臺的升降,機械機構(gòu)如圖5所示。由于電動推桿只需提供24V直流電源以及氣彈簧無需外界能源支持,在硬件系統(tǒng)中結(jié)構(gòu)更加簡單有效,減去了傳統(tǒng)搬運機器人或者機械手所依靠的氣壓來源,從使整個系統(tǒng)僅有電路而不需要氣路的存在,安全性也更高。并且,通過PLC程序控制可完成不同高度的升降,實現(xiàn)了上多個不同高度位置的取貨放貨,在垂直空間上擴大搬運范圍。
圖5 電動推桿及氣彈簧升降機構(gòu)結(jié)構(gòu)圖
系統(tǒng)工作流程如圖6所示,具體如下:
圖6 系統(tǒng)工作流程圖
3.2.1 可調(diào)節(jié)脈沖輸出子程序設(shè)計
本文所選用的西門子S7-200 PLC自身帶有兩路PTO/PWM高速脈沖發(fā)生器,這使得PLC能夠以最高100KHz的頻率產(chǎn)生一個高速脈沖串(PTO)以及一個脈寬調(diào)制波形(PWM)。并且,當兩路高速脈沖發(fā)生器使能后[8],PLC的數(shù)字量輸出過程印象區(qū)的Q0.0和Q0.1輸出波形。采用運動控制庫指令來控制高速脈沖輸出以實現(xiàn)對步進電機的驅(qū)動,從而帶動搬運平臺在X軸方向上的運動,運動控制庫函數(shù)功能表如表2所示。
表2 運動控制庫函數(shù)功能表
通過上表可知,在程序設(shè)計中需根據(jù)電機驅(qū)動負載的能力在啟動和停止時給定合適的速度,防止出現(xiàn)電機的抖動,步進電機初始化程序梯形圖如圖7所示。
圖7 步進電機初始化程序梯形圖
3.2.2 多高度升降子程序設(shè)計
在垂直方向上,電動推桿的行程可根據(jù)實際需求選用不同行程產(chǎn)品,通過程序設(shè)計可以將電動推桿單一的上升下降運動轉(zhuǎn)化成多高度的運動。經(jīng)過測試,電動推桿的運動是勻速的故可以通過定時器的配合,控制推桿每段上升或下降的距離,并且還可以實現(xiàn)距離的靈活調(diào)節(jié),平臺可到達行程內(nèi)的任意高度,多高度升降子程序梯形圖如圖8所示。如此一來,搬運平臺在垂直方向上的運動形式更加多樣[4],有利于用戶對不同形狀大小產(chǎn)品的收放。
圖8 多高度升降子程序梯形圖
3.2.3 雙向收放運動程序設(shè)計
在搬運平臺的左右伸縮進行貨物的收放工作時,通過程序控制兩個繼電器的觸點得電與否來實現(xiàn)對直流電機的正反轉(zhuǎn)控制,并且在兩端設(shè)有接近開關(guān),防止轉(zhuǎn)動距離過大使得齒輪與齒條的連接脫落。
本文設(shè)計實現(xiàn)通過攝像頭采集畫面,對每一個待收取物料的標簽進行特征提取與識別從而控制搬運平臺準確的將貨物放置于指定位置,而不是簡單的順序放置與搬運。采用OV7725攝像頭進行圖像的采集,并由STM32F103VET6處理器進行圖像的處理工作??紤]到應(yīng)用環(huán)境的多樣,攝像頭畫面容易受光照等因素的影響[5],所以直接采用原始畫面進行處理的難度較大并且準確率不高。因此,通過迭代閾值法對RGB565格式的圖像數(shù)據(jù)進行二值化處理。
首先,通過對數(shù)據(jù)進行移位等操作對RGB三色分量值進行單獨提??;然后,去除干擾使畫面轉(zhuǎn)為黑白二值圖像,并且通過串口調(diào)試得黑色對應(yīng)值為0,白色對應(yīng)值為255。得到二值化圖像后可以更加有效的提取貨物標簽上的特征值,設(shè)計通過邊緣檢測法[6],提取不同形狀的特征值實現(xiàn)對于多種形狀如正方形、三角形的識別與判斷并通過設(shè)定引腳高低電平信號的變化將貨物信息回傳給PLC控制搬運平臺運動。原始畫面與程序處理后畫面對比如圖9所示。
圖9 圖像處理效果對比
針對于當前制造業(yè)以及物流行業(yè)對物料智能化搬運的需求日益增長的現(xiàn)狀,通過PLC技術(shù)與嵌入式技術(shù)的相互協(xié)作,在承載能力大、運行穩(wěn)定、抗干擾能力強的基礎(chǔ)上加入了智能化處理方式,加入了圖像處理、人機交互等功能,解決了傳統(tǒng)搬運機器人中控制方式較為單一,多依賴于傳感開關(guān)等問題。同時,搬運平臺的創(chuàng)新型設(shè)計大大擴大了工作區(qū)域,實現(xiàn)了多維度多方向的搬運與傳送,提高了空間利用率。該系統(tǒng)具有較高的自動化水平、人機交互界面友好、智能化水平得到提高,可適用于多種不同的應(yīng)用環(huán)境與工業(yè)現(xiàn)場,有著良好的市場前景。