夏長峰， 蔡遠(yuǎn)文， 任 元， 王英廣

(1. 裝備學(xué)院 研究生院， 北京 101416； 2. 裝備學(xué)院 航天裝備系， 北京 101416； 3. 北京控制工程研究所， 北京 100190)

基于魯棒調(diào)節(jié)和目標(biāo)值濾波的CMG群力矩控制

夏長峰1， 蔡遠(yuǎn)文2， 任 元2， 王英廣3

(1. 裝備學(xué)院 研究生院， 北京 101416； 2. 裝備學(xué)院 航天裝備系， 北京 101416； 3. 北京控制工程研究所， 北京 100190)

為實現(xiàn)控制力矩陀螺群高精度快響應(yīng)力矩控制，提出了一種基于魯棒調(diào)節(jié)和目標(biāo)值濾波的控制方法。建立了采用永磁直流無刷力矩電機(jī)的框架伺服系統(tǒng)數(shù)學(xué)模型,根據(jù)被控對象的傳遞函數(shù)設(shè)計了魯棒調(diào)節(jié)器，針對裝置狀態(tài)可觀測的特點對魯棒調(diào)節(jié)器進(jìn)行了簡化，提出了鎮(zhèn)定補(bǔ)償器和伺服補(bǔ)償器的關(guān)鍵參數(shù)計算方法，實現(xiàn)了轉(zhuǎn)速控制的漸近調(diào)節(jié)且確保了動態(tài)性能指標(biāo)，并提出采用目標(biāo)值濾波器進(jìn)一步加強(qiáng)系統(tǒng)的動態(tài)跟蹤性能；在此基礎(chǔ)上，依托金字塔安裝構(gòu)型的控制力矩陀螺群實現(xiàn)了系統(tǒng)力矩快速精確輸出。MATLAB仿真結(jié)果表明：所提出的控制算法對1 N·m的力矩階躍信號控制誤差較傳統(tǒng)比例-積分-微分算法降低了65.7%，響應(yīng)時間減少了37.2%；對sin(20πt) N·m的正弦力矩跟蹤時，可將力矩輸出誤差穩(wěn)定在±2.1%之間。

控制力矩陀螺；目標(biāo)值濾波；魯棒調(diào)節(jié)；框架伺服系統(tǒng)；金字塔構(gòu)型；高精度快響應(yīng)控制

隨著我國航天事業(yè)的飛速發(fā)展以及航天任務(wù)的多樣化，對航天器姿態(tài)控制系統(tǒng)的快速機(jī)動響應(yīng)能力提出了更高要求[1]?？刂屏赝勇?Control Moment Gyroscope，CMG)輸出力矩大，響應(yīng)速度快[2-3]，是飛船、衛(wèi)星、空間站等航天器進(jìn)行姿態(tài)快速機(jī)動需采用的關(guān)鍵執(zhí)行機(jī)[4]。由CMG群構(gòu)成的姿態(tài)控制系統(tǒng)是航天器進(jìn)行姿態(tài)快速反應(yīng)，以及精確控制的首選方案。CMG由高速轉(zhuǎn)子系統(tǒng)和框架速率伺服系統(tǒng)組成，其中，高速轉(zhuǎn)子提供大小恒定的角動量，框架強(qiáng)制轉(zhuǎn)子改變角動量方向，從而使CMG輸出力矩，對航天器進(jìn)行姿態(tài)調(diào)整[5]。因此，CMG框架系統(tǒng)的控制精度、響應(yīng)速度將直接影響CMG的力矩輸出效果[6]。當(dāng)CMG群作為航天器姿態(tài)控制系統(tǒng)的執(zhí)行機(jī)構(gòu)時，為了最大限度地克服各種干擾對控制效果的影響，必須深入研究其框架伺服系統(tǒng)力矩輸出的高精度快速響應(yīng)控制方法。

