《電子技術應用》
您所在的位置:首頁 > 模擬設計 > 設計應用 > 基于DSP的機載光電穩(wěn)瞄穩(wěn)定環(huán)路數(shù)字控制實現(xiàn)
基于DSP的機載光電穩(wěn)瞄穩(wěn)定環(huán)路數(shù)字控制實現(xiàn)
摘要: 機載光電穩(wěn)瞄產(chǎn)品大量裝備于各種類型飛機上,,其核心是陀螺穩(wěn)定平臺,主要作用在于隔離載體的角擾動,,使安裝在載體上的光學傳感器的視軸在慣性空間內(nèi)保持穩(wěn)定,,使光學傳感器得到清晰的圖像,。穩(wěn)定控制最直觀的方法是將光學傳感器系統(tǒng)安裝在減震裝置上,減振器可以隔離載體的高頻低振幅振動,,但是減振后的低頻振動仍然會對視軸產(chǎn)生擾動,。因此,這種被動隔離的方法常與主動隔離的方法混合使用,。
Abstract:
Key words :

  1,、引言

  機載光電穩(wěn)瞄產(chǎn)品大量裝備于各種類型飛機上,其核心是陀螺穩(wěn)定平臺,,主要作用在于隔離載體的角擾動,,使安裝在載體上的光學傳感器的視軸在慣性空間內(nèi)保持穩(wěn)定,使光學傳感器得到清晰的圖像,。穩(wěn)定控制最直觀的方法是將光學傳感器系統(tǒng)安裝在減震裝置上,,減振器可以隔離載體的高頻低振幅振動,但是減振后的低頻振動仍然會對視軸產(chǎn)生擾動,。因此,,這種被動隔離的方法常與主動隔離的方法混合使用。主動隔離的方法有:整體穩(wěn)定,、齒輪傳動穩(wěn)定,、光學穩(wěn)定、電子學穩(wěn)定和動量輪穩(wěn)定[1],。

  機載光電穩(wěn)瞄穩(wěn)定控制算法除了經(jīng)典控制還有各種先進的控制算法,,如:最優(yōu)控制、變結構控制,、神經(jīng)網(wǎng)絡及模糊控制等,。從目前的文獻資料來看,這些先進的算法大都限于仿真研究,,實際用于產(chǎn)品的報道很少,。目前,機載光電穩(wěn)瞄產(chǎn)品以經(jīng)典控制模擬電路實現(xiàn)為主,。

  模擬控制的實現(xiàn)依賴于集成電路和分離元件,,設備間的信號傳遞均采用模擬量,,導致控制器元件眾多、結構復雜,、體積龐大,,同時在模擬電路的硬件基礎上,要想實現(xiàn)各種復雜的現(xiàn)代控制方法幾乎是不可能的,。數(shù)字控制系統(tǒng)以程序代替硬件,,有利于減小電路的體積,降低成本,,在信號處理,、算法實現(xiàn)上具有模擬控制無可替代的優(yōu)勢。數(shù)字控制是整個伺服控制領域的發(fā)展趨勢,。隨著科學技術的發(fā)展,,對機載光電穩(wěn)瞄的穩(wěn)定精度、動態(tài)品質的要求越來越高,。因此,,必須采用先進的數(shù)字控制技術,運用現(xiàn)代控制算法,,設計出高性能的陀螺穩(wěn)定平臺控制系統(tǒng),,以滿足實際系統(tǒng)的要求。

  2,、機載光電穩(wěn)瞄系統(tǒng)工作原理

  系統(tǒng)的控制環(huán)路如圖1所示,,系統(tǒng)包含三個環(huán)路,內(nèi)部為電流環(huán),,電流環(huán)控制流過電樞的電流盡可能嚴格跟隨電流指令,,改善電流跟隨電壓的動態(tài)特性,包括超調(diào)和調(diào)節(jié)時間等,,抑制電子噪聲和反電勢等的影響,。中間為速度環(huán),即穩(wěn)定環(huán),。穩(wěn)定環(huán)是光電穩(wěn)瞄系統(tǒng)的關鍵,,光電探測器的機(船、車)載應用直接受伺服系統(tǒng)穩(wěn)定環(huán)性能的影響[2],。穩(wěn)定環(huán)采用速率陀螺作為慣性敏感元件,,檢測光電穩(wěn)定平臺方位和俯仰軸角速度,與速度命令信號形成誤差電壓,,該誤差電壓通過穩(wěn)定控制器在直流電機軸上產(chǎn)生穩(wěn)定力矩,,從而實現(xiàn)光電穩(wěn)定平臺抑制擾動、保持在慣性空間相對穩(wěn)定。外部為位置環(huán),,通過比較輸入信號與反饋信號產(chǎn)生控制偏差,,借助位置控制器校正補償輸出到穩(wěn)定環(huán)對光電穩(wěn)瞄實施控制。在目前的穩(wěn)瞄產(chǎn)品中,,三個環(huán)路的控制器除了位置環(huán)控制器為數(shù)字控制器,,穩(wěn)定環(huán)控制器和電流環(huán)控制器均為模擬控制器。本文研究的目的是將穩(wěn)定環(huán)用數(shù)字控制方式實現(xiàn),。

