基于改進(jìn)干擾觀測(cè)器的艦載光電跟蹤系統(tǒng)重復(fù)控制?

王 玨

（艦艇學(xué)院作戰(zhàn)軟件與仿真研究所 大連 116011）

基于改進(jìn)干擾觀測(cè)器的艦載光電跟蹤系統(tǒng)重復(fù)控制?

王 玨

（艦艇學(xué)院作戰(zhàn)軟件與仿真研究所 大連 116011）

為降低干擾力矩對(duì)光電跟蹤系統(tǒng)精度的影響，提出了基于改進(jìn)干擾觀測(cè)器的光電跟蹤系統(tǒng)重復(fù)控制方法。首先，分析了傳統(tǒng)干擾觀測(cè)器的缺點(diǎn)，提出了改進(jìn)干擾觀測(cè)器；然后，對(duì)由直流力矩電機(jī)驅(qū)動(dòng)的光電跟蹤系統(tǒng)進(jìn)行了建模；最后，在改進(jìn)的干擾觀測(cè)器基礎(chǔ)上為光電跟蹤系統(tǒng)位置環(huán)設(shè)計(jì)了重復(fù)控制器，并加入到系統(tǒng)中。仿真結(jié)果表明，相對(duì)于傳統(tǒng)的PID控制器，所設(shè)計(jì)的控制器加快了反應(yīng)速度，大幅提高了控制精度。

干擾觀測(cè)器；光電跟蹤；重復(fù)控制；干擾力矩

1 引言

艦載光電跟蹤系統(tǒng)是一種具有高探測(cè)能力和精密跟蹤性能的，在目標(biāo)動(dòng)態(tài)測(cè)量、軌跡跟蹤記錄、偵查監(jiān)視、定位通信、制導(dǎo)瞄準(zhǔn)等軍事領(lǐng)域廣泛應(yīng)用的設(shè)備［1］。艦載光電系統(tǒng)與陸基光電系統(tǒng)相比，其最本質(zhì)的區(qū)別在于前者安裝在艦載的動(dòng)基座環(huán)境中，因而存在很多干擾［2～4］，這給跟蹤指向帶來新的挑戰(zhàn)和更高的要求。目前，光電跟蹤控制系統(tǒng)的工程實(shí)踐中廣泛使用PID控制，復(fù)合控制等技術(shù)。PID控制［5］存在控制器參數(shù)修改不方便、不能實(shí)時(shí)在線進(jìn)行調(diào)整等缺點(diǎn)；復(fù)合控制技術(shù)需要的脫靶量信息通常存在滯后，因而對(duì)脫靶量的跟蹤不具備實(shí)用價(jià)值，且其中的前饋控制環(huán)節(jié)也會(huì)給系統(tǒng)帶來擾動(dòng)。

為提高艦載光電跟蹤系統(tǒng)的跟蹤精度，本文提出了基于改進(jìn)干擾觀測(cè)器的光電跟蹤系統(tǒng)重復(fù)控制方法。

重復(fù)控制［6］具有控制器結(jié)構(gòu)簡(jiǎn)單、在線調(diào)整方便、穩(wěn)態(tài)控制精度高、控制性能具有非參數(shù)依賴性、能夠穩(wěn)態(tài)無差地跟蹤周期已知的任意周期信號(hào)，以及滿足系統(tǒng)穩(wěn)定性、穩(wěn)態(tài)性能和動(dòng)態(tài)性能的魯棒性等特點(diǎn)。這些優(yōu)點(diǎn)使重復(fù)控制非常適合應(yīng)用于艦載光電跟蹤系統(tǒng)。

為獲取干擾量，提出了一種基于參考模型擾動(dòng)估計(jì)的前饋控制器。相比于傳統(tǒng)觀測(cè)器，它能夠更好地估計(jì)系統(tǒng)動(dòng)態(tài)擾動(dòng)，解決脫靶量和前饋補(bǔ)償?shù)亩螖_動(dòng)問題，保證了系統(tǒng)的穩(wěn)定性，且響應(yīng)時(shí)間快，動(dòng)態(tài)性能好。

