董 雷,楊向宇,趙世偉
(華南理工大學(xué),廣州510642)
步進電動機是一種將電脈沖信號轉(zhuǎn)換成相應(yīng)角位移或線位移的控制電機,具有誤差不積累、結(jié)構(gòu)簡單、體積小、價格低廉、控制方便等優(yōu)點,因而被廣泛應(yīng)用在數(shù)控、印刷、噴繪、光學(xué)定位、機器人等行業(yè)[1]。傳統(tǒng)的步進電動機驅(qū)動器多采用開環(huán)運行方式,其成本低,控制簡單,但抗擾動性差,易失步,因此,目前對步進電動機控制的研究主要集中在閉環(huán)上。
步進電動機最常見的閉環(huán)控制策略是傳統(tǒng)PID控制,其參數(shù)整定較為繁瑣,且對運行工況的適應(yīng)能力較差,在系統(tǒng)快速性和穩(wěn)定性上也難以同時兼顧。文獻[2]根據(jù)步進電動機的線性或近似線性模型,推導(dǎo)了全局穩(wěn)定的自適應(yīng)控制算法,實現(xiàn)了給定信號較好的跟蹤,但該控制算法嚴重依賴于電機模型參數(shù)。文獻[3 -4]研究了模糊邏輯控制算法在步進電動機閉環(huán)控制系統(tǒng)中的應(yīng)用,但所用模糊控制規(guī)則過分依賴于經(jīng)驗和專家知識。文獻[5]將遺傳算法、神經(jīng)網(wǎng)絡(luò)和PID 控制相結(jié)合,設(shè)計基于遺傳算法優(yōu)化的RBF 神經(jīng)網(wǎng)絡(luò)PID 控制器并應(yīng)用到步進電動機位置控制系統(tǒng)中,得到了較高精度的定位效果,但該算法復(fù)雜,實現(xiàn)較為困難。文獻[6 -7]研究了滑模控制算法在永磁同步電機速度控制中的應(yīng)用,提高了系統(tǒng)的動態(tài)性能和抗擾動能力?;?刂破鲄?shù)少,設(shè)計簡單,響應(yīng)速度快,對系統(tǒng)參數(shù)的攝動及外部擾動具有較強的魯棒性。
本文對兩相混合式步進電動機的位置控制系統(tǒng)進行了滑模算法設(shè)計,針對負載擾動設(shè)計了負載觀測器,在此基礎(chǔ)上進行了Simulink 仿真和相應(yīng)的實驗,并將滑??刂扑惴ㄅc傳統(tǒng)PID 控制的控制效果做了對比分析。
本文采用的混合式步進電動機定子為兩相八極,轉(zhuǎn)子50 個齒,如圖1 所示。定子上均勻地分布著8 個磁極,每個磁極的極靴上又均勻地分布著5個小齒,定子磁極上的小齒齒距與轉(zhuǎn)子的小齒齒距相同。轉(zhuǎn)子由環(huán)形磁鋼和兩段鐵心組成,環(huán)形磁鋼在轉(zhuǎn)子中部,在安裝時兩段轉(zhuǎn)子鐵心錯開半個齒距。
圖1 兩相混合式步進電動機三維結(jié)構(gòu)圖
采用簡化的磁網(wǎng)絡(luò)模型,經(jīng)化簡整理可得系統(tǒng)的電壓方程和轉(zhuǎn)矩方程:
運動方程:
式中:ui,ii,ri(i=A,B)分別為定子相電壓、相電流、相電阻;θ,ωr,ω,Zr分別為轉(zhuǎn)子位置電角度、轉(zhuǎn)子機械角速度、轉(zhuǎn)子電角速度和轉(zhuǎn)子齒數(shù);L0,L2分別為電感基波和二次諧波恒定分量;J,B,TL分別為轉(zhuǎn)動慣量、粘滯摩擦系數(shù)和負載轉(zhuǎn)矩;Im,Lsr分別為永磁體等效成的轉(zhuǎn)子電流和定轉(zhuǎn)子互感的恒定分量;ke為反電勢系數(shù),其大小等于ZrLsrIm。
經(jīng)坐標變換得d-q 旋轉(zhuǎn)坐標系下的轉(zhuǎn)矩方程:
在磁場定向的矢量控制中,為便于控制,一般采用id=0 的控制方式,因此,式(4)簡化:
式(3)和式(5)聯(lián)立可得:
為了在算法上較易實現(xiàn)和滿足步進電動機位置控制的性能要求,本文選用常見的線性滑模面,其表達式:
式中:C 為狀態(tài)矩陣,X 為狀態(tài)向量。
設(shè)θ*為步進電動機給定位置,θ 為轉(zhuǎn)子實際位置。令e = θ*- θ,x1= e,x2=,u = iq。聯(lián)立式(6),可得步進電動機的位置誤差狀態(tài)方程:
因此選擇滑模面:
選擇合適的滑模趨近律并加以改進可以使系統(tǒng)得到較好的性能,并且能夠有效削弱抖振。常規(guī)指數(shù)趨近律的不足之處在于其切換帶為帶狀,系統(tǒng)在切換帶中向平衡點運動時,最后不能趨近于平衡點,而是在趨近于平衡點附近進行抖振,這可能激發(fā)系統(tǒng)未建模的高頻成分。文獻[8]給出了一種變指數(shù)趨近律:
修正后的時變切換增益ε':
采用飽和函數(shù)sat(s)代替理想符號函數(shù)sgn(s)能夠進一步削弱系統(tǒng)抖振:
Δ 為一個數(shù)值較小的正常數(shù)。
因此,本文最終采用的趨近律表達式如下:
聯(lián)立式(8)、式(9)、式(13),可得控制率:
傳統(tǒng)的負載轉(zhuǎn)矩降階觀測器只利用積分進行辨識[9-10],辨識收斂速度較慢。本文將比例和積分同時加入到負載轉(zhuǎn)矩的辨識中,可提高負載轉(zhuǎn)矩辨識的收斂速度。
由于控制器采樣時間遠遠小于擾動轉(zhuǎn)矩的變化時間,所以視負載擾動轉(zhuǎn)矩為一個狀態(tài)變量,且假定它是一個恒值,則有=0。結(jié)合式(6),得系統(tǒng)狀態(tài)方程如下:
構(gòu)建負載轉(zhuǎn)矩觀測器:
設(shè)系統(tǒng)特征根為s1,s2,并假定B =0,設(shè)計l1=l3=0,則狀態(tài)反饋系數(shù)l2,l4的值:
由式(19)可得觀測器的極點:
根據(jù)李雅普諾夫第一法,為使系統(tǒng)穩(wěn)定,需滿足Re[s1]<0,Re[s2]<0,設(shè)觀測器的兩個極點都配置在s1=s2= -sp處(sp>0),因此可得l2= -,l4=-2Jsp。根據(jù)系統(tǒng)期望的特性選擇極點所在的位置,按照式(17)構(gòu)建負載觀測器,即可觀測出TL的值。
為實現(xiàn)狀態(tài)觀測器的數(shù)字化控制,將式(17)進行離散化,即可得到轉(zhuǎn)速和負載轉(zhuǎn)矩觀測值的遞推公式:
表1 兩相混合式步進電動機的參數(shù)
系統(tǒng)分別跟蹤方波和鋸齒波指令信號,方波指令為周期3 s,幅值45°的位置信號,步進電動機首先空載運行,在1.5 s 時突加2 N·m 負載轉(zhuǎn)矩;鋸齒波指令為周期1 s,幅值180°的位置信號。仿真過程中采用相同的PID 控制器和滑??刂破鲄?shù),其位置響應(yīng)曲線如圖2、圖3 所示。
圖2 跟蹤方波指令仿真波形
圖3 跟蹤鋸齒波指令仿真波形
從圖2 (a)可以看出,步進電動機在空載運行時,與傳統(tǒng)PID 控制相比,采用滑??刂破髂芨斓馗櫡讲ㄎ恢眯盘柷一旧蠜]有超調(diào);突加負載時,電機在PID 控制方式下有一個較為明顯的位置跌落和回升過程,而在滑??刂品绞较挛恢玫漭^小,回升較快,如圖2 (b)所示。
圖3 顯示,使用相同的控制器參數(shù)跟蹤鋸齒波位置信號時,滑??刂频捻憫?yīng)速度更快,位置誤差更小。由此可以看出,在兩相混合式步進電動機的位置控制系統(tǒng)中,滑模控制可以得到比傳統(tǒng)PID 控制更好的動態(tài)性能,而且對不同性質(zhì)指令和負載擾動具有更強的魯棒性。
本文采用的實驗平臺如圖4 所示。系統(tǒng)由一臺86 式兩相混合式步進電動機、驅(qū)動板、直流電源和上位機組成,電機相關(guān)參數(shù)同表1。為了便于對比仿真結(jié)果,在該實驗平臺下,系統(tǒng)使用兩種控制器分別跟蹤上述兩種位置指令信號。實驗結(jié)束后,將上位機兩個采樣通道中相同時間段內(nèi)的數(shù)據(jù)取出,并用MATLAB 重新繪制,實驗波形如圖5、圖6 所示。
圖4 實驗平臺
對比實驗波形與仿真波形可以看出,兩者結(jié)果基本一致。兩種控制器都可以使步進電動機快速準確地跟蹤方波指令信號,且基本上無穩(wěn)態(tài)誤差,但滑??刂频膭討B(tài)響應(yīng)時間略短于PID 控制且基本無超調(diào),如圖5(b)所示。另外,由于實際步進電動機正反轉(zhuǎn)的模型參數(shù)和特性不完全對稱,PID 控制在跟蹤方波指令信號時正負超調(diào)稍有差別,如圖5(a)所示。圖6 顯示,使用相同的控制器參數(shù)跟蹤鋸齒波指令信號時,滑??刂频目刂菩Ч谩R陨蠈嶒灲Y(jié)果驗證了滑??刂圃趯崿F(xiàn)兩相混合式步進電動機位置控制上的可行性和優(yōu)越性。
本文針對兩相混合式步進電動機的位置控制系統(tǒng),采用改進的具有時變切換增益的指數(shù)趨近律對其進行了滑模算法設(shè)計,并針對負載擾動構(gòu)建了負載觀測器,在Simulink 環(huán)境下搭建了仿真模型,并進行了相應(yīng)的實驗驗證。仿真和實驗結(jié)果表明該算法相比于傳統(tǒng)PID 控制,在位置跟蹤上具有更好的動態(tài)性能,使系統(tǒng)具有更強的魯棒性。
[1] 蘇義鑫,孫功武,聶巍. 基于矢量控制的步進電動機細分驅(qū)動技術(shù)[J].微特電機,2014,42(2):56 -59.
[2] MARINO R,PERESADA S,TOMEI P. Nonlinear adaptive control of permanent magnet step motors[J]. Automatica,1995,31(11):1595 -1604.
[3] 劉川,劉景林.基于Simulink 仿真的步進電機閉環(huán)控制系統(tǒng)分析[J].測控技術(shù),2009,28 (1):44 -49.
[4] 高向東,黃石生,余英林.步進電機模糊控制技術(shù)的研究[J].微特電機,1999,27(3):3 -5.
[5] 金路,羅曉曙,姜東東.單細胞分析儀中步進電機的定位控制[J].自動化與儀表,2014,(12):38 -42.
[6] 汪海波,周波,方斯琛. 永磁同步電機調(diào)速系統(tǒng)的滑模控制[J].電工技術(shù)學(xué)報,2009,24(9):71 -77.
[7] WANG Ai-meng,JIA Xing-wang,DONG Shu-hui. A new exponential reaching law of sliding mode control to performance of permanent magnet synchronous motor[J].IEEE Trans on Magnetics,2013,49(5):2409 -2412.
[8] 歐陽敘穩(wěn),尹華杰,葉長青. 永磁同步電動機滑模控制仿真[J].微特電機,2011,39(8):38 -40,50.
[9] 山炳強,于海生.基于負載觀測器的永磁同步電機反步法控制[J].電機與控制應(yīng)用,2006,33(7):33 -36.
[10] 魯文其,胡育文,梁驕燕,等. 永磁同步電機伺服系統(tǒng)抗擾動自適應(yīng)控制[J].中國電機工程學(xué)報,2011,31(3):75 -81.