基于dSPACE平臺的穩(wěn)瞄控制系統(tǒng)建模方法研究

胥青青，吳玉敬，張璟玥，姜世洲

(西安應用光學研究所，陜西 西安710065)

機載光電穩(wěn)瞄系統(tǒng)常常要將光電傳感器(電視、紅外和激光測距機)的視軸精確指向目標，以完成對目標的捕獲、跟蹤及測量，配合武器系統(tǒng)，完成對目標的精確打擊。機載光電穩(wěn)瞄伺服控制系統(tǒng)是機載光電穩(wěn)瞄系統(tǒng)的重要組成部分，用來隔離載體的擾動，保證光電傳感器的視軸在慣性空間的穩(wěn)定。伺服控制系統(tǒng)的性能決定了機載光電穩(wěn)瞄系統(tǒng)的整體作戰(zhàn)效能。

對象模型是進行控制系統(tǒng)設計的基礎，模型建立的精確程度會直接影響控制系統(tǒng)設計效果。傳統(tǒng)的建模方法是物理建模法，該方法首先建立理論模型，然后對其中的參數(shù)進行計算、測量和估算，最終得到控制對象的模型，但實際建模過程中往往存在控制對象某些參數(shù)難以實際測量，結構體諧振、軸系摩擦和線纜擾動等非線性因素難以準確估算等問題，最終導致建立的模型和實際系統(tǒng)差別很大。本文提出一種頻域建模方法，該方法通過對控制系統(tǒng)進行掃頻，然后采用最小二乘擬合方法對數(shù)據(jù)進行處理，獲得對應于該系統(tǒng)的頻率特性數(shù)據(jù)，通過MATLAB 中的Ident 工具箱辨識頻率特性數(shù)據(jù)，獲得與該頻率特性數(shù)據(jù)擬合精度較好地一個傳遞函數(shù)，對該傳遞函數(shù)前向通道和反饋通道進行分離，前向通道的傳遞函數(shù)較好地反應了實際穩(wěn)瞄系統(tǒng)的模型。在該模型基礎上，本文還利用SISO 控制系統(tǒng)設計工具箱設計了速率穩(wěn)定回路控制器，取得了較好的控制效果。

1 基于dSPACE 平臺的建模方法

基于dSPACE 半實物仿真平臺的建模主要用dSPACE 和MATLAB 實現(xiàn)，具體分為2 步:1)對控制對象掃頻后采用最小二乘法擬合頻率特性;2)利用MATLAB下的Ident 系統(tǒng)辨識工具箱辨識對象數(shù)學模型。

1.1 dSPACE 系統(tǒng)簡介

dSPACE 半實物仿真平臺是由德國dSPACE 公司開發(fā)的一套基于MATLAB/Simulink 的控制系統(tǒng)在實時環(huán)境下的開發(fā)及測試工作平臺，實現(xiàn)了和MATLAB/Simulink 的無縫連接。dSPACE 由2 部分組成:1)硬件系統(tǒng)，2)軟件環(huán)境。

dSPACE 硬件系統(tǒng)的主要特點是具有高速計算能力，包括處理器和I/O 接口等;本系統(tǒng)采用的硬件配置板卡包括處理器板DS1005、AD 轉換板DS2002和DA 轉換板DS2103.

dSPACE 軟件環(huán)境具有強大的功能，可以很好地完成控制算法的設計、測試和實現(xiàn)，可以方便地實現(xiàn)代碼生成/下載和試驗調試等工作。dSPACE 軟件環(huán)境主要由MATLAB/Simulink 和ControlDesk 組成。激勵信號、數(shù)據(jù)處理和控制器設計由MATLAB/Simulink 完成，調試由ControlDesk 實現(xiàn)。

將dSPACE 半實物仿真平臺和穩(wěn)瞄伺服控制系統(tǒng)相結合，可以非?？焖俚貙崿F(xiàn)系統(tǒng)建模和控制器設計［1］。

1.2 頻率特性擬合方法

