摘 要: 為了在壓電陶瓷執行器微動控制中獲得高精度的同時,實現高響應速度,采用三階軌跡規劃方法設計控制算法。為了對控制算法的性能做出準確評價,采用xPC Target實時內核技術,以高速模擬信號采集卡作為控制/反饋信號的I/O通道,搭建了半實物仿真平臺,獲得了毫秒量級的伺服周期。實驗表明,當伺服周期為1 ms、定位行程為200 μm時,三階軌跡規劃算法使壓電陶瓷執行器可以在0.5 s內完成精度為±1 μm的定位,實現了兼顧高精度與高速度的微動控制。該半實物仿真系統可以有效驗證控制算法的性能,為算法的后續移植提供了有益參考。
關鍵詞: 實時仿真; xPC Target; S?Function Builder; 壓電陶瓷
中圖分類號: TN820.3?34; TP273+.5 文獻標識碼: A 文章編號: 1004?373X(2013)13?0138?04
Design of semi?physical simulation system of piezoceramic actuator
GUO Jia?liang, XU Li?song, YAN Feng
(State Key Laboratory of Applied Optics, Changchun Institute of Optics, Fine Mechanics and Physics, CAS, Changchun 130033, China)
Abstract: In order to obtain a fast response and high?precision in the jogging control of piezoceramic actuator, the control algorithm is designed on third order trajectory planning. For purpose of evaluating the performance of control algorithm accurately, the xPC Target real?time kernel technology is used, with high speed analog signal acquisition card as the I/O channel of control or feedback signal, to set up a semi?physical simulation platform, and achieves a servo period of milliseconds. Experiments show that third order trajectory planning could make piezoelectric actuator locate with an error of ±1 μm in 0.5 s, the jogging control with high accuracy and high speed is realized, when the servo cycle is 1 ms and the position stroke is 200 μm. The semi?physical simulation system could effectively verify the property of the control algorithm, and provide a useful reference for the further application of the algorithm.
Keywords: real?time simulation; xPC Target; S?Function Builder;piezoceramic
0 引 言
由于壓電陶瓷執行器(Piezoelectric Actuator,PZT)具有定位精度高、帶寬大、響應時間快等優點,所以被廣泛地應用于如超精密加工、半導體光刻等領域的精密定位系統中。但是隨著工業化生產對產率要求的不斷提高,在滿足定位精度要求的同時,對定位速度提出了越來越嚴格的要求[1]。如何實現快速而精確的定位控制,如何準確評價控制算法的性能顯得尤為重要。
對于PZT定位精度控制的研究主要集中于逆模型的建立,無論是基于現象的Preisach模型[2],還是具有明確函數表達式的Duhem模型[3],都可以有效補償遲滯與蠕變效應帶來影響,獲得高精度的定位控制。對于定位速度控制的研究,無論是動態性能更好的壓電器件的使用[4],還是點到點運動控制算法的優化與應用[5],都取得了高速度的定位控制?;诂F有的PZT,三階軌跡規劃方法可以獲得高精度、高速度的控制效果[6]。
由于三階軌跡規劃算法離散化迭代計算的時間因子為控制系統的單位伺服周期,而以往的非實時計算平臺,無法提供分辨率足夠小的伺服周期,也就無法保證在算法開發驗證階段對其性能進行評價的準確性[7]。xPC Target采用主機與目標機結合的方式,目標機運行的實時內核可以在足夠短的時間內計算控制算法的仿真模型[8?9],為三階軌跡規劃算法的實時執行及性能評價提供了有效的途徑。本文建立基于xPC Target的PZT微動控制半實物仿真平臺,對PZT的微動控制算法進行研究與驗證,以獲得高精度、高速度的PZT微動控制。
1 系統硬件設計
PZT微動控制半實物仿真系統硬件結構如圖1所示,整個系統硬件結構由以下幾個部分組成:處于用戶層的宿主機、處于中間層的xPC Target目標機和處于執行器層的PZT驅動/控制系統。其中,宿主機采用PC機,運行Matlab/Simulink/RTW環境,控制算法的Simulink模型在此環境上開發設計、編譯及下載到目標機中執行;仿真過程中由目標機運行xPC Target實時內核以及控制算法,目標機采用ADVANTECH公司的PWS?1409TP便攜式工控機,通過以太網與宿主機連接;目標機主板上加裝NI公司的PCI?6229多功能數據采集卡,通過此數據采集卡的模擬信號通道與執行器層的PZT控制系統連接;PCI?6229配備32通道16位模擬輸入端口,最高采樣率為250 kHz;4通道16位模擬輸出端口,最高采樣率為933 kHz,可以確保整個半實物仿真系統實現亞毫秒的伺服周期。PZT控制系統由Physik Instrumente公司的E?712驅動/控制箱、N?111型PZT以及D?E30型電容傳感器組成。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t1.tif>
圖1 半實物仿真系統硬件結構圖
2 控制算法設計
2.1 控制算法分析
對于典型的閉環運動控制方法,經過離散化之后,在每個伺服周期內,位移的測量值都與同一個給定值進行比較[10]。因此,在運動初始的若干個伺服周期內,測量值與給定值偏差會很大,而在臨近運動結束的若干個伺服周期內測量值與給定值的偏差又會很小,如果PID控制器參數保持不變,無疑會在啟動或者結束階段產生相對較大的殘余振動,既降低了控制精度,又增加了調節時間。
三階軌跡規劃方法以執行器可達到的最大速度、最大加速度以及最大沖擊為輸入參數,計算獲得的運動軌跡更為平滑,離散化后,將離散值作為不同伺服周期內不同的給定值,就可以減小上述的殘余振動,改善動態響應[7]。典型的三階對稱軌跡規劃輪廓如圖2所示。
通過對圖2(a)與圖2(b)相應軌跡曲線的比較可知:輸入條件不同時,相應的軌跡形狀并不相同。如何實現設計有效的算法計算出不同形狀的軌跡,是三階軌跡規劃方法面臨的主要問題。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t2.tif>
圖2 典型的三階軌跡輪廓
通過對圖2(a)與圖2(b)的進一步分析可知,雖然軌跡輪廓有所不同,只要是對稱的三階軌跡,都可以由3個時間惟一確定:即最大速度持續時間[tv],最大加速度持續時間[ta],最大沖擊持續時間[tj]。這3個時間數值的不同決定了三階軌跡的不同形狀。
2.2 控制算法實現
以上文的3個時間參數為切入點,三階對稱軌跡規劃算法的實現步驟可以分為三個:
第一步,由目標位移、最大沖擊、最大加速度以及最大速度,計算[tj]、[ta]和[tv],如圖2所示;
第二步,由[tj]、[ta]和[tv]計算沖擊跳變的8個時刻:[t0]~[t7],如圖2所示;
第三步,由[t0]~[t7]這8個時間參數作為分段積分的邊界,使用公式(1)所示的多重積分公式,計算每個伺服周期內的位移值,即能得到離散化的三階對稱軌跡。
[an+1=an+jntsvn+1=vn+ants+jnt2s2sn+1=sn+vnts+ant2s2+jnt3s6] (1)
式中,[ts]為伺服周期;[Jm]為最大沖擊值;[an,][vn,][sn]分別為[tn]時刻加速度值、速度值、位移值。
根據以上分析,使用C語言描述的三階對稱軌跡規劃算法流程圖如圖3所示。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t3.tif>
圖3 三階軌跡規劃C語言流程圖
3 系統Simulink仿真建模
3.1 系統總體模型
在半實物仿真系統的硬件結構的基礎上,借助Matlab/Simulink/RTW環境可以實現控制算法的驗證與評價[11]。PZT微動控制系統的Simulink仿真總體模型如圖4所示,實現模型主要功能的模塊有三個:軌跡規劃模塊SCurve、閉環PID控制算法模塊、PCI?6229采集卡的A/D和D/A驅動模塊。其中,PCI?6229采集卡的驅動模塊可以在Simulink Library→xPC Target→National Instruments庫中獲得;PID控制算法模塊的參數根據在線仿真進行整定;SCurve模塊就是三階軌跡規劃算法的Simulink模型。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t4.tif>
圖4 系統的Simulink總體模型
3.2 三階軌跡規劃模型
前文已完成了C語言描述的三階軌跡規劃的算法,使用Matlab/Simulink的S?Function Builder可以方便地將C語言描述的控制算法轉換為Simulink環境下的仿真模型。
在Matlab/Simulink中選擇User?Defined Functions,由其中的S?Function Builder建立一個函數型Simulink模塊,完成以下兩個步驟,即可獲得如圖5所示的SCurve函數型Simulink模塊:
第一步,在Data Properties標簽中,將給定位移sm、最大速度vm、最大加速度am、最大沖擊jm以及伺服周期Ts定義為輸入端口;將離散化位移軌跡sd、速度軌跡vd、加速度軌跡ad以及沖擊軌跡jd定義為輸出端口;
第二步,將三階軌跡規劃算法的C語言文件添加至Libraries標簽下,并將函數聲明添加至External function declaration段落。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t5.tif>
圖5 三階軌跡規劃的Simulink模型
3.3 控制算法仿真
為了對三階軌跡規劃算法進行仿真驗證,在圖5所示的Simulink模塊以外引入5個常量模塊及4個示波器模塊:disp為目標位移、vel為最大速度、acc為最大加速度、jerk為最大沖擊、Ts為伺服周期;sd_scope、vd_scope、ad_scope以及jd_scope分別顯示位移、速度、加速度及沖擊的軌跡。
將仿真參數設置為:最大沖擊[Jmax=1×]108 μm/s3,最大加速度[Amax=1×105]μm/s2,最大速度[Vmax=]450 μm/s,位移分別為20 μm和200 μm時,三階軌跡規劃仿真結果如圖6所示。
由圖6可見,仿真獲得的軌跡與理論分析相符,S?Function Builder成功地將C語言描述的三階軌跡規劃算法轉換成了Simulink模型。
4 實驗與結果分析
完成了如圖1所示的半實物仿真系統硬件搭建,以及如圖4所示的控制算法仿真驗證后,將Matlab/Simulink/RTW環境編譯后的控制算法下載至xPC Target的目標機中運行,通過實時采樣獲取的數據,對控制算法的性能進行實驗驗證。
將N?111型PZT設置為Nanostepping工作模式,最大沖擊取值[1×108]μm/s3,最大加速度取值[1×105]μm/s2,最大速度取值450 μm/s;將PCI?6229的采樣速率設為1 kHz,即伺服周期為1 ms。位移為200 μm時三階軌跡規劃算法的位移響應曲線與誤差曲線如圖7所示。
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t6.tif>
圖6 三階軌跡規劃算法仿真
<\\192.168.0.25\$d\8月\8-2\補\補!現代電子技術201313\Image\31t7.tif>
圖7 三階軌跡規劃實驗曲線
由圖7(a)可見,實際位移軌跡精確地跟蹤了理論計算的位移軌跡,半實物仿真平臺的實時性保障了控制算法的性能,沒有出現軌跡滯后現象。由圖7(b)可見,三階軌跡規劃算法可以在0.5 s內實現精度為±1 μm,行程為200 μm的微動控制。
5 結 語
本文利用xPC Target技術,建立了壓電陶瓷執行器微動控制半實物仿真系統,研究了壓電陶瓷執行器三階軌跡規劃算法。實驗表明,三階軌跡規劃算法可以實現壓電陶瓷執行器高精度與高速度的微動控制;xPC Target半實物仿真系統可以有效評價控制算法的性能,在對精度與速度要求嚴格的精密定位控制領域中具有一定的應用價值。
參考文獻
[1] 王俐,饒長輝,饒學軍.壓電陶瓷微動臺的復合控制[J].光學精密工程,2012,20(6):1266?1270.
[2] 賴志林,劉向東,耿潔,等.壓電陶瓷執行器遲滯的滑模逆模型補償控制[J].光學精密工程,2011,19(6):1282?1286.
[3] 陳輝,譚永紅,周杏鵬,等.壓電陶瓷執行器的動態模型辨識與控制[J].光學精密工程,2012,20(1):89?91.
[4] MERRY R J E, DE KLEIJN N, VAN DE MOLENGRAFT M J G, et al. Using a walking piezo actuator to drive and control a high?precision stage [J]. IEEE/ASME Transactions on Mechatronics, 2009, 14(1): 21?31.
[5]REW K H, HA C W, KIM K S. A Practically efficient method for motion control based on asymmetric velocity profile [J]. International Journal of Machine Tools and Manufacture, 2009, 49(7?8): 678?682.
[6] REW K H, KIM K S. A. A closed?form solution to asymmetric motion profile allowing acceleration manipulation [J]. IEEE Transactions on Industrial Electronics, 2010, 57(7): 2499?2506.
[7] 穆海華,周云飛,嚴思杰,等.超精密點對點運動三階軌跡規劃精度控制[J].機械工程學報,2008,44(1):126?131.
[8] 王曉東,董新民,姚崇.基于xPC的飛行控制系統半實物仿真設計[J].傳感器與微系統,2011,30(1):122?124.
[9] 姜達郁,李中健.基于Matlab的飛艇控制半物理實時仿真系統設計[J].現代電子技術,2012,35(12):130?133.
[10] 胡壽松.自動控制原理[M].4版.北京:科學出版社,2002.
[11] 薛鵬,肖前貴,高艷輝.某無人機飛控系統半實物仿真平臺設計[J].現代電子技術,2012,35(13):111?114.