光電穩(wěn)定平臺控制系統(tǒng)環(huán)路

圖1 光電穩(wěn)定平臺控制系統(tǒng)環(huán)路

  3,、控制系統(tǒng)建模與設計

  建立數(shù)學模型

  從前面的分析可知,穩(wěn)定環(huán)路控制的對象為包括穩(wěn)瞄轉塔的電流閉環(huán),,對電流閉環(huán)分析如下:

  PWM驅動模型如圖2所示。本系統(tǒng)中采用的是雙極性四橋式PWM驅動,,其傳遞函數(shù)可以寫為:

公式 ?。?)

PWM驅動模型

圖2 PWM驅動模型

  當PWM開關頻率較高,并且系統(tǒng)的截止頻率時,,上式可以簡化為:

公式 ?。?)

  其中kPMW= 電源電壓/三角波電壓;T為PWM開關周期,。

  一般來說T非常小,,可以忽略延遲環(huán)節(jié)。

  電機模型

  電機選用的是永磁直流力矩電機,,系統(tǒng)采用的是電壓調(diào)速,。由此可以得到電機的模型:

公式公式公式公式  (3)

  其中R為電機繞組電阻,,L為電機繞組電感,,U2表示調(diào)制電壓輸入,I表示流過電機繞組的電流,,E為電機繞組反電勢,,J為負載轉動慣量,M為電機輸出力矩,,ω為電機轉速(即負載轉速),,Ce和Cm分別為電機的反電勢常數(shù)和力矩常數(shù)。

  這樣可以得到整個電流環(huán)閉環(huán)結構形式如圖3所示,,圖中Md為干擾力矩,。

電流環(huán)反饋框圖

圖3 電流環(huán)反饋框圖

  根據(jù)實際電路計算,得到電流環(huán)控制器為:

公式  ,,其中公式 (4)

  3.1 控制器設計

  光電穩(wěn)瞄一般為兩軸或三軸陀螺穩(wěn)定平臺,,各個軸從控制系統(tǒng)的構成來講,具有相似結構。兩軸平臺包括方位軸和俯仰軸,,這里以方位軸為例進行控制器設計,。

  光電穩(wěn)瞄系統(tǒng)所用陀螺為速率陀螺,從陀螺的資料手冊上查得的陀螺數(shù)學模型[3]為:

公式 ?。?)

  式中:kg=10,,ω=100Hz,ξ=0.707,。

  根據(jù)前面的分析建立經(jīng)典控制系統(tǒng)Simulink仿真模型如圖4所示,。

經(jīng)典控制系統(tǒng)Simulink仿真模型