綜上所述，提出了重復(fù)控制與改進(jìn)的干擾觀測(cè)器相結(jié)合的方法，設(shè)計(jì)了基于改進(jìn)干擾觀測(cè)器的光電跟蹤系統(tǒng)重復(fù)控制器，將兩者的優(yōu)點(diǎn)相結(jié)合。并對(duì)所設(shè)計(jì)的控制器進(jìn)行了仿真計(jì)算，驗(yàn)證了控制方法的正確性和有效性。

2 干擾觀測(cè)器的改進(jìn)

2.1 干擾觀測(cè)器（DOB）簡(jiǎn)介及分析

干擾觀測(cè)器的基本思想是：把實(shí)際的系統(tǒng)輸出與標(biāo)準(zhǔn)模型的系統(tǒng)輸出之差應(yīng)用于標(biāo)準(zhǔn)模型，估計(jì)出等效干擾，并將其作為補(bǔ)償信號(hào)反饋到輸入端抵消系統(tǒng)擾動(dòng)［7］。圖1所示為干擾觀測(cè)器的標(biāo)準(zhǔn)結(jié)構(gòu)。

圖1中，ut為輸入，d為外部干擾，ξ為測(cè)量誤差；P(s)為實(shí)際的被控對(duì)象，Pn(s)為對(duì)象的標(biāo)稱模型，(s)為標(biāo)稱模型的逆模型；Q(s)是一個(gè)低通濾波器，δ為等效補(bǔ)償項(xiàng)，為干擾估計(jì)值。

干擾觀測(cè)器存在如下缺點(diǎn)：濾波器Q(s)對(duì)系統(tǒng)輸出和誤差估計(jì)都起著較大作用，影響了系統(tǒng)的抗干擾能力；控制對(duì)象P(s)不是零階，因此(s)在物理上很難實(shí)現(xiàn)；P(s)中含有一階環(huán)節(jié)，因此(s)中的微分環(huán)節(jié)會(huì)放大測(cè)量誤差ξ，降低了系統(tǒng)的控制精度。

2.2 參考模型擾動(dòng)估計(jì)的前饋控制器

為克服第一節(jié)中出現(xiàn)的問題，并繼承觀測(cè)器干擾估計(jì)能力的優(yōu)點(diǎn)，對(duì)干擾觀測(cè)器進(jìn)行改進(jìn)，將參考模型自適應(yīng)理論與干擾觀測(cè)器原理相結(jié)合［8］，將參考模型與實(shí)際被控對(duì)象輸出誤差比較得到擾動(dòng)量的估計(jì)值，并且將其中的擾動(dòng)估計(jì)作為速度前饋加入控制系統(tǒng)中，實(shí)現(xiàn)實(shí)時(shí)補(bǔ)償系統(tǒng)擾動(dòng)［9～10］?？刂破鹘Y(jié)構(gòu)如圖2所示。

圖2中uv為速度輸入，d為力矩?cái)_動(dòng)，ur為速度擾動(dòng)估計(jì)值；ym為參考模型輸出，y為被控對(duì)象輸出，二者差值為ee；G(s)為速度調(diào)節(jié)器，P(s)為被控對(duì)象，P1(s)為參考模型，Gp(s)為擾動(dòng)補(bǔ)償器。其工作原理為：比較速度輸入uv通過被控對(duì)象響應(yīng)和參考模型相應(yīng)就可以估計(jì)出由力矩?cái)_動(dòng)d帶來的速度響應(yīng)ee。將ee通過補(bǔ)償器Gp(s)等效為補(bǔ)償速度ur前饋至速度環(huán)中從而補(bǔ)償力矩?cái)_動(dòng)對(duì)光電系統(tǒng)的性能的影響?？刂破髦袥]有使用被控對(duì)象標(biāo)稱逆模型，物理上容易實(shí)現(xiàn)，而且避免了干擾觀測(cè)器微分放大誤差的問題。

由圖2可得輸入輸出的關(guān)系和速度擾動(dòng)估計(jì)方程為

設(shè)模型測(cè)量準(zhǔn)確，P(s)與P1(s)完全匹配，化簡(jiǎn)式子（9）得

由式（2）可知，系統(tǒng)開環(huán)傳遞函數(shù)為：G(s) P(s)，可見，在此方法中，前饋控制器并沒有改變系統(tǒng)的開環(huán)特性，不影響系統(tǒng)的穩(wěn)定性。

