(河池學(xué)院物理與機電工程學(xué)院,廣西 宜州 546300)
本文研究了一款基于STM32[4]的綠色環(huán)保型洗筷消毒一體機設(shè)計與制作。該設(shè)計通過濁度傳感器對結(jié)果進行判斷,通過加長轉(zhuǎn)臂的舵機轉(zhuǎn)向?qū)曜拥牧飨蜻M行控制。使用符合PI算法的控制器實現(xiàn)直流電機的調(diào)速。為了使本設(shè)計能夠快速、平穩(wěn)地運行,系統(tǒng)必須把相應(yīng)的轉(zhuǎn)向伺服電機控制以及直流驅(qū)動電機控制準(zhǔn)確地結(jié)合在一起。
本設(shè)計的總體結(jié)構(gòu)包括機械裝置和電路控制系統(tǒng)兩部分組成。機械部分由收集裝置[1-2]、一次清洗裝置、二次清洗裝置、運送裝置[3,5]、消毒出筷裝置五部分構(gòu)成,具體結(jié)構(gòu)如圖1所示。其中,收集裝置主要利用限位機構(gòu)對筷子進行定量收集。一次、二次清洗裝置主要由電磁閥、直流電機、濁度傳感器、超聲波發(fā)生器以及物理清洗機構(gòu)組成。運送過程主要利用升降裝置完成。消毒出筷裝置主要由紫外線臭氧發(fā)生器,以及半自動出筷機構(gòu)組成。在清洗過程中全程采用MG996R舵機對筷子的流向進行輔助控制,保證清洗過程的順利進行。電路控制系統(tǒng)為本設(shè)計的核心組成部分,它由電源電路、信號采集電路、信號控制電路、直流電機調(diào)速電路、以及舵機轉(zhuǎn)向電路組成。本設(shè)計采用STM32單片機控制整個電路,該芯片具有豐富的增強I/O端口運行速度快。
圖1整體結(jié)構(gòu)示意圖
本設(shè)計采用220 V交流電直接進行供電,方便易得。設(shè)計電源電路如圖2所示。交流電經(jīng)整流模塊后再經(jīng)過可調(diào)電阻RH1以及穩(wěn)壓器LM7805和LM7812經(jīng)過降壓后可得到+5 V和+12 V的電壓給其余電路進行供電。
圖2設(shè)計電源電路
信號采集電路用于對工作過程中產(chǎn)生的信號進行采集,本設(shè)計采用I2C總線進行信號采集,I2C總線通過上拉電阻接正電源。當(dāng)總線空閑時,兩根線均為高電平。連到總線上的任一器件輸出的低電平,都將使總線的信號變低,即各器件的SDA及SCL都是線“與”關(guān)系,用來對本設(shè)計中各裝置中產(chǎn)生的信號進行收集,再傳輸給STM32單片機進行數(shù)據(jù)處理。I2C總線信號采集如圖3所示。
圖3 I2C 總線信號采集電路
本設(shè)計通過電流采集進行信號處理,如圖4所示前一級運放構(gòu)成減法電路,后一級運放用來進行高階濾波+5 V電流經(jīng)電阻分壓后,用來減掉電流傳感器0 A時的基值電壓。經(jīng)二階濾波電路濾波,并經(jīng)過后級運放的2倍放大后引腳1輸出電壓2 V,引腳1與STM32的模數(shù)轉(zhuǎn)換通道相連,轉(zhuǎn)換結(jié)果提供給主程序,以便進行相關(guān)的處理。
圖4信號處理電路
本設(shè)計采用L298對直流電機進行調(diào)速控制,如圖5所示。利用該芯片可控制直流電動機的轉(zhuǎn)速與轉(zhuǎn)向,同時利用轉(zhuǎn)速差用物理分離的方法將雜質(zhì)進行分離。
圖5直流電機調(diào)速電路
本設(shè)計利用PWM信號對舵機控制轉(zhuǎn)向舵機自身硬件特性決定:在給定電壓一定時,空載和帶載時的角速度ω分別保持恒值,而線速度ν=ω·R,正比于轉(zhuǎn)臂的長度R。當(dāng)舵機所需轉(zhuǎn)動幅度一定時,長轉(zhuǎn)臂要比短轉(zhuǎn)臂轉(zhuǎn)動的角度小,即響應(yīng)更快。
本文控制多采用直流電機和伺服舵機,其具有結(jié)構(gòu)簡單、體積小、重量輕、免維護等諸多優(yōu)點。直流電機是一個非線性、多變量、強耦合的系統(tǒng),常規(guī)PID控制策略的參數(shù)不能隨電機運轉(zhuǎn)狀況的不同而變化,因此PID控制器不能提供很好的控制性能,而本文采用的模糊PID控制是模糊控制和PID控制的有效結(jié)合,可以在線調(diào)整PID控制參數(shù),提高控制精度,獲得更好的控制效果。
如果設(shè)定的速度為Vd,而當(dāng)前的實際速度為Vr,則速度偏差:
偏差變化率:
將速度偏差 e(t)和偏差變化率 EC(t-1)作為控制器的輸入變量,而控制量KP、KI、KD為輸出變量,編碼器實時測量值c(t)為比較變量。則控制器原理圖如圖6所示。
圖6模糊PID控制原理圖
根據(jù)操作人員經(jīng)驗以及模糊規(guī)則確定法通過反復(fù)的實驗對比來確定模糊控制規(guī)則,使系統(tǒng)達到動、靜特性的最佳效果。根據(jù)PID參數(shù)規(guī)則建立△KP、△KI、△KD模糊分布規(guī)則。
控制系統(tǒng)的軟件開發(fā)是基于STM32單片機進行的,軟件開發(fā)主要包括主程序流程的設(shè)計、子模塊初始化設(shè)計、電機啟動模塊設(shè)計、模糊PID控制模塊設(shè)計等。
控制器上電后,首先進行的是各個子模塊的初始化,子模塊初始化完成之后,依據(jù)霍爾傳感器反饋的高低電平來判斷當(dāng)前電機轉(zhuǎn)子的位置,確定需要導(dǎo)通的相,以此完成電機啟動。程序流程如圖7所示。
圖7主程序流程圖
表1 消毒毒方法的菌落均數(shù)比較
[1]陳立德.機械設(shè)計基礎(chǔ)[M].北京:高等教育出版社,2004:236-238.
[2]Ministry ofMachinery Industry statistics compiled.Mechanical transmission[M].Machinery Industry Press.2004:78-89.
[3]蘇 鵬,周風(fēng)余,陳 磊.基于STM32的嵌入式語音識別模塊設(shè)計[J].單片機與嵌入式系統(tǒng)應(yīng)用,2011,11(2):42-45.
[4]許德珠.機械工程材料[M].北京:高等教育出版社,1992:86-128.
[5]溫熙森,陳循,徐永成,等.機械系統(tǒng)建模與動態(tài)分析[M].北京:科學(xué)出版社,2004:47-89.