圖4 經(jīng)典控制系統(tǒng)Simulink仿真模型

  利用Simulink中的線性化工具將對象線性化,其結果作為sisotool控制器設計的基礎,,從sisotool工具箱中設計控制器:

公式 ?。?)

  設計后系統(tǒng)根軌跡和開環(huán)頻率特性結果如圖5所示。

sisotool工具箱設計的控制器

圖5 sisotool工具箱設計的控制器

  從圖中可以看出系統(tǒng)幅值裕度為12.4dB,,相角裕度為51.6º,。

  3.2 控制系統(tǒng)仿真

  將設計的控制器加入系統(tǒng)Simulink仿真模型得到系統(tǒng)階躍響應結果如圖6所示,頻率特性如圖7所示,。

階躍響應仿真結果

圖6階躍響應仿真結果

 

仿真頻率特性

圖7 仿真頻率特性

  從圖6中可以看出,,超調(diào)量為24.4%,調(diào)節(jié)時間約為115ms,。從圖7仿真頻率特性可以看出,,系統(tǒng)的帶寬約為25Hz。

  4,、數(shù)字控制硬件平臺

  數(shù)字控制硬件結構如圖8所示,。系統(tǒng)包括DSP芯片、A/D電路,、D/A電路和信號調(diào)理電路,。硬件平臺核心器件是TMS320F2812數(shù)字信號處理芯片。TMS320F2812的最高運行頻率可達150MHz,,片上存儲器最多達128K×16位的Flash存儲器,,最多達128K×16位的ROM,1K×16位的OPT ROM,,兩塊4K×16位的單周期訪問RAM,,一塊8K×16位的單周期訪問RAM,兩塊1K×16位的單周期訪問RAM[4],。由于TMS320F2812片內(nèi)RAM資源有限,,系統(tǒng)中外擴了一片512K的RAM芯片。

 數(shù)字控制硬件結構框圖

圖8 數(shù)字控制硬件結構框圖

  陀螺輸出的電壓經(jīng)信號調(diào)理電路后進入A/D芯片,,TMS320F2812從A/D芯片讀入轉換的電壓數(shù)據(jù),,經(jīng)算法計算后,,DSP芯片將輸出的值送入D/A芯片輸出電壓,輸出的電壓經(jīng)電壓跟隨提高驅動能力后進入電機驅動電路,,由力矩電機驅動陀螺穩(wěn)定平臺,。

  A/D轉換芯片采用AnalogDevices公司的16位6通道模數(shù)轉換芯片AD7656。此芯片輸入電壓范圍為-10V~+10V,。

  陀螺輸出信號要經(jīng)過遠距離傳輸,,為了降低陀螺信號的噪聲,穩(wěn)瞄系統(tǒng)中采用差分形式傳輸陀螺輸出信號,。本設計中模數(shù)轉換芯片AD7656為單端輸入方式,,因此需要將陀螺輸出的差分信號轉換成單端信號。轉換電路采用AnalogDevices公司的AD620儀表放大器芯片,,該芯片的1腳和8腳之間接的電阻 決定其放大倍數(shù),,放大倍數(shù)計算公式如下:

公式  (7)

  由式7可知,,當電阻 為無窮大時放大倍數(shù) ,,本設計中選擇放大倍數(shù)為1。

  D/A轉換芯片采用AnalogDevices公司的12位4通道數(shù)模轉換芯片DAC8412,,輸出電壓范圍為-10V~+10V,輸出的通道由DSP的地址低兩位A1和A0選擇,。DAC8412芯片的±10V輸入?yún)⒖茧妷河葾D688芯片產(chǎn)生,。

  5、試驗與分析

  a) 通道精度測試

  1) A/D電路精度測試

  用標準電壓源測試A/D電路的采樣精度,,測試結果如圖9所示,。圖中橫軸為輸入到A/D電路的標準電壓源電壓值,縱軸為AD7656芯片轉換出的數(shù)據(jù),,圖中黑點為實際測試的數(shù)據(jù)點,,直線為理想狀態(tài)下的A/D電路采樣曲線。

