陸金磊,姜曉明,王 軍
(1.南京理工大學(xué) 先進發(fā)射協(xié)同創(chuàng)新中心,江蘇 南京 210094; 2.上海機電工程研究所,上海 201109)
壓電式快速反射鏡(PFSM)采用壓電疊堆作為驅(qū)動器[1],具有體積小、響應(yīng)快、精度高、動態(tài)性能好等優(yōu)點,在自適應(yīng)光學(xué)[2]、圖像穩(wěn)定系統(tǒng)[3-4]、目標(biāo)跟蹤系統(tǒng)[5-6]、生物醫(yī)學(xué)系統(tǒng)[7]等領(lǐng)域具有廣泛的應(yīng)用前景。本文將PFSM應(yīng)用在光電精密跟蹤系統(tǒng)中,將其作為復(fù)合軸子系統(tǒng)的執(zhí)行機構(gòu),主要用于校正機架主系統(tǒng)的隨機誤差。為穩(wěn)定跟蹤目標(biāo),光電跟瞄系統(tǒng)的精度需要達到微弧度級,這對PFSM的控制精度提出了很高要求。對于控制設(shè)計者來說,如何獲得被控對象的精準(zhǔn)數(shù)學(xué)模型極為關(guān)鍵。
目前,常用的傳遞函數(shù)參數(shù)辨識方法主要包括時域階躍響應(yīng)法和頻域頻率響應(yīng)法。蔡騫等[8]采用階躍響應(yīng)法對擺式傾斜儀傳遞函數(shù)進行了辨識,該方法測試方便,但只能將系統(tǒng)近似為低階系統(tǒng),精度較差。在頻率響應(yīng)辨識法中,常用的有曲線直接辨識和函數(shù)擬合辨識。劉金星等[9]結(jié)合測量得到的伺服系統(tǒng)開環(huán)Bode圖和自動控制原理,通過理論計算直接得出PFSM系統(tǒng)的傳遞函數(shù),該方法較為簡單直觀,但誤差較大。黃海波等[10]采用最小二乘法辨識出復(fù)合軸精跟蹤系統(tǒng)的傳遞函數(shù),該方法操作方便,辨識精度較高。
本文根據(jù)壓電疊堆材料的特性和反射鏡的運動機理,構(gòu)建了PFSM系統(tǒng)傳遞函數(shù)模型,并結(jié)合實測的PFSM系統(tǒng)幅頻和相頻響應(yīng)特性,使用非線性最小二乘曲線擬合法,選定合適的迭代初值,針對不同頻率特性進行分段擬合,得到了精確的PFSM系統(tǒng)傳遞函數(shù),為控制器設(shè)計奠定了基礎(chǔ)。
PFSM系統(tǒng)主要由控制器、模數(shù)和數(shù)模(AD&DA)轉(zhuǎn)換模塊、功率驅(qū)動模塊、PFSM和電阻應(yīng)變片傳感器構(gòu)成,如圖1所示。圖中:電阻應(yīng)變片傳感器檢測到壓電疊堆的位移量電壓信號,依次經(jīng)過濾波器、傳感器放大模塊和AD轉(zhuǎn)換模塊輸入到控制器。電阻應(yīng)變片傳感器模塊的傳遞函數(shù)可用一個比例環(huán)節(jié)描述;功率驅(qū)動模塊采用線性功率運放直接驅(qū)動,具有很好的線性特性,其傳遞函數(shù)也可用一個比例環(huán)節(jié)描述;在忽略頻率混疊效應(yīng)后,AD轉(zhuǎn)換的傳遞函數(shù)為1/T,T為采樣周期;DA轉(zhuǎn)換可被看作一個零階保持器,其傳遞函數(shù)為(1-e-Ts)/s。在后續(xù)的辨識過程中,可人為去除AD&DA過程對結(jié)果的影響。因此,在分析中,可不考慮AD&DA環(huán)節(jié)。
圖1 PFSM系統(tǒng)控制框圖Fig.1 Block diagram of PFSM system control
以下根據(jù)PFSM的運行機理,構(gòu)建其傳遞函數(shù)模型。文中的PFSM采用Physik Instrumente公司的S340偏轉(zhuǎn)頭,該偏轉(zhuǎn)頭由四壓電疊堆驅(qū)動。當(dāng)電壓施加在壓電疊堆上時,壓電疊堆產(chǎn)生逆壓電效應(yīng),每對壓電疊堆形成推拉運動,驅(qū)動鏡面轉(zhuǎn)動。圖2為四壓電疊堆的反射鏡俯視圖。圖中:A,B,C,D分別為4個壓電疊堆,沿圓周呈90°垂直分布;鏡面中心與致動器和反射鏡接觸點的距離為r;BD軸為俯仰軸;AC軸為方位軸;θa為方位角;θp為俯仰角。設(shè)壓電疊堆的傳遞函數(shù)為G1(s),PFSM機械運動的傳遞函數(shù)為G2(s),則PFSM的傳遞函數(shù)可表示為
G(s)=G1(s)G2(s)
(1)
圖2 四壓電疊堆的反射鏡Fig.2 Fast steering mirror driven by four piezoelectric stacks
壓電疊堆是將單個晶片做得很薄,然后將數(shù)百片疊加起來,從而實現(xiàn)機械上的串聯(lián)和電路中的并聯(lián)??梢詫弘姱B堆等效成一個電容來進行分析,如圖3所示。
圖3 壓電疊堆等效模型Fig.3 Equivalent model of piezoelectric stack
圖中:t為時間;uin(t)為電源電壓;uout(t)為施加在壓電疊堆上的電壓;R為電源的輸出電阻;c為壓電疊堆的等效電容。根據(jù)基爾霍夫電壓定律可得
(2)
對式(2)進行拉普拉斯變化,設(shè)初始條件為0,可得
Uin(s)=RcsUout(s)+Uout(s)
(3)
令τ=Rc為時間常數(shù),則壓電疊堆的傳遞函數(shù)為
(4)
根據(jù)壓電疊堆運動特性,建立機構(gòu)簡化模型,如圖4所示。
圖4 機構(gòu)簡化模型Fig.4 Simplified model of mechanism
圖中:F為壓電疊堆輸出驅(qū)動力;Kf為阻尼系數(shù);Kg為連接剛度;x為壓電疊堆變形量。設(shè)反射鏡質(zhì)量為m,則壓電疊堆機械運動的數(shù)學(xué)模型可用微分方程描述為
(5)
根據(jù)壓電疊堆的變形特性,壓電疊堆輸出驅(qū)動力F與壓電疊堆變形量x之間的關(guān)系為
F=Kp(auo(t)-x)
(6)
式中:Kp為壓電疊堆等效剛度系數(shù);a為待定系數(shù)。
將式(6)代入式(5),整理得
(7)
對式(7)進行拉普拉斯變換,設(shè)初始條件為0,則可得到PFSM機械運動傳遞函數(shù)為
(8)
結(jié)合式(4),(8),可得PFSM傳遞函數(shù)為
GPFSM(s)=G1(s)G2(s)=
(9)
由式(9)可見,PFSM的傳遞函數(shù)為一個慣性環(huán)節(jié)和一個二階振蕩環(huán)節(jié)(也可能是過阻尼的)的串聯(lián),可表示為
(10)
式中:a0,bi(i=0,1,2)即為要辨識的參數(shù)。因功率放大環(huán)節(jié)和電阻應(yīng)變片傳感器的傳遞函數(shù)都可被看作比例環(huán)節(jié),故這2個比例環(huán)節(jié)的系數(shù)也可包含在參數(shù)a0,bi中。事實上,由于PFSM的機械剛度有限,因此系統(tǒng)的開環(huán)特性往往在高頻段附加一個或多個如式(11)所示的雙二階的機械諧振環(huán)節(jié)[11],
(11)
式中:bi(i=3,4,5,6)即為要辨識的參數(shù)。根據(jù)以上分析,PFSM系統(tǒng)的開環(huán)傳遞函數(shù)可被看作式(10)和一個或多個式(11)的串聯(lián)。
使用動態(tài)信號分析儀,產(chǎn)生的線性掃頻信號為
(12)
式中:A為振幅;f0為初始頻率;k為頻率隨時間增加的斜率。用此信號,可以獲得PFSM系統(tǒng)的頻率特性,如圖5所示。
圖5 PFSM系統(tǒng)開環(huán)傳遞函數(shù)的頻率特性Fig.5 Frequency characteristics of open loop transfer function of PFSM system
由幅頻特性曲線可知,PFSM系統(tǒng)的傳遞函數(shù)可能為一個慣性環(huán)節(jié)、一個二階振蕩環(huán)節(jié)和一個雙二階環(huán)節(jié)的串聯(lián),這也符合之前的模型分析。因系統(tǒng)傳遞函數(shù)包含的參數(shù)較多,故在多維空間進行參數(shù)搜索很困難。機械諧振往往出現(xiàn)在高頻段,由于主函數(shù)的衰減作用,因此PFSM系統(tǒng)的幅頻特性已在-30 dB水平,轉(zhuǎn)換為絕對值,約為10-2的量級。若將傳遞函數(shù)模型以絕對值表示,則式(11)對幅頻特性曲線的影響極小。因此,在辨識過程中,將PFSM系統(tǒng)的傳遞函數(shù)分為式(10)和式(11)兩部分,先以式(10)擬合,得到擬合結(jié)果后,從測量得到的頻率特性中提出式(10),再以式(11)擬合。
由于實測的PFSM系統(tǒng)開環(huán)傳遞函數(shù)的頻率特性是非線性的,因而使用非線性最小二乘法辨識參數(shù),用幅頻模型進行擬合,以相頻特性輔助進行結(jié)果檢驗。Matlab的Curve Fit工具箱提供了豐富的曲線擬合功能。將幅頻特性以絕對值表示,導(dǎo)入工具箱,同時提供函數(shù)模型為式(9)的幅頻模型,即
(13)
在Curve Fit里使用非線性最小二乘法進行曲線擬合,同時選擇魯棒性為最小殘差法,置信區(qū)間為使系數(shù)限制有效。非線性最小二乘法需要提供參數(shù)初始值,若初始值選擇不當(dāng),則容易使誤差函數(shù)陷入局部極小值,不能給出期望的擬合效果。使用Matlab的單輸入單輸出(SISO)工具,根據(jù)傳遞函數(shù)模型選擇零極點,構(gòu)造出一個頻率特性與實測的PFSM系統(tǒng)頻率特性相接近的傳遞函數(shù),然后將選擇的零極點作為擬合的初始值,從而有效避開局部極小值的影響。式(13)中,將a0,b0,b1,b2的初始值分別設(shè)定為1,1×10-7,1×10-3,1×10-4,并限定各參數(shù)最小值為0。擬合出的4個參數(shù)的值分別為0.856,2.539×10-6,5.388×10-4,3.788×10-4。
擬合出的主傳遞函數(shù)與實測傳遞函數(shù)的頻率特性的對比結(jié)果如圖6所示。根據(jù)上述分析,從圖6中剔除主傳遞函數(shù)的頻率特性,以相同方法擬合機械諧振環(huán)節(jié)的傳遞函數(shù)。式(11)中,將b3,b4,b5,b6的初始值分別設(shè)定為2×10-7,1×10-7,2×10-7,1×10-4,并限定各參數(shù)最小值為0,擬合出的4個參數(shù)的值分別為3.610×10-7,1.221×10-4,2.825×10-7,1.081×10-4。機械諧振環(huán)節(jié)幅頻特性的擬合情況如圖7所示。
圖6 主傳遞函數(shù)與實測傳遞函數(shù)的頻率特性對比Fig.6 Comparison of frequency characteristics between main transfer function and measured transfer function
圖7 機械諧振環(huán)節(jié)幅頻特性擬合情況Fig.7 Fitting of amplitude frequency characteristics of mechanical resonance
綜合上述擬合參數(shù),可得出PFSM系統(tǒng)實測頻率特性與擬合得到的傳遞函數(shù)頻率特性的對比結(jié)果,如圖8所示。由圖可見:經(jīng)過參數(shù)辨識的PFSM系統(tǒng)傳遞函數(shù)幅頻和相頻特性曲線與實測曲線吻合度很高。實測頻率特性與辨識頻率特性之間的誤差如圖9所示。由圖可見:在低頻段(小于150 Hz),幅頻誤差小于0.1 dB,相頻誤差小于1°;在高頻段,幅頻誤差約為0.3 dB,相頻誤差最大為3°。這一方面是由于系統(tǒng)在高頻段對一些小噪聲比較敏感,另一方面是由于在辨識中忽略了高頻段存在的一些小的機械諧振。不過,擬合誤差都在可接受范圍內(nèi)。
圖8 PFSM系統(tǒng)開環(huán)傳遞函數(shù)與擬合頻率特性Fig.8 PFSM system’s frequency characteristics of open loop transfer function and fitting transfer function
圖9 PFSM系統(tǒng)開環(huán)傳遞函數(shù)與擬合頻率特性之間的誤差Fig.9 PFSM system’s frequency characteristic errors between open loop transfer function and fitting transfer function
針對以上分析,為檢驗辨識效果,設(shè)計補償器為
(14)
則系統(tǒng)開環(huán)傳遞函數(shù)變?yōu)?/p>
(15)
式中:GAD(s)=(1-e-Ts)/(Ts),T為采樣時間;KP,TI分別為需要調(diào)節(jié)的PI控制器參數(shù)。采樣時間T為0.000 2 s,在仿真時將GAD(s)進行Pade線性化。用式(15)補償一個慣性環(huán)節(jié),其目的是保證補償器C(s)的分母階數(shù)不小于分子階數(shù),使之符合因果性。當(dāng)系統(tǒng)跟蹤如下正弦信號時,即
x(t)=12.5sin(10πt)
(16)
調(diào)節(jié)PI參數(shù),令KP=1.411,TI=1/2 073,此時PFSM系統(tǒng)輸出曲線如圖10所示,其誤差曲線如圖11所示。由圖可見:對于振幅為12.5 mrad,頻率為5 Hz的正弦目標(biāo),其跟蹤誤差最終穩(wěn)定在0.25 mrad以內(nèi)。
圖10 校正后的PFSM系統(tǒng)輸出曲線Fig.10 Output curve of corrected PFSM system
圖11 校正后的PFSM系統(tǒng)輸出誤差曲線Fig.11 Output error curve of corrected PFSM system
對于校正后的PFSM系統(tǒng),其開環(huán)頻率特性如圖12所示。此時,系統(tǒng)的幅值裕度為15.9 dB,相位裕度為61.6°,開環(huán)截止頻率為308 Hz。如果未對PFSM系統(tǒng)進行校正,則其開環(huán)頻率特性如圖13所示。此時,系統(tǒng)的幅值裕度為4.96 dB,相位裕度為14.4°,開環(huán)截止頻率為127 Hz,300 Hz處的機械諧振環(huán)節(jié)會導(dǎo)致該頻率附近的誤差和噪聲放大,降低系統(tǒng)性能。通過雙二階濾波器和經(jīng)典PI算法,系統(tǒng)的幅值裕度提高了10.94 dB,相位裕度提高了47.2°,開環(huán)截止頻率提高了181 Hz。
圖12 校正后PFSM系統(tǒng)的開環(huán)特性Fig.12 Open loop characteristics of corrected PFSM system
圖13 未校正PFSM系統(tǒng)的開環(huán)特性Fig.13 Open loop characteristics of uncorrected PFSM system
本文根據(jù)壓電疊堆材料的特性和反射鏡的運動機理,構(gòu)建了PFSM系統(tǒng)傳遞函數(shù)模型,并結(jié)合實測的PFSM系統(tǒng)幅頻和相頻響應(yīng)特性,應(yīng)用非線性最小二乘曲線擬合法,通過Matlab SISO工具箱放置開環(huán)零極點,從而選定合適的迭代初值,針對不同頻率特性進行分段擬合,得到了精確的PFSM系統(tǒng)傳遞函數(shù)。通過實測傳遞函數(shù)與擬合傳遞函數(shù)的對比,驗證了PFSM系統(tǒng)傳遞函數(shù)模型的合理性。由此設(shè)計的雙二階濾波器和經(jīng)典PI相結(jié)合的控制算法有效降低了機械諧振的影響,擴寬了控制系統(tǒng)的閉環(huán)帶寬。通過辨識建立的精確的PFSM系統(tǒng)傳遞函數(shù),為高性能的光電跟蹤系統(tǒng)提供了控制器設(shè)計依據(jù)。