張恩東,李 焱,張玉東,陳 寧,李 珍
(1.長春工業(yè)大學,長春 130012; 2.中國科學院 長春光學精密機械與物理研究所,長春 130033; 3.北京鼎漢技術有限公司,北京 100070)
基于直流力矩電機快速定位光電伺服系統(tǒng)設計
張恩東1,李 焱2,張玉東3,陳 寧2,李 珍2
(1.長春工業(yè)大學,長春 130012; 2.中國科學院 長春光學精密機械與物理研究所,長春 130033; 3.北京鼎漢技術有限公司,北京 100070)
光電設備大角度失調時需要快速定位來重新捕獲跟蹤目標。傳統(tǒng)的方法為Bang-Bang控制,單Bang-Bang控制在精確定位時,極易出現(xiàn)抖振現(xiàn)象,針對這一不足,基于直流力矩電機提出了一種雙??刂?,即大角度調轉時采用非線性Bang-Bang控制,在精定位,且目標滿足圖像提取閾值時,切換為線性控制,線性控制分為兩個階段,在紅外捕獲過程中,位置回路采用一階調節(jié)器,在紅外跟蹤環(huán)節(jié),位置回路切換為二階調節(jié)器,并結合脫靶量信息完成紅外捕獲、跟蹤的閉環(huán)控制。通過試驗,在給定的某直流力矩電機的基礎上,加以雙??刂坪臀恼陆o定的切換準則,光電設備180°快速定位在1.9 s左右,比傳統(tǒng)方法縮短了近0.5 s,快速性大大提高,同時利用激光測距機可以給出舷角相差180°的單目標三維信息數(shù)據(jù)率為0.53 Hz,穩(wěn)定性達到設計要求,提高了快速定位時光電對抗能力。
快速定位;Bang-Bang控制;直流力矩電機;雙??刂?;三維信息
光電設備大角度失調時需要快速定位來重新捕獲跟蹤目標。傳統(tǒng)的控制方式是Bang-Bang控制,在系統(tǒng)偏差大時Bang-Bang控制可以加大對系統(tǒng)的控制力度,提高系統(tǒng)的快速性。文獻[1]將Bang-Bang控制應用到雷達,利用相平面法分析了Bang-Bang控制的不足;文獻[2]針對光電設備的快速定位提出了一種非線性控制和線性控制結合的方法,但是對線性控制并沒有進行詳細介紹,試驗結果不盡人意。文獻[3]針對步進電機,提出一種小偏差控制策略,但是具有很大的局限性。文獻[4]針對位置伺服系統(tǒng)提出了一種新的快速定位的方法,即在復合控制的基礎上,增加一自適應前置濾波器以改善系統(tǒng)動態(tài)性能,實現(xiàn)快速定位及跟蹤,但是僅僅停留在理論及仿真上,并未在實際工程中加以應用。文獻[5]基于Bang-Bang控制原理,采用廉價編碼盤實現(xiàn)高性能快速定位最優(yōu)系統(tǒng),但是定位精度低,不適用于光電跟蹤設備。
本文首先分析了Bang-Bang控制的原理和不足,在此基礎上基于直流力矩電機提出了一種雙??刂疲创蠼嵌日{轉時采用非線性Bang-Bang控制,在精定位,且目標滿足圖像提取閾值時,切換為線性控制,線性控制分為兩個階段,在紅外捕獲過程中,位置回路采用一階調節(jié)器,在紅外跟蹤環(huán)節(jié),位置回路切換為二階調節(jié)器,并結合脫靶量信息完成紅外捕獲、跟蹤的閉環(huán)控制。本文同時給出了非線性Bang-Bang控制和線性控制的最優(yōu)切換準則,紅外捕獲階段和紅外跟蹤階段的切換準則,在工程試驗中,取得了良好的試驗效果,提高了光電設備大角度快速定位時光電對抗能力。
1.1Bang-Bang控制原理及不足
Bang-Bang控制是最優(yōu)控制中極小值原理的一個特列。本文首先分析了Bang-Bang控制的原理和其應用于光電設備大角度失調時快速定位時的不足,在此基礎上提出了雙模控制的控制方法,原理圖如圖1所示。
圖1 雙??刂圃韴D
設電機及跟蹤架的傳遞函數(shù):
T為速度回路等效時間常數(shù)。
由Bang-Bang控制的狀態(tài)可知,u=+1時:
u=-1時:
歸納式(4)、式(5)可得如下切換方程:
其中:
本系統(tǒng)采用閉環(huán)控制,所以Δθ=θi-θ,設θi=0,則Δθ=-θ,將Δθ=-θ帶入式(6)可得:
由式(3)可得開關線方程:
1.2線性控制的數(shù)字實現(xiàn)
光電設備快速定位伺服系統(tǒng)是一個位置跟隨系統(tǒng),直流力矩電機因其力矩大、響應快、控制精度高等優(yōu)點廣泛作為光電設備的執(zhí)行元件。光電設備由方位和俯仰兩套獨立的子系統(tǒng)構成,采用速度和位置雙閉環(huán)回路控制,本文數(shù)學模型的建立以重點研究方位直流力矩電機為例。光電設備快速定位伺服系統(tǒng)原理圖如圖2所示。
圖2 光電設備快速定位伺服系統(tǒng)原理圖
速度回路的作用是減小電機時間滯后,提高系統(tǒng)的快速性,通過閉環(huán),降低力矩等干擾誤差。圖3是速度回路閉環(huán)后的Bode圖-3db處W要大于100即滿足系統(tǒng)穩(wěn)定條件。
圖3 速度回路閉環(huán)波特圖
位置回路的設計是要滿足一定速度、加速度下的穩(wěn)態(tài)和動態(tài)性能指標。圖4是位置回路閉環(huán)后的Bode圖,閉環(huán)帶寬ωbp=20.2 rad/s。
圖4 位置回路閉環(huán)波特圖
圖5 ark=1 900時電機加速曲線
1.4硬件構成
控制器采用DSP2812作為CPU核心,該芯片運算速度為150 MIPS,使用DSP作為中心處理單元和控制單元大大提高了系統(tǒng)的集成度。通過利用處理器自身資源和擴展外圍器件,系統(tǒng)具有4路異步通訊串行接口、24路通用輸入輸出接口、8路PWM輸出接口。其伺服系統(tǒng)硬件原理圖如圖6所示。激光測距系統(tǒng)采用1.06 μm波長的光源,紅外系統(tǒng)采用像元數(shù)為 的中波紅外焦平面探測器組件一套,光學系統(tǒng)的視場均為 ,可實現(xiàn)跟蹤功能。
圖6 伺服系統(tǒng)硬件原理圖
圖7 三種狀態(tài)階躍響應
當紅外從捕獲階段切換為跟蹤階段時,開啟激光測距機,對于往返調轉,為了保證激光測距的準確性,我們保持4幀,其中激光測距機前4幀距離信息中有3幀以上為激光探測值則激光測距視為有效。圖8為目標跟蹤時的模擬圖像。
圖8 目標跟蹤時的模擬圖像
圖9是雙??刂茣r90°往返定位的錄取報文的截取片段,讀取報文可知方位角、俯仰角的位置信息,分析激光測距反饋的距離信息是否為探測值可知激光測距機反饋距離信息是否穩(wěn)定。
圖9 雙??刂其浫笪膱D
系統(tǒng)要求單180°定位時,定位時間不超過3s。對本系統(tǒng)典型大角度定位能力做出以下統(tǒng)計,如表1所示。由試驗可知,雙??刂葡?,快速定位能力完全滿足系統(tǒng)要求。
表1 典型定位角度所用實際時間
本文基于直流力矩電機提出了一種雙??刂?,即大角度調轉時采用非線性Bang-Bang控制,在精定位,且目標滿足圖像提取閾值時,切換為線性控制,線性控制分為兩個階段,在紅外捕獲過程中,位置回路采用一階調節(jié)器,在紅外跟蹤環(huán)節(jié),位置回路切換為二階調節(jié)器,并結合脫靶量信息完成紅外捕獲、跟蹤的閉環(huán)控制。通過試驗,在給定的某直流力矩電機的基礎上,加以雙??刂坪臀恼陆o定的切換準則,光電設備180°快速定位在1.9s左右,比傳統(tǒng)方法縮短了近0.5s,快速性大大提高,同時利用激光測距機可以給出舷角相差180°的雙目標三維信息數(shù)據(jù)率為0.53Hz,穩(wěn)定性達到設計要求,提高了快速定位時光電對抗能力。
[1] 周永清.雷達伺服快速定位Bang-Bang控制的數(shù)字實現(xiàn)[J].系統(tǒng)工程與電子技術,1989(5):41-47.
[2] 謝慕君,葛文奇.快速定位系統(tǒng)最佳轉換點的確定[J].光學精密工程,1997,5(4)53-57.
[3] 李 漢.一種步進電機快速準確定位系統(tǒng)的設計及其分析[J].微電機,2012,45(9):92-95.
[4] 孫麟治,李鳴鳴,程維明.精密定位技術研究 [J].光學精密工程,2005,13:70-75.
[5] 張寅孩,張仲超.用Bang-Bang控制策略實現(xiàn)快速定位最優(yōu)系統(tǒng)[J].電力電子技術,2003,37(1):22-24.
[6]SUChuan,CHENGFT,HUANGMH,etal.Intelligentprgnosticssystemdesignandimplementation[J].IEEETransactionsonSemiconductorManufcturing,2006,19(2):195207.
[7] 陳娟. 數(shù)字化光電跟蹤系統(tǒng)定位極限環(huán)的研究[D]. 長春:中國科學院長春光學精密機械與物理研究所,2003.
[8] 葛兵,高慧斌.艦載經(jīng)緯儀視軸自穩(wěn)定方法[J].艦船科學技術,2006.28(6):93-96.
[9] 徐佑軍,劉金碩.跟瞄伺服快速定位的數(shù)字控制[J].微機發(fā)展,2002(1):88-90.
[10]VANZWIETENJH,DRISCOLLFR,VANZWIETENTS,etal.Developmentofanadaptivedisturbancerejectionsystemfortherapidlydeployablestableplatform-part2controllerdesignandclosedloopresponse[J].OceanEngineering,2010,37(14/15):1367-1379.
[11]WANGGL,XUD,GYUY.Anovelstrategyofdead-time.compensationforPWMvoltage-sourceInverter[C]//AppliedPowerElectronicsConferenceandExpositionTwenty-ThirdAnnual.2008:1779-1783.
[12] 胡壽松.自動控制原理[M].北京:科學出版社,2007.
DesignofPhotoelectricFastPositioningServoSystemBasedonDCTorqueMotor
ZHANGEn-dong1,LIYan2,ZHANGYu-dong3,CHENNing2,LIZhen2
(1.Changchun University of Technology,Changchun 130012,China; 2.Changchun Institute of Optics, Fine Mechanics and Physics,CAS,Changchun 130033,China;3.Beijing Dinghan Technology Co.,Ltd.,Beijing 100070,China)
Large angle misalignment of optoelectronic devices need to quickly locate to recapture tracking target. traditional method is using Bang-Bang control, when the Bang-Bang control is precise positioning, the system is not easy to be stable . For this deficiency, this paper presents a kinds of double model control, namely the coarse tracking uses Bang-Bang control, when the extraction threshold of the image satisfied for thecontrast of the target, it switches linear control into the small deviation range, and during the linear control, it puts forward the strategy of infrared an order capturing and infrared second-order tracking depending on the characteristics of different regulators, and combines the IR information to accomplish the closed-loop control of IR tracking. Using this method and the switching criteria what the paper has given, it achieved good results in the experiment, which makes the photoelectric device spend around 1.9 s in 180° position, it is shorter nearly 0.5 s than traditional method, at the same time, the laser rangefinder gives the rate of three-dimensional information about 0.53 Hz, meet the design requirements of stability and improve the optoelectric count measure ability.
fast positioning; Bang-Bang control; DC torque motor; double model control; three-dimensional information
2015-07-23
TM33;TM359.6
:A
:1004-7018(2016)11-0054-03
張恩東(1989-),男,碩士研究生,主要從事電力電子與電氣傳動、艦載光電設備伺服控制、快速定位伺服控制等研究。