目前，多數(shù)伺服控制系統(tǒng)采用比例-積分-微分(Proportional-Integral-Differential，PID)控制算法，該方法原理簡單且易于實現(xiàn)，但是由于對系統(tǒng)的不確定性參數(shù)敏感，機(jī)動性差，無法獲得理想的隨動跟蹤效果[7-9]。文獻(xiàn)[10]以高精度光電碼盤作為角位置傳感器，以數(shù)字信號處理器(Digital Signal Processor，DSP)作為數(shù)字控制硬件核心，設(shè)計了PID三環(huán)控制器，該方案下的框架伺服系統(tǒng)達(dá)到了較好的控制精度。但由于PID控制算法本身的局限性，無法使系統(tǒng)動態(tài)響應(yīng)兼顧快速性和精確性。文獻(xiàn)[11]分析了頻繁機(jī)動條件下由CMG群進(jìn)行側(cè)擺機(jī)動的可行性，并根據(jù)CMG群構(gòu)型設(shè)計了控制律，通過仿真驗證了該方法可以使航天器姿態(tài)角快速、精確地達(dá)到機(jī)動要求，但文中沒涉及框架伺服系統(tǒng)控制問題。為提高航天器姿態(tài)控制系統(tǒng)CMG群力矩輸出精度，文獻(xiàn)[12-15]采用觀測器和補(bǔ)償算法，但觀測器精度和帶寬有限，且觀測存在一定滯后，會影響動態(tài)響應(yīng)效果，無法實現(xiàn)動態(tài)力矩高精度輸出。文獻(xiàn)[16]和文獻(xiàn)[17]分別采用模糊控制器和自抗擾控制器來抑制航天器干擾力矩，在低頻條件下可以實現(xiàn)高精度力矩輸出，但對高頻指令力矩跟蹤效果不佳。

本文在建立框架伺服系統(tǒng)數(shù)學(xué)模型的基礎(chǔ)上，提出基于魯棒調(diào)節(jié)和目標(biāo)值濾波方法對CMG框架角速度進(jìn)行快速精確控制，同時采用基于金字塔構(gòu)型的CMG群實現(xiàn)高精度快響應(yīng)力矩輸出。仿真實驗結(jié)果表明:該方法具有良好的機(jī)動性和較高的跟蹤精度。

1 框架伺服系統(tǒng)建模

圖1 框架伺服系統(tǒng)結(jié)構(gòu)示意圖

根據(jù)電機(jī)的電壓平衡方程可以得到電機(jī)驅(qū)動電壓Um與電樞電流i關(guān)系如下：

(1)

式中，Ke為反電動勢系數(shù)。

假定框架力矩電機(jī)在電流環(huán)閉環(huán)的工作情況下為理想的力矩器，轉(zhuǎn)矩系數(shù)為Km,則電機(jī)的電磁轉(zhuǎn)矩Tm表達(dá)式為

Tm=Kmi

(2)

對電機(jī)軸分析，由牛頓定律可以得到

(3)

根據(jù)式(1)～(3)可確定該伺服系統(tǒng)結(jié)構(gòu)框圖，如圖2所示。

圖2 框架伺服系統(tǒng)結(jié)構(gòu)框圖

根據(jù)圖2，可以確定被控對象傳遞函數(shù)為

(4)

令a=LJ/Km,b=(Lf+JR)/Km,c=(fR+KeKm)/Km,則式(4)可表示為

(5)

2 基于魯棒調(diào)節(jié)和目標(biāo)值濾波的力矩控制

2.1 基于魯棒調(diào)節(jié)和目標(biāo)值濾波的控制器設(shè)計

現(xiàn)有伺服系統(tǒng)大多采用常規(guī)PID控制器，這是一種一自由度控制器，該控制器結(jié)構(gòu)簡單，通過調(diào)節(jié)控制器的比例系數(shù)Kp、積分系數(shù)Ki、微分系數(shù)Kd，使系統(tǒng)獲得良好的穩(wěn)態(tài)精度，能夠滿足一般的控制系統(tǒng)要求；但難以同時保持快速性和準(zhǔn)確性，因此對于高性能的控制系統(tǒng)有局限性，不易獲得理想的控制效果[9]。魯棒調(diào)節(jié)器是一種二自由度控制器，可滿足兼顧精確性和跟隨性的要求[18]。