本文擬采用掃頻法建立系統(tǒng)數(shù)學模型［2－5］。該方法首先給系統(tǒng)輸入一個正弦掃頻信號，并記錄輸出信號，得到系統(tǒng)各頻率處的原始輸入和輸出，采用最小二乘法［1，7－8］，對輸入的激勵信號數(shù)據(jù)和記錄的輸出信號數(shù)據(jù)處理，消除噪聲得到系統(tǒng)幅頻和相頻特性。

設系統(tǒng)輸入、輸出分別為

式中:A，B 分別為輸入、輸出信號的幅值;B/A 為系統(tǒng)傳遞函數(shù)的線性幅值;由于輸入信號的相位為0，所以φ 既是輸出信號的相位，也是系統(tǒng)傳遞函數(shù)的相位。

由dSPACE 獲得某個頻率下輸出y0(t)的一組采樣數(shù)據(jù)為y(kT)，根據(jù)三角公式可知

式中:Bs、Bc分別為正弦、余弦分量系數(shù)。當采樣頻率f0，測試頻率點ω0，采樣點數(shù)N 滿足等式ω0=時，

因此系統(tǒng)輸出y0(t)的線性幅值和相位差為

系統(tǒng)傳遞函數(shù)在測試頻率點處的線性幅值B/A和相位φ 就可求得。

1.3 系統(tǒng)辨識的方法

圖1為dSPACE 平臺的系統(tǒng)辨識流程圖。

首先對控制對象的模型階次和轉折頻率進行估計，確定掃頻范圍，再利用dSPACE 平臺給測試對象一個設定好的掃頻信號源，并保存相關的掃頻數(shù)據(jù)，根據(jù)最小二乘法處理保存的數(shù)據(jù)，得到系統(tǒng)的頻率特性數(shù)據(jù)(線性幅值，相位和頻率)，繪制出系統(tǒng)的線性幅頻和相頻曲線。

圖1 系統(tǒng)辨識流程圖Fig.1 Flowchart of system identification

將得到的系統(tǒng)頻率特性數(shù)據(jù)導入MATLAB 中的Ident 系統(tǒng)辨識工具箱［6－7］，根據(jù)預估的系統(tǒng)階次辨識出最優(yōu)的數(shù)學模型，對該模型進行轉化，最終導入Simulink，進行分析。需要說明的是Ident 的輸入為所要辨識系統(tǒng)的線性幅值、相位和頻率，而控制系統(tǒng)通常概念上Bode 圖為對數(shù)幅頻曲線，其之間差20 倍的LOG 關系，本文在辨識過程中的幅頻曲線縱軸采用線性幅值，其單位為無量綱的增益，在控制器設計過程中的幅頻曲線縱軸采用對數(shù)幅值，其單位為dB.

2 仿真實驗

為了驗證本方法的正確性，在MATLAB 中對一個已知的二階系統(tǒng)進行仿真實驗。給定掃頻信號幅值為1，頻率變化范圍為1～100 Hz，采樣頻率為5 kHz.將仿真得到的大量數(shù)據(jù)導入最小二乘擬合算法，獲得該對象的頻率特性數(shù)據(jù)，繪制出的線性頻率特性如圖2所示。

圖2 二階系統(tǒng)線性頻率特性Fig.2 Linear frequency characteristic of object

將頻率特性數(shù)據(jù)導入MATLAB 中的Ident 系統(tǒng)辨識工具箱，選擇線性參數(shù)模型后，給定階次為二階，辨識出的模型和已知的二階系統(tǒng)頻率特性對比如圖3所示。擬合度為95.2%，擬合精度較高，獲得的模型傳遞函數(shù)為

對比可知，辨識結果較為精確，該辨識方法可行。

3 某穩(wěn)瞄方位軸穩(wěn)定回路實驗

圖3 二階系統(tǒng)與辨識輸出模型線性頻率特性對比Fig.3 Comparison of linear frequency characteristics of object and model

選定的辨識對象為某型穩(wěn)瞄系統(tǒng)速率穩(wěn)定回路，如圖4所示［8］。它由陀螺測量視軸相對慣性空間的速度，與速度命令形成誤差信號，經(jīng)過穩(wěn)定回路控制器形成控制電壓，通過伺服驅動器控制力矩電機，力矩電機產(chǎn)生驅動力矩，帶動平臺反向轉動，消除誤差。