在新課標(biāo)要求下小學(xué)體育學(xué)科教學(xué)也有了新的發(fā)展方向，這些新的發(fā)展方向一方面指引著小學(xué)體育學(xué)科教學(xué)活動(dòng)的開展，另一方面也代表了教師在小學(xué)體育學(xué)科教學(xué)中必須采取新的方法。目前，在小學(xué)體育學(xué)科教學(xué)中所突出的新發(fā)展方向主要體現(xiàn)在以下方面：

前饋調(diào)節(jié)器Gp(s)是一個(gè)比例低通濾波器。前饋回路的低通濾波器能很好地濾除測(cè)量誤差，又能保證系統(tǒng)的穩(wěn)定。比例環(huán)節(jié)是基于誤差調(diào)節(jié)的，能夠加快響應(yīng)速度、縮短調(diào)節(jié)時(shí)間。

3 基于改進(jìn)干擾觀測(cè)器的光電跟蹤系統(tǒng)重復(fù)控制器

3.1 光電跟蹤系統(tǒng)建模

該系統(tǒng)的被控對(duì)象部分采用雙環(huán)控制結(jié)構(gòu)，分別為速度環(huán)和電流環(huán)。速度環(huán)是已經(jīng)設(shè)計(jì)好的PI控制器；其模型如圖3所示。

無刷直流力矩電機(jī)是一種特別的直流伺服電機(jī)，忽略電樞中電流的波動(dòng)性，把電流看作直流，這時(shí)無刷直流力矩電機(jī)近似為線性元件［11］。由電機(jī)的工作原理可推出電樞回路的電壓平衡方程為

其中，U為電樞兩端的平均電壓；R，i，L分別為電樞回路的電阻，電流和電感；反電勢(shì)e為

其中，Ke，θ?分別為電機(jī)的反電勢(shì)系數(shù)和轉(zhuǎn)角速度。

電機(jī)的電磁力矩與電流成正比

其中，Md為電磁力矩，Km為電磁力矩系數(shù)。

定義艦艇搖擺力矩干擾為My，電機(jī)的轉(zhuǎn)矩平衡方程可以表示為

式中，J為負(fù)載等效轉(zhuǎn)動(dòng)慣量。

3.2 基于改進(jìn)干擾觀測(cè)器的重復(fù)控制

重復(fù)控制是在20世紀(jì)80年代初由Moue等提出的一種學(xué)習(xí)控制方法［12］。在采用其他控制技術(shù)很難獲得很高的控制精度的情況下，重復(fù)控制因其控制精度高、實(shí)現(xiàn)簡(jiǎn)單以及控制性能的非參數(shù)依賴性，很快成為解決周期性外激勵(lì)信號(hào)控制問題的一種有效方法［13］。

重復(fù)控制是一種基于內(nèi)模原理的控制方法。如果某一信號(hào)可視為一個(gè)自治系統(tǒng)的輸出，將這一信號(hào)的模型設(shè)置在穩(wěn)定的閉環(huán)系統(tǒng)中，則此反饋系統(tǒng)可實(shí)現(xiàn)對(duì)此信號(hào)的完全跟蹤或抑制［14］?；趦?nèi)模原理，通過在控制器中引入一個(gè)時(shí)滯正反饋環(huán)節(jié)，由時(shí)滯環(huán)節(jié)的記憶特性不斷累積誤差信息進(jìn)行反復(fù)學(xué)習(xí)，從而使系統(tǒng)能夠穩(wěn)態(tài)無差地跟蹤或抑制周期己知的任意周期信號(hào)［15］。

而艦載光電系統(tǒng)與路基系統(tǒng)相比要受到海浪力矩的干擾，一段時(shí)間內(nèi)海浪干擾可以視為周期信號(hào)，因此重復(fù)控制是提高艦載光電系統(tǒng)跟蹤精度的一種有效方法。其基本結(jié)構(gòu)圖如圖4所示。

在重復(fù)控制中，一般期望重復(fù)控制作用在高頻段的增益減小，保證系統(tǒng)穩(wěn)定。為此，在重復(fù)控制中經(jīng)常加入低通濾波器Q(s)，如圖5所示。

