基于自抗擾控制的永磁同步電機(jī)速度跟蹤控制

閆 峰，夏 斌，程 燃

(云科智能伺服控制技術(shù)有限公司，上海 200433)

0 引言

數(shù)控機(jī)床伺服驅(qū)動(dòng)方式通常是“旋轉(zhuǎn)電機(jī)+滾珠絲杠”進(jìn)給方式，這種伺服形式結(jié)構(gòu)復(fù)雜，且存在傳動(dòng)間隙及彈性變形，要獲得較高的快速性和加工精度，給伺服控制系統(tǒng)提出了更高的要求[1]。以PID為核心的控制方法是基于系統(tǒng)對(duì)信號(hào)的響應(yīng)特性或者系統(tǒng)的反饋信息來(lái)確定控制律，即利用系統(tǒng)的給定與實(shí)際信號(hào)的誤差來(lái)確定系統(tǒng)的控制信號(hào)，導(dǎo)致系統(tǒng)的控制量總會(huì)慢一拍。同時(shí)，由于系統(tǒng)完全不依賴于模型或僅參考理想模型，當(dāng)同一套控制器應(yīng)用于相似的控制對(duì)象時(shí)或者是對(duì)象受到本身參數(shù)攝動(dòng)和外部干擾時(shí)，控制器的參數(shù)需要重新調(diào)節(jié)，其通用性差[2-4]。文獻(xiàn)[5]采用PDFF控制抑制速度超調(diào)，但對(duì)參數(shù)攝動(dòng)和外部干擾的抑制效果不明顯。文獻(xiàn)[6]采用滑模變結(jié)構(gòu)控制來(lái)抑制參數(shù)攝動(dòng)和外部的擾動(dòng), 由于滑?？刂乒逃械摹岸墩瘛眴?wèn)題, 影響伺服系統(tǒng)的穩(wěn)態(tài)精度。

本文針對(duì)PMSM伺服控制系統(tǒng)存在的對(duì)系統(tǒng)參數(shù)攝動(dòng)及外部干擾的抑制問(wèn)題，設(shè)計(jì)線性自抗擾速度控制器(包括線性跟蹤微分器、線性擴(kuò)張狀態(tài)觀測(cè)器以及狀態(tài)反饋控制器)，將非線性的系統(tǒng)通過(guò)狀態(tài)反饋與擾動(dòng)估計(jì)補(bǔ)償?shù)姆绞阶儞Q為一類串聯(lián)積分型系統(tǒng)，從而提高了系統(tǒng)的動(dòng)、靜態(tài)性能。實(shí)驗(yàn)結(jié)果表明，線性自抗擾速度跟蹤控制器可以有效地抑制不確定的擾動(dòng)，提高系統(tǒng)的跟蹤性能和魯棒性。

1 PMSM數(shù)學(xué)模型

在忽略鐵心飽和、不計(jì)渦流和磁滯損耗、轉(zhuǎn)子上無(wú)阻尼繞組、永磁材料的電導(dǎo)率為零、相繞組中感應(yīng)電動(dòng)勢(shì)波形是正弦波的前提下，永磁同步電機(jī)d-q軸系的狀態(tài)方程為：

(1)

其中，isd、isq分別為d、q軸定子電流；usd、usq分別為d、q軸定子電壓；Ld、Lq分別為d、q軸線圈的電感；Rs為定子相繞組電阻；ωr為電角速度；ψf為勵(lì)磁磁鏈。

機(jī)械運(yùn)動(dòng)方程為：

(2)

其中，Ωr為機(jī)械角速度；Tem為勵(lì)磁轉(zhuǎn)矩；TL為負(fù)載轉(zhuǎn)矩；J為轉(zhuǎn)動(dòng)慣量；B為粘滯摩擦系數(shù)。

2 線性自抗擾控制