本文將魯棒調(diào)節(jié)器推廣應(yīng)用于框架伺服控制系統(tǒng)，并對其進(jìn)行改進(jìn)。魯棒調(diào)節(jié)器由伺服補(bǔ)償器和鎮(zhèn)定補(bǔ)償器兩部分構(gòu)成，分別用于實現(xiàn)漸近調(diào)節(jié)和確保動態(tài)指標(biāo)。魯棒調(diào)節(jié)控制系統(tǒng)如圖3所示，其中，T(s)為伺服補(bǔ)償器，K(s)為鎮(zhèn)定補(bǔ)償器，G(s)為被控對象。

圖3 魯棒調(diào)節(jié)器結(jié)構(gòu)框圖

如果把系統(tǒng)本身的狀態(tài)輸出反饋當(dāng)作鎮(zhèn)定補(bǔ)償器，且所有狀態(tài)可直接觀測，則圖3可以簡化為圖4的形式。圖4中，伺服補(bǔ)償器決定系統(tǒng)的跟蹤特性，鎮(zhèn)定補(bǔ)償器決定系統(tǒng)的反饋特性，二者相互獨立。因此，同時提高系統(tǒng)的跟蹤特性和反饋特性成為可能，即系統(tǒng)的跟蹤特性可由T(s)單獨決定，反饋特性由K(s)單獨決定，從而實現(xiàn)二自由度的控制。

圖4 簡化的魯棒調(diào)節(jié)器結(jié)構(gòu)框圖

令T(s)=(a0+a1s)/s,K(s)=k0+k1s,則框架伺服控制系統(tǒng)閉環(huán)傳遞函數(shù)可以表示為

(6)

對框架系統(tǒng)控制器進(jìn)行設(shè)計，一方面要考慮使系統(tǒng)傳遞函數(shù)零點與系統(tǒng)的諧振極點相重合，從而形成偶極子的諧振抑制；另一方面要考慮控制器能夠滿足系統(tǒng)的恒速控制和隨動控制的要求。因此，構(gòu)造系統(tǒng)的閉環(huán)目標(biāo)函數(shù)如下：

(7)

式中:ξ為阻尼率；ωn為自然角頻率。根據(jù)式(6)、(7)，采用待定系數(shù)法計算控制器參數(shù)，可得

(8)

為了進(jìn)一步加強(qiáng)系統(tǒng)的動態(tài)跟蹤性能，通過在信號輸入端添加目標(biāo)值濾波器F(s),實現(xiàn)快速響應(yīng)跟蹤控制。其中，目標(biāo)值濾波器表達(dá)式為[19-20]

(9)

式中:Ti、Td分別為控制器的積分時間和微分時間；α為可調(diào)參數(shù)。目標(biāo)值濾波器通過改變α數(shù)值實現(xiàn)對跟蹤速度的調(diào)節(jié)。則改進(jìn)的框架伺服系統(tǒng)控制結(jié)構(gòu)，如圖5所示。

圖5 改進(jìn)的框架伺服系統(tǒng)控制結(jié)構(gòu)框圖

2.2CMG群力矩輸出

本文采用由4個CMG構(gòu)成的金字塔結(jié)構(gòu)CMG群作為力矩輸出執(zhí)行機(jī)構(gòu)[21-22]，在本體坐標(biāo)系(Oxyz)中的幾何關(guān)系如圖6所示。圖6中，β為CMG的安裝傾角，δi為第i個CMG的框架角(i=1,2,3,4)，hi為第i個CMG的角動量。則CMG群的角動量和h為

(10)

式中，h1～h4的表達(dá)式分別為：

(11)

(12)

(13)

(14)

式中:角動量幅值h0=Jω,J為轉(zhuǎn)動慣量,ω為CMG轉(zhuǎn)子轉(zhuǎn)速。

圖6 金字塔構(gòu)型CMG群

根據(jù)歐拉定理對式(10)求導(dǎo)，可得金字塔構(gòu)型CMG群所能提供的輸出力矩T為

(15)

3 仿真分析

為了驗證所提出控制方法的有效性，在MATLAB軟件的Simulink環(huán)境下建立CMG群快速響應(yīng)仿真模型，并與傳統(tǒng)的PID控制算法仿真結(jié)果進(jìn)行對比，仿真系統(tǒng)主要參數(shù)如表1所示，其中，PID算法參數(shù)參照文獻(xiàn)[23]進(jìn)行設(shè)置。

表1 仿真系統(tǒng)參數(shù)

