張琪琪,儲春華
(海南大學(xué),海口570228)
步進(jìn)電動機是一種將脈沖信號轉(zhuǎn)化成相應(yīng)角位移和直線位移的電動機,每輸入一個脈沖,電機就轉(zhuǎn)動固定的角度。其角位移正比于輸入脈沖,旋轉(zhuǎn)速度正比于脈沖頻率,運行速度和角位移也不受電源電壓波動以及負(fù)載的影響[1]。因此,通過控制脈沖信號的頻率和個數(shù),就可精確控制步進(jìn)電動機的速度和角位移。由于步進(jìn)電動機具有高精度定位、快速起停的特點,現(xiàn)已廣泛應(yīng)用于數(shù)字控制領(lǐng)域,如軟盤驅(qū)動系統(tǒng)、數(shù)模轉(zhuǎn)換控制系統(tǒng)、繪圖儀、打印機、數(shù)控機床等。
步進(jìn)電動機閉環(huán)控制常用的方法是PID 控制,但PID 控制適用于具有精確數(shù)學(xué)模型的線性系統(tǒng),而步進(jìn)電動機模型在運行過程中往往是非線性的、時變的,這使得設(shè)定的PID 參數(shù)控制無法根據(jù)變化的條件實時改變控制參數(shù)從而得到最優(yōu)的控制。模糊邏輯控制和神經(jīng)網(wǎng)絡(luò)控制都是用來處理非線性、不確定系統(tǒng)的重要控制方法,模糊邏輯控制具有魯棒性強、容錯能力高等優(yōu)點,神經(jīng)網(wǎng)絡(luò)控制具有自我學(xué)習(xí)、并行處理等優(yōu)點。本文結(jié)合模糊邏輯控制、神經(jīng)網(wǎng)絡(luò)控制以及常規(guī)PID,利用模糊邏輯規(guī)則將狀態(tài)變量進(jìn)行模糊化和歸一化處理后,再將其作為神經(jīng)網(wǎng)絡(luò)的輸入,利用神經(jīng)網(wǎng)絡(luò)自我適應(yīng)和學(xué)習(xí)的特點對加權(quán)系數(shù)進(jìn)行調(diào)整,根據(jù)系統(tǒng)的運行狀態(tài)自動調(diào)整相應(yīng)參數(shù),最終得到最優(yōu)的PID 控制參數(shù)。該控制器克服了傳統(tǒng)PID 控制器參數(shù)固定的缺點,可提高系統(tǒng)的控制性能[2-4]。
基于步進(jìn)電動機的結(jié)構(gòu)及工作原理,A. C.Leenhouts 等根據(jù)前人的總結(jié),忽略渦流、磁滯效應(yīng)、轉(zhuǎn)矩的三次以上諧波以及兩相混合步進(jìn)電動機間的互感現(xiàn)象,提出如下的Leenhouts 模型用以表示步進(jìn)電動機[5]。
磁鏈方程:
式中:ΨA,ΨB為A,B 相的相繞組的氣隙總磁通;LA,LB為A,B 相的相繞組自感;iA,iB為A,B 相的相繞組電流;ΨMA,ΨMB為永磁體在A,B 兩相繞組下分別產(chǎn)生的氣隙磁通;θe為轉(zhuǎn)子的電角度。
電感方程:
式中:LA,LB為A,B 相的相繞組自感;L 為自感中的恒定分量;iA,iB為A,B 相的相繞組的電流;Zr為轉(zhuǎn)子齒數(shù);ktc為飽和系數(shù);其他為電感的基波分量。
反電動勢方程:
式中:uA,uB為A,B 相的相繞組反電動勢;kt0為轉(zhuǎn)矩系數(shù);h3為三次諧波轉(zhuǎn)矩系數(shù);θ 為轉(zhuǎn)子的機械角度。且:
基本電路方程:
式中:vA,vB是電機A,B 相的總電壓;且假設(shè)A,B 是相互對稱的;R 為兩相繞組的總電阻;A,B 相的電磁轉(zhuǎn)矩TA,TB如下:
D 為電機的保持轉(zhuǎn)矩幅值,混合式步進(jìn)電動機的定位轉(zhuǎn)矩:
步進(jìn)電動機的總電磁轉(zhuǎn)矩:
混合式步進(jìn)電動機的動力方程:
式中:J 為電機的轉(zhuǎn)動慣量;ω 為機械角速度;Dx為粘性摩擦系數(shù);TL為為負(fù)載轉(zhuǎn)矩。
上述式(1)~(9)構(gòu)成了兩相步進(jìn)電動機的數(shù)學(xué)模型。其相關(guān)參數(shù)根據(jù)常州松洋機電有限公司SY57STH51 -2804B 型步進(jìn)電動機的相關(guān)技術(shù)資料和文獻(xiàn)確定[6],自感L =4.34 mH,飽和系數(shù)ktc=0.026 4,轉(zhuǎn)矩系數(shù)kt0=0.85,轉(zhuǎn)子齒數(shù)Zr=50,三次諧波轉(zhuǎn)矩系數(shù)h3=0.31,總電阻R=0.83 Ω,電機轉(zhuǎn)動慣量J=275 g·cm2,電機保持轉(zhuǎn)矩幅值D=0.04 N·m,粘性摩擦系數(shù)Dx=0.05 N·m·s/rad,繞組電流I=2.8 A。
在控制過程中最常用的是PID 控制,合理的參數(shù)才能使控制系統(tǒng)得到良好的性能。傳統(tǒng)的PID 控制器參數(shù)需要人工反復(fù)試驗確定,本文利用神經(jīng)網(wǎng)絡(luò)自我學(xué)習(xí)的特點,結(jié)合模糊邏輯控制根據(jù)系統(tǒng)的運行情況,使輸出層神經(jīng)元的輸出狀態(tài)與PID 控制器的參數(shù)Kp,KI,KD相對應(yīng),通過神經(jīng)網(wǎng)絡(luò)的自我學(xué)習(xí)以及模糊邏輯的處理,實現(xiàn)加權(quán)系數(shù)的調(diào)整以及模糊邏輯的處理,從而達(dá)到性能指標(biāo)最優(yōu)化的PID參數(shù)[7]?;谏窠?jīng)網(wǎng)絡(luò)的模糊PID 控制器由三部分組成:(1)傳統(tǒng)的PID 控制器;(2)模糊化模塊;(3)神經(jīng)網(wǎng)絡(luò)。
傳統(tǒng)的PID 控制器利用PID 控制與步進(jìn)電動機進(jìn)行閉環(huán)控制,且其增量式PID 控制可以表示:
式中:Kp,KI,Kd分別對應(yīng)比例、積分、微分系數(shù),Δuk為控制量的增量;e(k)為誤差。
圖1 神經(jīng)網(wǎng)絡(luò)模糊PID 控制系統(tǒng)結(jié)構(gòu)圖
模糊化模塊利用模糊控制理論對神經(jīng)網(wǎng)絡(luò)的輸入進(jìn)行預(yù)處理,具有魯棒性強和非線性控制等優(yōu)點,可以避免神經(jīng)網(wǎng)絡(luò)因輸入量過大而導(dǎo)致的神經(jīng)元對輸入敏感性下降的缺點。此模塊將 e(k{ })進(jìn)行模糊量化和歸一化處理。通過計算e(k)/r(k),將系統(tǒng)的誤差e(k)歸一化,并在閉區(qū)間[0,1]內(nèi)完成模糊量化,并將誤差傳給神經(jīng)網(wǎng)絡(luò)。
式中:E 為系統(tǒng)誤差的模糊論域。
神經(jīng)網(wǎng)絡(luò)模塊將模糊處理后的誤差作為輸入,利用神經(jīng)網(wǎng)絡(luò)的自我學(xué)習(xí)對加權(quán)系數(shù)初值進(jìn)行調(diào)整,再由系統(tǒng)的運行狀態(tài)調(diào)整PID 控制器的參數(shù)Kp,Ki,Kd。此模塊結(jié)構(gòu)如圖2 所示,有M 個輸入節(jié)點、Q 個隱含節(jié)點、3 個輸出節(jié)點。輸出節(jié)點對應(yīng)著PID 的三個參數(shù),而控制器的參數(shù)Kp,Ki,Kd不能為負(fù),因此取非負(fù)的Sigmoid 函數(shù)作為輸出層神經(jīng)元活化函數(shù),取正負(fù)對稱的Sigmoid 函數(shù)作為隱含層神經(jīng)元活化函數(shù)。
圖2 BP 神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)圖
神經(jīng)網(wǎng)絡(luò)輸入:
隱含層的輸入輸出為:
式中:oj為輸出值;neti為凈輸入值;wij為權(quán)系數(shù);sigmoid 活化函數(shù)f[x]=tanh (x)角標(biāo),(1)、(2)、(3)分別為神經(jīng)網(wǎng)絡(luò)輸入層、隱含層、輸出層。
輸出層的輸入輸出:
神經(jīng)網(wǎng)絡(luò)輸出層加權(quán)系數(shù):
式中:η 為學(xué)習(xí)速率;δ 為慣性系數(shù)。
隱含層加權(quán)系數(shù):
本模型選取4 -5 -3 結(jié)構(gòu)的神經(jīng)網(wǎng)絡(luò),學(xué)習(xí)速率取0.25,慣性系數(shù)取0.05。由于Simulink 沒有與此算法相關(guān)的PID 控制器,此處通過編寫S 函數(shù)并將其裝封在神經(jīng)網(wǎng)絡(luò)模糊PID 模塊中實現(xiàn)對步進(jìn)電動機的控制[8]。圖3 為PID 參數(shù)在線自整定的過程,由于篇幅所限,S 函數(shù)程序略。
圖3 神經(jīng)網(wǎng)路模糊PID 參數(shù)自整定
利用MATLAB 中的Simulink 工具箱,結(jié)合式(1)~式(9)的步進(jìn)電動機數(shù)學(xué)模型,建立兩相混合式步進(jìn)電動機的仿真模型。步進(jìn)電動機的仿真模型如圖4 所示,由電壓、電流、電感以及機械四個模塊組成。其中,TL為輸入負(fù)載轉(zhuǎn)矩,A +,A -,B +,B-為A,B 兩相的輸入電壓,m 則為整個電機模型的輸出,該輸出信號包括了輸出電壓、電流、轉(zhuǎn)矩、角速度以及轉(zhuǎn)子位置信號。
圖4 步進(jìn)電動機的仿真模型
模型中對步進(jìn)電動機的驅(qū)動采用環(huán)形分配器、PWM 發(fā)生器和H 橋的驅(qū)動電路。環(huán)形分配器模塊由環(huán)形計數(shù)器和邏輯電路組成,PWM 發(fā)生器模塊采用電流滯環(huán)控制型,將環(huán)形分配器產(chǎn)生的一定相序的脈沖信號轉(zhuǎn)換成PWM 電流信號,再與反饋電流信號進(jìn)行滯環(huán)控制,從而產(chǎn)生驅(qū)動H 橋MOSFET 管的驅(qū)動信號,H 橋模塊則采用傳統(tǒng)拓?fù)浣Y(jié)構(gòu)的雙H 橋驅(qū)動步進(jìn)電動機的A,B 兩相電流[9],如圖5 所示。
神經(jīng)網(wǎng)絡(luò)模糊PID 控制的步進(jìn)電動機整體仿真模型如圖6 所示。
圖5 仿真模型及兩相電流
圖6 兩相混合式步進(jìn)電動機神經(jīng)網(wǎng)絡(luò)PID 控制系統(tǒng)仿真模型
圖7 階躍響應(yīng)
3.2.2 系統(tǒng)運行仿真分析
空載起動時,設(shè)定初始轉(zhuǎn)速為40 r/min,起動時轉(zhuǎn)矩、轉(zhuǎn)速如圖8 所示。步進(jìn)電動機在起動時,轉(zhuǎn)速有較大的波動,但在很短的時間內(nèi)趨于穩(wěn)定,最終在給定值附近一定范圍內(nèi)波動。轉(zhuǎn)矩在起動時波動較大,在速度達(dá)到給定值時穩(wěn)定在0 附近波動。
圖8 步進(jìn)電動機空載起動仿真
空載起動,給定轉(zhuǎn)速40 r/min,并在0.05 s 時突增0.4 N·m 的負(fù)載轉(zhuǎn)矩,轉(zhuǎn)速、轉(zhuǎn)矩如圖9 所示。從圖9 中可以看出,在0.05 s 時負(fù)載轉(zhuǎn)矩突然增大到0.4 N·m,使電磁轉(zhuǎn)矩瞬間增大,此時轉(zhuǎn)速隨之出現(xiàn)較大的波動,很快轉(zhuǎn)矩穩(wěn)定在0.4 N·m 左右,在轉(zhuǎn)矩穩(wěn)定時轉(zhuǎn)速也穩(wěn)定在給定的40 r/min 上下波動。
圖9 神經(jīng)網(wǎng)絡(luò)模糊PID 空載步進(jìn)電動機突然加負(fù)載轉(zhuǎn)矩仿真
分析仿真結(jié)果得出,步進(jìn)電動機控制系統(tǒng)在空載起動和起動后負(fù)載突然增加時,系統(tǒng)響應(yīng)快,暫態(tài)過程時間短,轉(zhuǎn)矩和轉(zhuǎn)速的波動小,故神經(jīng)網(wǎng)絡(luò)模糊PID 控制系統(tǒng)對步進(jìn)電動機控制性能有一定的提高。
本文在步進(jìn)電動機的運行原理和前人總結(jié)的數(shù)學(xué)模型的基礎(chǔ)上,搭建了兩相混合式步進(jìn)電動機模型,環(huán)形計數(shù)器和邏輯電路組成的環(huán)形分配器、滯環(huán)控制的PWM 發(fā)生器和傳統(tǒng)H 橋結(jié)構(gòu)組成驅(qū)動電路模型,并對神經(jīng)網(wǎng)絡(luò)模糊PID 控制算法進(jìn)行簡析,構(gòu)建了神經(jīng)網(wǎng)絡(luò)模糊PID 控制的步進(jìn)電動機閉環(huán)控制系統(tǒng)。從仿真結(jié)果看,該系統(tǒng)與單純的神經(jīng)網(wǎng)路PID 控制系統(tǒng)相比,具有響應(yīng)速度快、超調(diào)小、抗負(fù)載沖擊能力等良好的靜、動態(tài)特性。該仿真系統(tǒng)對步進(jìn)電動機控制系統(tǒng)的設(shè)計以及控制算法的改進(jìn)提供了一定的參考,具有良好的推廣和應(yīng)用價值。
[1] 馮秀清,鄧星鐘等.機電傳動控制[M].5 版.武漢:華中科技大學(xué)出版社,2011:92.
[2] CHANG W - D,HWANG R - C,HEISH J - G. A multivariable on1ine adaptive PID controller using auto-tuning neurons[J].Engineering Applications of Artificial Intelligence,2003,16(1):57 -63.
[3] HUANG S N,TAN K K,LEE T H.A combined PID/adaptive controller for a class of nonlinear system[J]. Automatica,2001,37(5):611 -618.
[4] 陶永華,尹怡欣,葛蘆生. 新型PID 控制及其應(yīng)用[M]. 北京:機械工業(yè)出版社,1998:136 -176.
[5] LEEHOUNTS A C.Step motor system design handbook[M].USA:Litchfield Engineering Co.,1991:4 -7,35 -36.
[6] 鄒乾.兩相混合式步進(jìn)電機的模糊PI 控制方法研究[D]. 杭州:浙江大學(xué),2010.
[7] 劉霜.混合式步進(jìn)電機的神經(jīng)網(wǎng)絡(luò)控制方法研究[D]. 杭州:浙江大學(xué),2013.
[8] 劉金琨.先進(jìn)PID 控制MATLAB 仿真[M].3 版.北京:電子工業(yè)出版社,2011.
[9] 周一飛.基于Simulink 的步進(jìn)電機控制系統(tǒng)仿真[D].成都:西南交通大學(xué),2014.