ADRC將模型論與控制論有機(jī)的結(jié)合，通過(guò)對(duì)象模型分析，建立系統(tǒng)固有的加速度與系統(tǒng)狀態(tài)的線性關(guān)系[7]。線性自抗擾控制器由線性跟蹤微分器、線性擴(kuò)張狀態(tài)觀測(cè)器以及狀態(tài)反饋控制器三部分組成，其一階線性ADRC控制框圖，如圖1所示。其中，v為系統(tǒng)輸入信號(hào)；v1為過(guò)渡信號(hào)；u0為矯正信號(hào)；u為系統(tǒng)控制信號(hào)；z1為狀態(tài)量觀測(cè)信號(hào)；z2為擾動(dòng)估計(jì)信號(hào)；b為系統(tǒng)模型參數(shù)；y為系統(tǒng)輸出信號(hào)。

線性跟蹤控制器的狀態(tài)方程為：

(3)

其中，x為線性跟蹤微分器的狀態(tài)變量；a1和a2分別為線性跟蹤微分器的控制參數(shù)。當(dāng)控制參數(shù)取值為a1=r2，a2=2r，且r>0時(shí)，其過(guò)渡過(guò)程沒(méi)有超調(diào)。

圖1 一階線性ADRC控制框圖

擴(kuò)張狀態(tài)觀測(cè)器是將系統(tǒng)的內(nèi)、外擾動(dòng)擴(kuò)張成一個(gè)新的狀態(tài)變量，即總擾動(dòng)，并將其觀測(cè)出來(lái)補(bǔ)償?shù)较到y(tǒng)的控制量中，實(shí)現(xiàn)對(duì)擾動(dòng)的抑制作用。

一階非線性系統(tǒng)方程為：

(4)

其中，x1為系統(tǒng)中的狀態(tài)變量；f(x1(t),w(t))為系統(tǒng)的未建模部分及未知的擾動(dòng)。將總擾動(dòng)通過(guò)擴(kuò)張狀態(tài)觀測(cè)器擴(kuò)張成系統(tǒng)的一個(gè)新的狀態(tài)變量x2=f(x1(t),w(t))，將其代入式(4)中，其線性系統(tǒng)方程為：

(5)

由式(4)、式(5)的推導(dǎo)過(guò)程，將非線性系統(tǒng)轉(zhuǎn)換為線性系統(tǒng)，即為線性串聯(lián)積分型系統(tǒng)[8]。

9）住房建設(shè)部門(mén)資料。主要為風(fēng)景名勝區(qū)、自然文化遺產(chǎn)的名稱、面積，城市（縣城）和村鎮(zhèn)建設(shè)的統(tǒng)計(jì)范圍及相關(guān)成果資料，可作為重要地理要素的參考數(shù)據(jù)源。

由以上分析可知，線性跟蹤微分器的作用是安排過(guò)渡過(guò)程，給出合理的控制信號(hào)，解決了響應(yīng)速度與超調(diào)量之間的矛盾。線性擴(kuò)張狀態(tài)觀測(cè)器通過(guò)設(shè)計(jì)一個(gè)擴(kuò)張的狀態(tài)量來(lái)估計(jì)未知擾動(dòng)和控制對(duì)象中未建模部分，然后狀態(tài)反饋控制器給出合適的控制量用于補(bǔ)償這些擾動(dòng)，將控制對(duì)象變?yōu)榇?lián)積分型控制對(duì)象，實(shí)現(xiàn)動(dòng)態(tài)系統(tǒng)的反饋線性化。

3 自抗擾速度控制原理

一階ADRC速度跟蹤控制器框圖，如圖2所示。

線性跟蹤控制器采用PD控制，其狀態(tài)方程為：

(6)

其中，b1和b2分別為線性跟蹤微分器的控制參數(shù)。若使控制系統(tǒng)無(wú)超調(diào)，則b1=r2，b2=2r，r>0，且b1=(a1+kp)>0，b2=(a2+kd)>0，即

(7)

其中，kp和kd分別為線性跟蹤PD控制器的控制參數(shù)。

圖2 一階ADRC速度跟蹤控制器框圖

參考任意階系統(tǒng)建立線性擴(kuò)張狀態(tài)觀測(cè)器的方法[9-10]，建立線性擴(kuò)張狀態(tài)觀測(cè)器的方程為：

(8)

