李向旭,張曾科,姜 敏
(1.清華大學自動化系,北京 100084;2.蘇州大學電子信息學院,江蘇 蘇州 215021)
兩軸光纖陀螺穩(wěn)定平臺的主要作用是穩(wěn)定雷達天線指向和跟蹤目標移動[1]。根據(jù)兩軸雷達穩(wěn)定平臺的結(jié)構(gòu)和原理[2-3],如果平臺機械結(jié)構(gòu)設計合理,就可以保證兩個通道之間的影響很?。?],這樣就可以忽略兩個通道之間的耦合。本文只討論俯仰通道控制器的設計。光纖陀螺作為速度測量元件與穩(wěn)定回路控制器Cs(s)、速度內(nèi)環(huán)和減速器閉環(huán)構(gòu)成穩(wěn)定回路。角位置傳感器作為角位置測量元件,與跟蹤回路控制器Cp(s)、穩(wěn)定回路和積分模塊閉環(huán)構(gòu)成跟蹤回路。
由于所用電機的電樞電路總電感非常小,可以忽略電機電氣時間常數(shù)。根據(jù)電機方程,得到電機傳遞函數(shù)為
則速度內(nèi)環(huán)的傳遞函數(shù)為
其中:K為放大環(huán)節(jié)的放大倍數(shù),根據(jù)經(jīng)驗取K=20。
根據(jù)實際工作要求,穩(wěn)定回路開環(huán)截止頻率在200 rad/s左右,隔離度要求為If=0.5Hz<0.5%,If=1Hz<1%,If=3Hz<5%,f為外加干擾的頻率[5]。
根據(jù)以上要求,采用滯后超前校正法設計穩(wěn)定回路 PID 控制器[6]:
加入此控制器后,系統(tǒng)穩(wěn)定回路開環(huán)截止頻率為206 rad/s,相角穩(wěn)定裕度為59.2°,幅值穩(wěn)定裕度為38.2 dB。穩(wěn)定回路是穩(wěn)定的,開環(huán)截止頻率滿足要求。由圖1的Simulink模型仿真可得If=0.5Hz=0.08%,If=1Hz=0.35%,If=3Hz=2.8%,即穩(wěn)定回路控制器(3)滿足系統(tǒng)性能要求。
圖1 穩(wěn)定回路仿真模型Fig.1 Simulation model for the stable loop
跟蹤回路的輸入為目標視線方向(LOS)角位置,穩(wěn)定平臺必須能夠快速準確地跟蹤它的變化。實際系統(tǒng)要求單位階躍輸入響應超調(diào)量σ<25%,過渡過程時間ts<0.2 s,穩(wěn)定誤差e(∞)=0,震蕩次數(shù) N≤2。為了避免引入高頻干擾,要求跟蹤回路開環(huán)截止頻率ωc≈50 rad/s。
采用滯后超前校正方法設計跟蹤回路PID控制器:
加入Cp(s)后跟蹤回路開環(huán)截止頻率為wc=54.2 rad/s,相角穩(wěn)定裕度為49.7°,幅值穩(wěn)定裕度為12.7 dB。跟蹤回路控制器(4)滿足跟蹤回路必須穩(wěn)定的要求。然而,跟蹤回路的單位階躍響應為圖2所示的PID響應曲線,系統(tǒng)的超調(diào)量σ=28%,過渡過程時間ts=0.145 s。系統(tǒng)階躍響應的超調(diào)量超出了設計要求的范圍。因此,必須在保證開環(huán)截止頻率不變的基礎上降低階躍響應超調(diào)量。
圖2 PID控制和模糊控制單位階躍響應Fig.2 Unit step responses of the PID controller and fuzzy controller
為了解決1.2節(jié)中系統(tǒng)超調(diào)量過大的問題,本文進一步采用兩維模糊控制器[7-8]。模糊控制器的輸入為誤差e和誤差的變化率ec,相應的量化因子分別為ke和kec。線性變換E=kee將變量e從語言的基本論域映射到量化論域E。當kee>6時,令E=6;當kee<-6時,令E=-6。定義在量化論域E上的模糊子集為{NB,NM,NS,O,PS,PM,PB},其隸屬度函數(shù)如圖 3所示。EC=kecec與上述定義相同。EC和U上定義的模糊子集和各個子集對應的隸屬度函數(shù)與E相同。
圖3 模糊控制器輸入變量的隸屬度函數(shù)Fig.3 Membership function of the input variable of the fuzzy controller
模糊規(guī)則表詳見文獻[9]中表5-1。模糊推理采用Mamdani準則,輸出模糊量逆模糊化采用加權(quán)平均法,模糊控制器輸出u=kuU。
遺傳算法是一種模仿生物進化的智能算法,部分學者利用遺傳算法解決了模糊控制器設計問題[10-11]。本文用遺傳算法來優(yōu)化跟蹤回路模糊控制器ke、kec和ku3個參數(shù)。對于穩(wěn)定平臺而言,單位階躍輸入為最苛刻的輸入,因此只對單位階躍輸入時的系統(tǒng)進行優(yōu)化。
種群數(shù)量20,采用實數(shù)編碼法。選擇策略采用排序選擇法,同時采用保留最佳個體的機制,使適應度函數(shù)最小的兩個個體保留到下一代。交叉操作采用算術(shù)交叉法,交叉概率為0.8。交叉操作采用非均勻變異法,變異概率為0.01。適應度函數(shù):
式中:e(t)為t時刻的誤差值;σ為系統(tǒng)階躍響應的超調(diào)量;e(∞)為系統(tǒng)響應的靜態(tài)誤差;w1、w2、w3為大于零的權(quán)重值,取 w1=10、w2=200、w3=5000。
進行50代的迭代后,得到ke=17.918、kec=0.138和ku=111.771。每一代中最優(yōu)的適應度函數(shù)變化曲線如圖4所示。
系統(tǒng)單位階躍響應如圖2中模糊控制響應曲線所示。模糊控制器可以很好地改善系統(tǒng)的響應特性,不僅使系統(tǒng)的超調(diào)量為零,而且可以將系統(tǒng)的過渡過程時間控制在0.15 s以內(nèi)。然而,模糊控制的階躍響應存在0.2%的靜態(tài)誤差,而且無法直觀地得到跟蹤回路的開環(huán)截止頻率,難以保證其在50 rad/s左右。
圖4 遺傳算法優(yōu)化最優(yōu)適應度變化圖Fig.4 Best fitness values of the GA
由第1節(jié)和第2節(jié)可知,單純的PID控制和遺傳算法優(yōu)化的模糊控制都不能完全滿足系統(tǒng)的要求,因此必須把兩者結(jié)合起來形成復合控制器。常用的結(jié)合方法是閾值切換法,其基本思想是:當誤差絕對值大于設定閾值時,采用模糊控制策略,當誤差絕對值小于設定閾值時采用PID控制策略[12]。但是在切換時刻兩種控制器輸出一般不相等,這容易造成施加給被控對象的控制量發(fā)生跳變,造成系統(tǒng)震蕩[13]。本文采用模糊控制調(diào)整加權(quán)因子的PID-模糊復合控制策略來解決這個問題。
設計復合控制器輸出為
式中:UFUZZY為模糊控制器輸出;UPID為經(jīng)典控制器輸出;α為模糊控制器和經(jīng)典控制器輸出的加權(quán)因子,并且0≤α≤1。
本文采用一維模糊控制器來計算α,其輸入為系統(tǒng)誤差,其變化范圍為[-1,1],輸入變量量化因子為ke′=6,則誤差的量化論域為[-6,6]。定義在誤差量化論域上的模糊子集為{NB,NM,O,PM,PB},相應的隸屬度函數(shù)如圖5所示。
圖5 加權(quán)因子模糊控制輸入變量的隸屬度函數(shù)Fig.5 Membership function of the input variable of the weighted factor fuzzy controller
模糊控制規(guī)則如下:
輸出變量W的模糊子集為{PID,MIX,F(xiàn)UZZY},其隸屬度函數(shù)如圖6。
圖6 加權(quán)因子控制器輸出變量的隸屬度函數(shù)Fig.6 Membership function of the output variable of the weighted factor fuzzy controller
模糊推理采用了Mamdani準則,逆模糊化采用加權(quán)平均法。輸出變量的比例因子為1,即α=W。加權(quán)因子模糊控制器的輸入和輸出關系如圖7所示。當誤差絕對值|e|<0.167時α=0,復合控制器就是經(jīng)典PID控制器Cp(s);α隨著誤差絕對值增大而增大,復合控制器輸出越來越多地依賴于模糊控制器輸出;α隨著量化誤差變化連續(xù)變化,復合控制器輸出不會產(chǎn)生較大突變,避免了由閾值切換法引起的輸出震蕩。
圖7 加權(quán)因子模糊控制器輸入輸出關系Fig.7 The input-output relationship of the weighted factor fuzzy contoller
圖8所示為系統(tǒng)跟蹤幅值為1,周期為0.5 s,脈寬為0.25 s的方波信號的響應曲線??梢姡瑥秃峡刂破骶哂斜葐渭働ID控制器更好的跟蹤性能。0 s至0.25 s的復合控制響應曲線可以看作系統(tǒng)的單位階躍響應曲線。復合控制的單位階躍響應的超調(diào)量為16%,過渡過程時間為0.145 s,靜態(tài)誤差為零。
如果在輸入端輸入斜率為1的斜坡信號,則系統(tǒng)跟蹤的誤差曲線如圖9所示。單純的PID控制和復合控制的跟蹤誤差曲線重合,即兩者具有相同的跟蹤精度。誤差絕對值|e|<0.167,如3.1節(jié)所述,復合控制器就是經(jīng)典PID控制器Cp(s),所以復合控制器和經(jīng)典PID控制器有相同的靜態(tài)誤差,跟蹤回路開環(huán)截止頻率約為50 Hz。
圖8 PID控制和復合控制單位方波跟蹤響應Fig.8 The square wave responses of the PID controller and the composite controller
圖9 PID控制和復合控制單位斜坡信號跟蹤誤差曲線Fig.9 Ramp signal tracking error curves of the PID controller and composite controller
如果在系統(tǒng)輸出端加上寬度為0.1 s,周期為0.2 s,幅值為0.3 rad的正負交替的干擾脈沖。PID控制器和復合控制器響應曲線如圖10所示??梢姡c單純的PID控制相比,復合控制具有更強的抗干擾能力。
圖10 PID控制和復合控制方波干擾響應Fig.10 Square wave disturb responses of the PID controller and the composite controller
仿真性能表明,文中設計的模糊控制調(diào)整加權(quán)因子的模糊-PID復合控制器可以滿足系統(tǒng)的要求。從設計過程而言,PID控制器和模糊控制器可以根據(jù)系統(tǒng)要求獨立設計,簡化了設計工作。與模糊PID算法相比,這種方法比較簡單,需要的計算量較小。
模糊-PID復合控制器設計的核心是尋找最優(yōu)的系統(tǒng)誤差和加權(quán)因子之間的對應關系,而加權(quán)因子模糊控制器的輸入輸出模糊變量的隸屬度函數(shù)和量化因子決定了這種對應關系。在進一步研究中可以采用模糊神經(jīng)網(wǎng)絡在在線運行中調(diào)整有關參數(shù)來優(yōu)化系統(tǒng)性能。
[1]RUE A K.Stabilization of precision electro-optical pointing and tracking systems[J].IEEE Trans Aerospace and Electronic Systems,1969,AES-5:805-819.
[2]唐小軍,趙曉蓓,毛武軍.基于DSPs的空空導彈位標器控制系統(tǒng)的設計[J].彈箭與制導學報,2005,25(2):327-332.
[3]陸岷,張平.基于DSP的天線穩(wěn)定平臺控制器[J].計算機測量與控制,2006,14(8):1052-1071.
[4]MCKERLEY C W.A model for a two degree of freedom coupled seeker with mass imbalance[C]//Southeastcon’96,‘Bring Together Education,Science and Technology’,Proceedings of the IEEE,11-14 April,1996:84-87.
[5]趙超.導引頭穩(wěn)定系統(tǒng)隔離度研究[J].電光與控制,2008,15(7):78-82.
[6]孫寧,劉潔瑜,周小剛,等.光纖陀螺慣性數(shù)字穩(wěn)定回路設計[J].電光與控制,2007,14(3):131-135.
[7]車宏,盧廣山.模糊控制在機載光電跟蹤系統(tǒng)中的應用[J].電光與控制,2001,8(4):15-20.
[8]何華鋒,胡昌華,代延民.一種自適應模糊PID控制器應用仿真[J].電光與控制,2006,13(1):41-44.
[9]李士勇.模糊控制和智能控制理論與應用[M].哈爾濱:哈爾濱工業(yè)大學出版社,1990.
[10]歐陽晉,屈衛(wèi)東.基于遺傳算法的模糊控制器優(yōu)化設計及應用[J].控制與決策,2003,18(2):386-388.
[11]FANG Laihua,WU Aiguo,ZHENG Aihong.GA&LS-based fuzzy neural network control[C]//Proceedings of the 5th World Congress on Intelligent Control and Automation,2004:2467-2650.
[12]薛福珍,劉忍權(quán).基于GA的模糊-PID控制器設計[J].自動化與儀表,2006(3):45-49.
[13]姬偉.陀螺穩(wěn)定光電跟蹤平臺伺服控制系統(tǒng)研究[D].南京:東南大學,2006.