3.1 框架角速度跟蹤仿真

圖7 階躍角速度響應(yīng)

將本文提出的魯棒調(diào)節(jié)器結(jié)合目標(biāo)值濾波算法，應(yīng)用于框架伺服系統(tǒng)仿真平臺中進(jìn)行仿真分析，同時將傳統(tǒng)的PID控制算法應(yīng)用于同一框架伺服系統(tǒng)。用1°/s的單位階躍信號作為框架角速度給定信號，2種算法的角速度響應(yīng)曲線對比結(jié)果如圖7所示。由圖7可知，傳統(tǒng)PID控制器的上升時間為0.043 s，超調(diào)量為7.24%，調(diào)整時間為0.116s；本文所提出的控制算法上升時間為0.009 s，超調(diào)量為1.98%，調(diào)整時間為0.012 s。通過與傳統(tǒng)PID控制器對比可看出，所提出的魯棒調(diào)節(jié)結(jié)合目標(biāo)值濾波得到的角速度響應(yīng)時間短，超調(diào)量小，雖然與指令信號完全重合所需時間略長于PID算法，但是其進(jìn)入終值±3%范圍的穩(wěn)定狀態(tài)更快，具有更好的跟隨性。其原因在于與PID控制器相比，目標(biāo)值濾波器結(jié)合伺服補(bǔ)償器可以實現(xiàn)對指令信號的快速跟蹤，鎮(zhèn)定補(bǔ)償器可以對誤差進(jìn)行準(zhǔn)確補(bǔ)償。

當(dāng)框架角速度指令信號為頻率10 Hz、幅值1°/s的正弦信號時，2種方法得到的角速度響應(yīng)曲線如圖8所示。根據(jù)圖8可以看出:輸入信號頻率為10 Hz情況下，傳統(tǒng)PID控制方法對輸入信號的跟蹤存在幅值衰減和相位滯后；魯棒調(diào)節(jié)結(jié)合目標(biāo)值濾波控制方法可以對輸入信號的幅值和相位保持一致跟蹤。其原因在于魯棒控制器中的伺服補(bǔ)償器和目標(biāo)值濾波器可以對輸入信號進(jìn)行快速跟蹤，鎮(zhèn)定補(bǔ)償器可以對跟蹤誤差進(jìn)行準(zhǔn)確補(bǔ)償。此時，采用魯棒調(diào)節(jié)結(jié)合目標(biāo)值濾波控制算法的角速度誤差信號如圖9所示。由圖9可知，角速度誤差范圍在±0.032°/s之間。綜合圖8和圖9可知，只有基于魯棒調(diào)節(jié)結(jié)合目標(biāo)值濾波的控制器符合系統(tǒng)的動態(tài)性能指標(biāo)要求。

圖8 正弦角速度響應(yīng)

圖9 角速度跟蹤誤差

3.2 CMG群力矩輸出仿真

根據(jù)公式(15)可知，對指令力矩的有效跟蹤是以對框架角速度的有效跟蹤為前提條件。因此，在3.1節(jié)實現(xiàn)對框架角速度跟蹤的基礎(chǔ)上，對CMG群進(jìn)行力矩輸出仿真。計算機(jī)產(chǎn)生在星體坐標(biāo)系下x軸方向上1 N·m的力矩階躍信號指令，CMG群產(chǎn)生的x軸方向控制力矩響應(yīng)如圖10所示。從圖中可以看出:基于經(jīng)典PID的CMG群上升時間為0.042 s，超調(diào)量為8.16%，調(diào)整時間為0.153 s；基于魯棒調(diào)節(jié)和目標(biāo)值濾波算法的力矩輸出系統(tǒng)上升時間為0.012 s，超調(diào)量為2.8%，調(diào)整時間為0.096 s。通過對比可知，與采用傳統(tǒng)PID控制器的力矩輸出系統(tǒng)相比，基于魯棒調(diào)節(jié)結(jié)合目標(biāo)值濾波的CMG群力矩波動量降低了65.7%，響應(yīng)時間減少了37.2%。

圖10 階躍信號力矩輸出響應(yīng)