圖4 穩(wěn)瞄系統(tǒng)速率穩(wěn)定回路Fig.4 Stabilizing loop of system

3.1 對象模型階次和轉折頻率估計

對象模型階次和轉折頻率是采用系統(tǒng)辨識方法對控制對象建模的一個重要參數(shù)。為了便于預估環(huán)路參數(shù)，辨識開始前，選擇穩(wěn)定回路控制器為比例控制，電流環(huán)帶寬通常大于1 kHz，遠遠大于穩(wěn)定回路轉折頻率，因而可以將其近似成一個比例環(huán)節(jié)［9］。從圖4可知，辨識數(shù)據(jù)來源于控制系統(tǒng)的給定，因此可以將閉環(huán)系統(tǒng)看做反饋通道為單位負反饋，前向通道依次為控制器和功放、電機、平臺以及陀螺的串聯(lián)，因而從掃頻給定到速率反饋整個前向通道階次為一個四階系統(tǒng)，綜合考慮到諧振、摩擦和線擾等因素影響，實際系統(tǒng)應該是一個高階系統(tǒng)，反饋通道為單位負反饋。

掃頻頻率區(qū)間應覆蓋系統(tǒng)所有轉折頻率點，并向高頻和低頻有所延伸，速率穩(wěn)定回路轉折頻率通常為30 Hz 左右，所以辨識掃頻信號的合理區(qū)間為0.5～200 Hz.

已知穩(wěn)瞄系統(tǒng)速率穩(wěn)定回路控制器Gk(s)為比例控制;驅動器、電機、平臺和陀螺的串聯(lián)傳遞函數(shù)為Gp(s);整個速率穩(wěn)定回路閉環(huán)傳遞函數(shù)為Gs(s).

因此

3.2 根據(jù)頻率特性辨識系統(tǒng)模型

掃頻信號作為速率穩(wěn)定回路的給定，反饋信號為速率陀螺的信號。將給定信號、反饋信號和掃頻信號的頻率同時保存作為辨識的數(shù)據(jù)來源。頻率區(qū)間選擇0.5～200 Hz，采用與仿真實驗同樣的擬合算法，獲得速率穩(wěn)定回路頻率特性如圖5所示。

圖5 穩(wěn)定回路線性頻率特性Fig.5 Linear frequency characteristic of stabilizing loop

輸入系統(tǒng)頻率特性數(shù)據(jù)，取模型為六階系統(tǒng)，辨識輸出模型頻率特性和系統(tǒng)頻率特性如圖6所示，低頻誤差小于5%.

辨識獲得速率穩(wěn)定回路閉環(huán)傳遞函數(shù)為

圖6 穩(wěn)定回路與辨識輸出模型線性頻率特性對比圖Fig.6 Comparison of linear frequency characteristics of stabilizing loop and model

采用(8)式，得前向通道傳遞函數(shù)

由以上分析可知，該傳遞函數(shù)是功放、電機、平臺、陀螺和擾動等的串聯(lián)組合，可以作為穩(wěn)定回路的控制對象。

3.3 SISO 控制器設計

將(10)式導入SISO 控制系統(tǒng)設計工具箱，利用經(jīng)典控制理論中典型的串聯(lián)補償方法設計獲得的控制器為

(10)式包含3 個0 點，其中2 個0 點重合，包含1 個極點和2 個積分環(huán)節(jié)。獲得期望特性的頻率曲線，如圖7所示。

圖7 SISO 工具箱開環(huán)Bode 圖Fig.7 Open loop Bode diagram of SISO toolbox

將所設計控制器加入該半實物仿真實驗平臺運行，實測該控制器用于真實系統(tǒng)后的Bode 圖如圖8所示，由圖7和圖8可知，仿真開環(huán)剪切頻率為31.5 Hz，實測為32 Hz，仿真相位裕度為50°，實測為53°，仿真結果和實測結果非常接近。

圖8 實測開環(huán)Bode 圖Fig.8 Bode diagram in actual test

4 結論