其中，e1為系統(tǒng)中的輸出量與系統(tǒng)對(duì)其觀測(cè)值的差值；y為系統(tǒng)輸出信號(hào)，即為ωr；β1、β2分別為擴(kuò)張狀態(tài)觀測(cè)器的增益參數(shù)；b=Kt/J為系統(tǒng)模型參數(shù)，Kt為電機(jī)轉(zhuǎn)矩系數(shù)。

由式(8)整理可得，線性擴(kuò)張狀態(tài)觀測(cè)器矩陣方程為：

(9)

擴(kuò)張狀態(tài)觀測(cè)器特征多項(xiàng)式為：

(10)

狀態(tài)反饋控制器采用比例控制，其狀態(tài)方程為：

(11)

線性ADRC中的擴(kuò)張觀測(cè)器帶寬ω0和狀態(tài)反饋控制器帶寬ωc需要滿足的條件[11]為：

ω0≈5-10ωc

(12)

通過(guò)線性擴(kuò)張狀態(tài)觀測(cè)器可準(zhǔn)確地將系統(tǒng)的擾動(dòng)量、狀態(tài)量及其微分值觀測(cè)出來(lái)，再通過(guò)狀態(tài)反饋控制器將原系統(tǒng)變換為“串聯(lián)積分型”系統(tǒng)[12]。

將式(11)中的系統(tǒng)控制信號(hào)表達(dá)式代入式(12)中，可得：

(13)

將式(13)中的系統(tǒng)狀態(tài)變量用x1表示，總擾動(dòng)用x2表示，系統(tǒng)輸出信號(hào)用y表示，其系統(tǒng)的狀態(tài)方程為：

(14)

其中，變量x2和z2近似相等時(shí)，其系統(tǒng)狀態(tài)方程簡(jiǎn)化為：

(15)

式(13)～式(15)的推導(dǎo)過(guò)程為控制系統(tǒng)對(duì)象逐漸變換為串聯(lián)積分型系統(tǒng)的過(guò)程。

線性自抗擾速度控制器原理為通過(guò)擴(kuò)展?fàn)顟B(tài)觀測(cè)器觀察出系統(tǒng)總擾動(dòng)，然后狀態(tài)反饋控制器引入合適的控制量，作為系統(tǒng)總擾動(dòng)估計(jì)的補(bǔ)償量，最后將非線性的系統(tǒng)變換為線性串聯(lián)積分型系統(tǒng)進(jìn)行控制。

4 實(shí)驗(yàn)結(jié)果及分析

永磁同步電機(jī)自抗擾速度跟蹤控制系統(tǒng)框圖，如圖3所示。其中，電機(jī)采用矢量控制，電流環(huán)采用PI控制器，實(shí)驗(yàn)選用的PMSM參數(shù)如下：額定電壓為400V，額定功率為1.3kW；額定電流為5.4A；額定轉(zhuǎn)矩為8.34Nm；額定轉(zhuǎn)速為1500rpm；最大電流為14A；最大轉(zhuǎn)矩為23.3Nm；反電動(dòng)勢(shì)系數(shù)為124 V/krpm；轉(zhuǎn)矩系數(shù)為1.78Nm/A；轉(zhuǎn)動(dòng)慣量為19.9kg·m2×10-4。采用單圈20位、多圈16位絕對(duì)值編碼器獲取永磁同步電機(jī)位置信息，實(shí)現(xiàn)閉環(huán)控制。

圖3 PMSM自抗擾速度跟蹤控制系統(tǒng)框圖

實(shí)驗(yàn)采用TI的F2812DSP實(shí)現(xiàn)電流采樣、SVPWM、SPI串行通信及雙閉環(huán)控制算法等軟件相關(guān)功能。采用倍福公司的EtherCAT與上位機(jī)進(jìn)行通訊，獲得狀態(tài)變量的實(shí)驗(yàn)波形。

搭建對(duì)比實(shí)驗(yàn)平臺(tái)，設(shè)計(jì)PDFF速度跟蹤控制器，其控制框圖，如圖4所示。其中，kf為前饋補(bǔ)償參數(shù)；kp為比例控制參數(shù)；ki為積分控制參數(shù)。PDFF控制參數(shù)設(shè)置值為kf=0.65，kp=30，ki=10。

圖4 PDFF速度控制框圖