當(dāng)指令力矩為x軸方向，幅值為1 N·m、頻率為10 Hz的正弦信號時，CMG系統(tǒng)產(chǎn)生的x軸方向力矩響應(yīng)如圖11所示。從圖11可以看出:基于傳統(tǒng)PID算法的力矩輸出系統(tǒng)無法保持對指令力矩的幅值和相位跟蹤，動態(tài)性能較差；基于魯棒調(diào)節(jié)結(jié)合目標(biāo)值濾波的力矩控制方法能對指令力矩保持一致跟蹤。本文提出的力矩控制方法產(chǎn)生的誤差如圖12所示。由圖12可知，力矩控制系統(tǒng)初始誤差為6%，最終誤差保持在±2.1%之間,控制精度可以滿足系統(tǒng)的精度指標(biāo)要求。

圖11 正弦信號力矩輸出響應(yīng)

圖12 正弦力矩跟蹤誤差

4 結(jié) 論

1) 魯棒調(diào)節(jié)器中的鎮(zhèn)定補(bǔ)償器實現(xiàn)了對角速度誤差的有效補(bǔ)償，伺服補(bǔ)償器結(jié)合目標(biāo)值濾波器實現(xiàn)了對指令角速度的快速跟蹤。仿真結(jié)果表明：階躍角速度跟蹤超調(diào)為1.98%，正弦角速度跟蹤誤差為±3.2%；

2) 本文提出的基于魯棒調(diào)節(jié)和目標(biāo)值濾波的金字塔構(gòu)型CMG力矩輸出系統(tǒng)，可實現(xiàn)對指令力矩的一致跟蹤。仿真結(jié)果表明：與PID算法相比，所提出算法響應(yīng)時間減少37.2%，階躍力矩信號跟蹤超調(diào)量減小65.7%，且可將正弦力矩跟蹤誤差保持在±2.1%范圍內(nèi)。

References)

[1]ZHENG S,HAN B.Investigations of an integrated angular velocity measurement and attitude control system for spacecraft using magnetically suspended double-gimbal CMGs[J].Advances in Space Research,2013,51(12):2216-2228.

[2]ABBAS H S,ALI A,HASHEMI S M,et al.LPV state-feedback control of a control moment gyroscope[J].Control Engineering Practice,2014,24: 129-137.

[3]REN Y,FANG J.High-precision and strong-robustness control for an MSCMG based on modal separation and rotation motion decoupling strategy[J].IEEE Transactions on Industrial Electronics,2014,61(3):1539-1551.

[4]CUI P,LI S,ZHAO G,et al.Suppression of harmonic current in active-passive magnetically suspended CMG using improved repetitive controller[J].IEEE/ASME Transactions on Mechatronics,2016，21(4):1-10.

[5]CHEN X C,CHEN M Y.A filtering control method of the gimbal rate-servo system in DGMSCMG based on strong tracking filter[J].Advanced Materials Research,2014,875-877:2164-2169.

[6]HAN B,ZHENG S,WANG Z,et al.Design,modeling,fabrication,test of a large scale single-gimbal magnetically suspended control moment gyro[J].IEEE Transactions on Industrial Electronics,2015，62(12):1-1.

[7]ZHAO L,ZHAI B,WU D,et al.A low speed servo system of CMG gimbal based on adaptive sliding mode control and iterative learning compensation[C]// IEEE International Conference on Mechatronics and Automation.[S.l.]:IEEE,2015:2249-2254.

[8]FU P,CHEN Z,CONG B,et al.A position servo system of permanent magnet synchronous motor based on back-stepping adaptive sliding mode control[J].Diangong Jishu Xuebao/transactions of China Electrotechnical Society,2013,28(9):288-293;301.

[9]CAI S,WU S,BAO G.Cylinder position servo control based on fuzzy PID[J].Journal of Applied Mathematics,2013(3):1-10.

[10]張峰,房建成.一種基于DSP的磁懸浮控制力矩陀螺框架伺服系統(tǒng)[J].微電機(jī),2007,40(11):32-34.

[11]湯亮,徐世杰.采用單框架控制力矩陀螺群的衛(wèi)星側(cè)擺機(jī)動控制研究[J].航天控制,2003,21(2):1-5.

[12]SUN J J,PENG C.Disturbance observer control method in DGMSCMG[J].Electronics Letters,2014,50(14):989-990.