將改進(jìn)的重復(fù)控制器加到參考模型擾動(dòng)前饋控制器前，組成基于改進(jìn)干擾觀測(cè)器的光電跟蹤系統(tǒng)重復(fù)控制器?；诟倪M(jìn)型干擾觀測(cè)器的重復(fù)控制系統(tǒng)即利用了觀測(cè)器的補(bǔ)償作用，又利用了重復(fù)控制的重復(fù)疊加提高精度的特性。如圖6所示。

4 仿真實(shí)驗(yàn)及分析

4.1 參數(shù)設(shè)置

L近似等于0，設(shè)定仿真參數(shù)為：Ke=1.2V/(rad/s)，Ke1=0.16V/(rad/s)，Km=6N·m/A ，R=8Ω，J=0.465N·m。PID控制器參數(shù)為：Kp=120，Ki=8，Kd=5。速度PI控制器參數(shù)為：Kpv=10，Kiv=1；KPWM=10；根據(jù)比較點(diǎn)移動(dòng)原理求出 Ke2=0.9V/(rad/s)；艦艇搖擺力矩為：My=15sin2πtN·m 。

基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)仿真模型和基于改進(jìn)干擾觀測(cè)器的重復(fù)控制系統(tǒng)仿真模型分別如圖7～圖8所示。

4.2 結(jié)果分析

以階躍信號(hào)為輸入，分別運(yùn)行PID控制系統(tǒng)仿真模型、基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)仿真模型和基于改進(jìn)干擾觀測(cè)器的重復(fù)控制系統(tǒng)仿真模型輸出結(jié)果如圖9所示。

由圖9可見，由PID控制時(shí)，跟蹤系統(tǒng)受海浪力矩干擾嚴(yán)重，存在較大的超調(diào)，約為0.45%，調(diào)節(jié)時(shí)間較長(zhǎng)，約為0.42s；基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)有效減少了超調(diào)，約為0.28%；基于改進(jìn)干擾觀測(cè)器的重復(fù)控制系統(tǒng)則進(jìn)一步減小超調(diào)，約為0.22%，并同時(shí)提高了系統(tǒng)的反應(yīng)速度，減小了調(diào)節(jié)時(shí)間，約為0.34s。

以速度為θ?i=0.0175rad/s的低速跟蹤斜坡信號(hào)為輸入，對(duì)系統(tǒng)進(jìn)行仿真，誤差曲線如圖10所示；以θi=sin(πt)rad為輸入，對(duì)系統(tǒng)進(jìn)行仿真，結(jié)果如圖11所示。

由圖10可知，在海浪力矩的干擾下，斜坡信號(hào)的輸入下，PID控制系統(tǒng)的控制誤差在較大范圍內(nèi)變化，誤差均方根為1.2mrad，而基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)則有效抑制了海浪力矩的干擾，誤差均方根為0.034mrad，基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)進(jìn)一步抑制了海浪力矩的干擾，誤差均方根為0.026mrad；由圖11可知，在海浪力矩的干擾下，正弦信號(hào)輸入下PID控制系統(tǒng)的控制誤差在較大范圍內(nèi)變化，誤差均方根為1.9mrad，而基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)則有效抑制了海浪力矩的干擾，誤差均方根為1.7mrad，基于改進(jìn)干擾觀測(cè)器的控制系統(tǒng)進(jìn)一步抑制了海浪力矩的干擾，誤差均方根為1.3mrad。

5 結(jié)語

針對(duì)艦艇搖擺力矩對(duì)光電跟蹤系統(tǒng)控制精度的具有干擾的問題，本文將重復(fù)控制和干擾觀測(cè)器結(jié)合起來，融合了兩種控制系統(tǒng)的優(yōu)點(diǎn)，提出了基于改進(jìn)干擾觀測(cè)器的重復(fù)控制器，并建立了艦載光電跟蹤系統(tǒng)的仿真模型，進(jìn)行了仿真實(shí)驗(yàn)。結(jié)果表明，與傳統(tǒng)的PID控制相比，所提出的控制方法能夠有效抑制干擾，減小誤差，并改善系統(tǒng)的穩(wěn)態(tài)特性，從而提高了系統(tǒng)的快速性和抗干擾能力。