利用最小二乘法和系統(tǒng)辨識方法，在dSPACE半實物仿真平臺上實現(xiàn)了陀螺穩(wěn)定回路模型的建立，并基于該模型設計了控制器，仿真結果和半實物平臺實驗結果非常接近，證明了這種方法的有效性和實用性。由辨識過程可知，辨識數(shù)據(jù)是在穩(wěn)瞄系統(tǒng)實際工況下掃頻獲得的，其中包含了摩擦和線擾等非線性因素，因而這種建模方法獲得的模型更接近實際。最終獲得的穩(wěn)定回路模型可以直接作為位置回路的控制對象，為位置隨動控制器和瞄準線跟蹤控制器的設計提供了依據(jù)。本方法實現(xiàn)了速率穩(wěn)定回路的數(shù)字控制，其控制器可以直接移植到嵌入式處理器進行實時控制而無需調試，極大地提高了效率。本方法為數(shù)字化機載光電穩(wěn)瞄伺服控制系統(tǒng)分析和設計奠定了基礎。

References)

［1］ 潘峰，薛定宇，徐心和.基于dSPACE 半實物仿真技術的伺服控制研究與應用［J］.系統(tǒng)仿真學報，2004，16(5):936－939.PAN Feng，XUE Ding－yu，XU Xing－h(huán)e.The research and application of dSPACE based hardware－in－the－loop simulation technique in servo control［J］.Journal of System Simulation，2004，16(5):936－939.(in Chinese)

［2］ 李言俊.系統(tǒng)辨識理論及應用［M］.北京:國防工業(yè)出版社，2006.LI Yan－jun.Theory and application of system identification［M］.Beijing:National Defense Industrial Press，2006.(in Chinese)

［3］ 范世珣，范大鵬，張智永，等.機電裝置頻率特性的數(shù)字化測試方法研究［J］.動力學與控制學報，2007，5(1):92－96.FAN Shi－xun，F(xiàn)AN Da－peng，ZHANG Zhi－yong，et al.The research on the digital measurement of frequency response characteristics of machatronics equipment［J］.Journal of Dynamics and Control，2007，27(6):92－96.(in Chinese)

［4］ 劉德朋，趙葉華.關于頻率特性的一種精確測量算法［J］.電子測量與儀器學報，2006，20(3):54－56.LIU De－peng，ZHAO Ye－h(huán)ua.A novel precision measuring algorithms of frequency characteristic［J］.Journal of Electronic Measurement and Instrument，2006，20(3):54－56.(in Chinese)

［5］ 張紹寧，陳鵬.非標準設備頻率特性的自動化測試［J］.戰(zhàn)術導彈技術，2006，(6):76－79.ZHANG Shao－ning，CHENG Peng.Automation test for frequency characteristic of nonstandard facilities［J］.Tactical Missile Technology November，2006，(6):76－79.(in Chinese)

［6］ 薛定宇，陳陽泉.基于MATLAB/Simulink 的系統(tǒng)仿真技術與應用［M］.北京:清華大學出版社，2006.XUE Ding－yu，CHENG Yang－quan.system simulation technology and application based on MATLAB/Simulink［M］.Beijing:Tsinghua University Press，2006.(in Chinese)

［7］ Lennart Ljung.System Identification Toolbox 7 User’s Guide［EB/OL］.［2008－10］.http:∥www.mathworks.cn/help/ toolbox/ident/ug/ug_intropage.html.

［8］ 張璟玥，紀明，王惠林.機載穩(wěn)瞄控制系統(tǒng)模型及仿真分析［J］.應用光學，2006，27(6):491－496.ZHANG Jing－yue，JI Ming，WANG Hui－lin.Modeling and simulation of airborne stabilized sighting system［J］.Journal of Applied Optics，2006，27(6):491－496.(in Chinese)

［9］ 秦繼榮，沈安俊.現(xiàn)代直流伺服控制技術及其系統(tǒng)設計［M］.北京:機械工業(yè)出版社，1999.QING Ji－rong，SHENG An－jun.DC servo control of modern technology and system design［M］.Beijing:China Machinery Press，1999.(in Chinese)