[13]PENG C,SUN J J.Disturbance observer control method in SGMSCMG[J].Proceedings of the institution of Mechanical Engineers,Part C: Journal of Mechanical Engineering Science,2015,229(11):1998-2006.

[14]魯明,張欣,李耀華.SGCMG框架伺服系統(tǒng)擾動力矩分析與控制[J].中國空間科學(xué)技術(shù),2013,33(1):15-20.

[15]DESHPANDE V S,MOHAN B,SHENDGE P D,et al.Disturbance observer based sliding mode control of active suspension systems[J].Journal of Sound & Vibration,2014,333(11):2281-2296.

[16]CHOU M C,LIAW C M.Dynamic control and diagnostic friction estimation for an SPMSM-driven satellite reaction wheel[J].Industrial Electronics IEEE Transactions on,2011,58(10):4693-4707.

[17]PENG C,FANG J C.High-precision control for double-gimbal magnetically suspended control moment gyro via composite anti-disturbance control[J].Proceedings of the Institution of Mechanical Engineers Part G Journal of Aerospace Engineering,2014,229(7):1183-1193.

[18]涂奉生.魯棒(Robust)調(diào)節(jié)器[J].信息與控制,1979(4):85-91.

[19]熊志強(qiáng),王煒,邱祖廉.一種二自由度PID的實現(xiàn)[J].控制理論與應(yīng)用,2003,22(4):17-19.

[20]SHI J J,ZHANG L X,JIANG A Q.Application on two degree of freedom model driven PID in liner first-order inverted pendulum[J].Applied Mechanics & Materials,2013,433-435:1000-1004.

[21]ZHANG J,JIN J,LIU Z.An improved installation for control moment gyros and its applications on reconfiguration and singular escape[J].Acta Astronautica,2013,85(11):93-99.

[22]王平,王華,任元.基于MSCMG金字塔構(gòu)型的航天器姿態(tài)測控一體化控制方法[J].系統(tǒng)工程與電子技術(shù),2016,38(1):123-129.

[23]何芝強(qiáng).PID控制器參數(shù)整定方法及其應(yīng)用研究[D].杭州：浙江大學(xué),2005：12-24.

(編輯：李江濤)

Torque Control of CMG Cluster Based on Robust Controller
and Target Value Filter

XIA Changfeng1， CAI Yuanwen2， REN Yuan2， WANG Yingguang3

(1. Department of Graduate Management, Equipment Academy, Beijing 101416, China; 2. Department of Space Equipment , Equipment Academy, Beijing 101416, China; 3. Beijing Institute of Control Engineering, Beijing 100190, China)

In order to realize high-precision and fast-response torque control of Control Moment Gyroscope (CMG) cluster, a control algorithm based on target value filter and robust controller is put forward. The mathematical model of gimbal servo system which adopts permanent magnet brushless direct current torque motor in CMG is set up. The robust controller is designed according to the transfer function of the controlled object, and then it is simplified based on the observable characteristics of the device status. The calculation method of key parameters in stabilizing compensator and servo compensator is proposed. In this way, asymptotic adjustment of rotational speed is achieved and the dynamic performance index is guaranteed. Besides, dynamic tracking performance of the system is further strengthened with the proposed target value filter, on the basis of which，fast and precise system torque output is realized with the pyramidal CMG cluster configuration. MATLAB simulation results show that the control error of 1 N·m step torque is reduced by 65.7% and response time is decreased by 37.2% with the proposed algorithm compared to traditional Proportional-Integral-Differential (PID) method. The error of sin(20πt)N·m sinusoidal torque is stabilized between -2.1% and +2.1% with the proposed method.

control moment gyroscope (CMG); target value filter; robust controller; gimbal servo system; pyramidal central configuration; high-precision and fast-response control

2017-03-14

國家自然科學(xué)基金資助項目(51475472，61403396)

夏長峰(1989—)，男，博士研究生，主要研究方向為先進(jìn)慣性測量與控制技術(shù)。superxiacf@163.com 蔡遠(yuǎn)文，男，教授，博士生導(dǎo)師。

TP2

2095-3828(2017)03-0086-06

A DOI 10.3783/j.issn.2095-3828.2017.03.015