根據(jù)PMSM自抗擾速度跟蹤控制系統(tǒng)框圖搭建軟、硬件平臺(tái)，得到以下實(shí)驗(yàn)結(jié)果。圖5分別為ADRC和PDFF速度跟蹤控制系統(tǒng)，階躍轉(zhuǎn)速時(shí)的轉(zhuǎn)速波形和q軸電流波形。圖6分別為ADRC和PDFF速度跟蹤控制系統(tǒng)在額定轉(zhuǎn)速下突加、突卸額定負(fù)載時(shí)的轉(zhuǎn)速波形和q軸電流波形。

由圖5可得，階躍轉(zhuǎn)速指令從0rpm上升到1500rpm，ADRC控制可快速達(dá)到期望轉(zhuǎn)速，且反饋轉(zhuǎn)速無(wú)超調(diào)；q軸電流比PDFF控制下的q軸電流更為平滑。從階躍轉(zhuǎn)速指令跟蹤特性上看，由于ADRC控制中線性跟蹤微分器可優(yōu)化期望指令，并給出合理的控制信號(hào)，解決了響應(yīng)速度快與超調(diào)量之間的矛盾，使得ADRC控制系統(tǒng)具有良好的動(dòng)態(tài)性能。

(a) 階躍轉(zhuǎn)速時(shí)轉(zhuǎn)速波形

(b) 階躍轉(zhuǎn)速時(shí)q軸電流波形圖5 ADRC和PDFF速度跟蹤控制系統(tǒng)階躍轉(zhuǎn)速時(shí)轉(zhuǎn)速波形及q軸電流波形

(a) 突加、卸載時(shí)轉(zhuǎn)速波形

(b) 突加、卸載時(shí)q軸電流波形圖6 ADRC和PDFF速度跟蹤控制系統(tǒng)突加、卸載時(shí)轉(zhuǎn)速波形及q軸電流波形

由圖6可得，系統(tǒng)突加、突卸額定負(fù)載時(shí)，ADRC控制下的轉(zhuǎn)速跌落、提升小，且可以快速恢復(fù)穩(wěn)定轉(zhuǎn)速；而q軸電流波形比PDFF控制的q軸電流波形動(dòng)態(tài)調(diào)節(jié)更迅速且劇烈。從抗負(fù)載擾動(dòng)性能上看，由于ADRC控制中線性擴(kuò)張狀態(tài)觀測(cè)器可估算出負(fù)載擾動(dòng)，而狀態(tài)反饋控制器可給出合適的控制量補(bǔ)償此擾動(dòng)，使得ADRC控制下的速度跟蹤控制系統(tǒng)具有良好的抗擾動(dòng)特性。

實(shí)驗(yàn)結(jié)果表明，ADRC速度跟蹤控制系統(tǒng)可合理地安排過(guò)渡過(guò)程，使得系統(tǒng)響應(yīng)快且無(wú)超調(diào)。而線性擴(kuò)張狀態(tài)觀測(cè)器和狀態(tài)反饋控制器可對(duì)負(fù)載擾動(dòng)進(jìn)行估計(jì)和補(bǔ)償，使得控制系統(tǒng)具有較強(qiáng)的魯棒性。

5 結(jié)束語(yǔ)

針對(duì)高檔數(shù)控機(jī)床對(duì)速度快速響應(yīng)及跟蹤精度的要求，結(jié)合永磁同步電機(jī)的特點(diǎn)，采用自抗擾控制設(shè)計(jì)速度跟蹤器來(lái)抑制伺服系統(tǒng)模型攝動(dòng)及外部不確定性擾動(dòng)，實(shí)現(xiàn)了伺服控制系統(tǒng)對(duì)擾動(dòng)的抑制作用。實(shí)驗(yàn)結(jié)果表明，該方案合理地安排了期望指令的過(guò)渡過(guò)程，并對(duì)擾動(dòng)進(jìn)行觀測(cè)和補(bǔ)償，發(fā)揮了自抗擾控制的優(yōu)勢(shì)，使得控制系統(tǒng)具有良好的動(dòng)態(tài)特性和魯棒性，從而提高了伺服控制系統(tǒng)的跟蹤精度。