A/D電路精度測試結果

圖9 A/D電路精度測試結果

  可以看出,,測試的數(shù)據(jù)點基本上位于理想A/D電路采樣曲線上,,為此算法中不需要對A/D電路采樣的數(shù)據(jù)進行補償。

  2) D/A電路精度測試

  通過輸出標定值來標定D/A電路的輸出精度,,測試結果如圖10所示,。圖中橫軸為DAC8412要輸出的標定電壓值數(shù)據(jù),縱軸為D/A電路實際輸出的電壓值,,圖中黑點為實際測試的數(shù)據(jù)點,,直線為理想狀態(tài)下的D/A電路輸出曲線。

 D/A電路精度測試結果

圖10 D/A電路精度測試結果

  可以看出,,測試的數(shù)據(jù)點基本上位于理想D/A電路輸出曲線上,,為此算法中不需要對D/A電路輸出的電壓值進行補償,。

  b) 伺服周期的設定

  采樣周期是數(shù)字控制系統(tǒng)的一個非常重要的指標,高性能伺服控制系統(tǒng)一般采樣率不小于1KHz,,為此要測量算法運行所需的時間,,確保其在伺服周期內(nèi)完成。

  利用DSP的IO口,,在算法運行之前置IO口為低電平,,算法運行之后置IO口為高電平,從示波器測量出低電平的時間即為算法運行所需時間,,測試結果如圖11所示,。可以看出算法運行所需時間為55 ,,滿足一般高精度數(shù)字控制系統(tǒng)的控制頻率為1kHz要求,。本設計中設定采樣周期1ms。

算法運行所需時間測試結果

圖11 算法運行所需時間測試結果

  c) 控制系統(tǒng)動態(tài)測試

  1) 階躍響應

  為系統(tǒng)加入階躍信號,,用示波器測量得到階躍響應曲線如圖12所示,。圖中上方的曲線為給定階躍信號曲線,下方的曲線為系統(tǒng)的響應曲線,??梢钥闯觯仙龝r間約為20ms,,峰值時間約為40ms,,調(diào)節(jié)時間約為100ms,超調(diào)量約為37%,。

系統(tǒng)階躍響應曲線

圖12 系統(tǒng)階躍響應曲線

  2) 系統(tǒng)頻率特性

  經(jīng)掃頻得到系統(tǒng)的閉環(huán)特性曲線如圖13所示,。從圖13可以看出,系統(tǒng)帶寬約為17Hz,。

系統(tǒng)的閉環(huán)特性曲線

圖13 系統(tǒng)的閉環(huán)特性曲線

  6,、結論

  穩(wěn)定環(huán)路是光電穩(wěn)瞄系統(tǒng)的關鍵,影響到光電穩(wěn)瞄的穩(wěn)定性能,。論文設計的控制器可以滿足光電穩(wěn)瞄的應用需求,,搭建的數(shù)字控制硬件平臺為在機載光電穩(wěn)瞄控制中實現(xiàn)復雜的算法建立了實現(xiàn)平臺。從仿真和試驗的結果可以看出,,數(shù)字控制實現(xiàn)機載光電穩(wěn)瞄穩(wěn)定控制設計簡單且可靠,,系統(tǒng)穩(wěn)定性能和動態(tài)品質較好。數(shù)字控制在機載光電穩(wěn)瞄穩(wěn)定環(huán)路控制中得到了成功應用,,系統(tǒng)穩(wěn)定控制器的設計和調(diào)試變得簡單,、靈活、高效,。論文也為其它復雜算法在機載光電穩(wěn)瞄中應用打下了基礎,。

此內(nèi)容為AET網(wǎng)站原創(chuàng),,未經(jīng)授權禁止轉載。