［1］張艷.提高艦載光電設(shè)備跟蹤精度的關(guān)鍵技術(shù)研究［M］.北京：中國科學(xué)院大學(xué)，2013.

［2］ W S Ra，I Zh Whang，J Y Ahn.Robust horizontal line-of-sight rate estimator for sea skimming anti-ship missile with two-axis gimballed seeker［J］.IEE Proceed?ings：Radar，Sonar and Navigation，2005，152（1）：9-15.

［3］O Yaakov，I Michael.Mini-UAV attitude estimation us?ing an hertially stabilized payload［J］.IEEE Transactions on Aerospace and Electronic Systems，1999，35（4）：1191-1203.

［4］ J Hilkert.Inertially stabilized platform technology［J］.IEEE Control SystemsMagazine，2008，28（1）：26-46.

［5］蔣鋒.基于ARM的光電跟蹤系統(tǒng)伺服控制器設(shè)計(jì)［M］.西安：中國科學(xué)院研究生院，2009.

［6］中野道雄，井上惠，原辰次，等.重復(fù)控制［M］.長(zhǎng)沙：吳敏中南工業(yè)大學(xué)出版社，1995：18-83.

［7］高亮.基于干擾觀測(cè)器的轉(zhuǎn)臺(tái)控制系統(tǒng)設(shè)計(jì)［M］.哈爾濱：哈爾濱工業(yè)大學(xué)，2007.

［8］李嘉全，丁策，王紹彬等.基于速度信號(hào)的擾動(dòng)觀測(cè)器及在光電穩(wěn)定平臺(tái)的應(yīng)用［J］.光學(xué)精密工程，2011，19（5）：998-1004.

［9］陳濤，陳娟，陳長(zhǎng)青.直流力矩電機(jī)低速自適應(yīng)跟蹤控制［J］. 光電工程，2003，30（3）：31-34.

［10］丁科，黃永梅，馬祖光等.抑制光束抖動(dòng)的快速反射鏡復(fù)合控制［J］.光學(xué)精密工程，2011，19（9）：1991-1998.

［11］陳霞，鄒繼斌.基于干擾觀測(cè)器的反作用力矩測(cè)試系統(tǒng)魯棒性設(shè)計(jì)［J］.電工技術(shù)學(xué)報(bào)，2010，25（7）：26-46.

［12］Mohammad M F，Maryam B.Modeling and Robust Dis?crete LQ Repetitive Control of Electrically Driven Robots［J］.International Journal of Automation and Computing，2013，10（5）：472-480.

［13］Tomizuka M，Tsao T，Chew K.Analysis and Synthesis of Discrete-Time Repetitive Controllers［J］.Journal of Dy?namic Systems，Measurement，and Control，1989，111（3）：353-358.

［14］Srinivasan K，Shaw F R.Analysis and design of repeti?tive control systems using the regeneration spectrum［J］.ASME Journal of Dynamic Systems，Measurement and Control：1991，113（2）：216-222.

［15］HARA S.Repetitive control system：a new type servo system for periodic exogenous signals［J］.IEEE Trans Autom Contrl，1988，33（7）：659-668.

Repetitive Control of Ship-based Photoelectric Tracking System Based on the Improved Disturbance Observer

WANG Jue
（Operational Software and Simulation Research Institute，Dalian Naval Academy，Dalian 116011）

In order to reduce the disturbance effect on the precision of the photoelectric tracking system，the paper puts for?ward the repetitive control method of photoelectric tracking system based on the improved disturbance observer.Firstly，this paper analyzes the shortcomings of traditional disturbance observer and puts forward an improved disturbance observer.Then，makes the model of photoelectric tracking system driven by DC torque motor.Finally，on the basis of the improved disturbance observer for photoelectric tracking system position the loop repetitive controller is designed，and added to the system.The simulation results show that，compared with the traditional PID controller，the controller accelerates the reaction speed，greatly improves the control precision。

disturbance observer，photoelectric tracking，repetitive control，disturbance torque

V556

10.3969/j.issn.1672-9730.2017.11.033

Class Number V556

2017年5月16日，

2017年6月17日

王玨，男，碩士研究生，研究方向：艦載光電系統(tǒng)視軸穩(wěn)定技術(shù)。