鄭 穎，馬大為，姚建勇，樂貴高

(南京理工大學(xué) 機械工程學(xué)院，江蘇 南京 210094)

基于自抗擾技術(shù)的火箭炮伺服系統(tǒng)解耦控制

鄭 穎，馬大為，姚建勇，樂貴高

(南京理工大學(xué) 機械工程學(xué)院，江蘇 南京 210094)

火箭炮伺服系統(tǒng)為方位和俯仰兩軸耦合的伺服系統(tǒng)。為研究發(fā)射時的兩軸耦合問題及燃氣流沖擊強干擾影響，建立了火箭炮伺服系統(tǒng)雙軸轉(zhuǎn)臺動力矩方程和耦合系統(tǒng)微分方程，采用基于自抗擾技術(shù)的解耦控制方法設(shè)計了擴張狀態(tài)觀測器及虛擬控制量。通過擴張狀態(tài)觀測器估計系統(tǒng)總擾動并進行實時補償，通過虛擬控制量得到實際控制量對耦合系統(tǒng)進行控制。仿真結(jié)果表明,基于自抗擾技術(shù)的解耦控制提高了火箭炮伺服系統(tǒng)跟蹤精度，使系統(tǒng)在兩軸負載轉(zhuǎn)矩耦合效應(yīng)和燃氣流沖擊下有效地抑制了發(fā)射平臺振動,滿足控制性能指標，對火箭炮兩軸耦合控制問題具有一定的理論意義和實用價值。

兵器科學(xué)與技術(shù)；火箭炮；伺服系統(tǒng)；兩軸耦合；自抗擾； 解耦控制

火箭炮伺服系統(tǒng)是方位和俯仰兩軸耦合的系統(tǒng)，在發(fā)射過程中伺服系統(tǒng)受到兩軸負載轉(zhuǎn)矩耦合影響，以往火箭炮伺服系統(tǒng)通常只考慮單軸控制，忽略了兩軸耦合的特點。因此考慮火箭炮伺服系統(tǒng)作為雙輸入雙輸出系統(tǒng)，研究兩軸耦合效應(yīng)是有必要的。對多變量系統(tǒng)采用魯棒控制[1]的計算量較大。依靠自抗擾控制技術(shù)能較好地解決解耦控制，并且計算量不大，魯棒性好[2]。自抗擾控制方法在多輸入多輸出系統(tǒng)中得到廣泛應(yīng)用[3-5]，具有較好的控制效果。筆者建立了火箭炮伺服系統(tǒng)方位和俯仰兩軸耦合的動力矩方程及雙輸入雙輸出系統(tǒng)微分方程。基于自抗擾技術(shù)的解耦控制方法采用跟蹤微分器、擴張狀態(tài)觀測器和誤差反饋得到虛擬控制量，從而對耦合伺服系統(tǒng)進行控制，具有較好的跟蹤精度并有效抑制了燃氣流沖擊影響。

1 火箭炮耦合系統(tǒng)建模

火箭炮兩軸耦合系統(tǒng)坐標系關(guān)系變換如圖1所示。方位軸框架(包括俯仰軸框架)繞其轉(zhuǎn)動軸Oza逆時針轉(zhuǎn)動角度γ，俯仰軸框架繞其轉(zhuǎn)動軸Oyp逆時針旋轉(zhuǎn)角度β。假設(shè)方位軸和俯仰軸框架相對于各自的坐標軸系是軸對稱的，方位軸框架(含俯仰軸框架)相對于方位軸框架轉(zhuǎn)動軸Oza的轉(zhuǎn)動慣量為

JOza=Jza+Jxpsin2β+Jzpcos2β

(1)

式中：Jxp為俯仰軸框架繞Oxp軸旋轉(zhuǎn)的轉(zhuǎn)動慣量；Jzp為俯仰軸框架繞Ozp軸旋轉(zhuǎn)的轉(zhuǎn)動慣量；Jza為方位軸框架(不包括俯仰軸框架)繞Oza軸旋轉(zhuǎn)的轉(zhuǎn)動慣量。

俯仰軸框架相對于轉(zhuǎn)動軸Oyp的轉(zhuǎn)動慣量為：

JOyp=Jyp

(2)

式中Jyp為俯仰軸框架繞Oyp軸旋轉(zhuǎn)的轉(zhuǎn)動慣量。

方位軸框架轉(zhuǎn)動時的角速度矢量為

(3)

俯仰軸框架角速度為

(4)

剛體的歐拉動力學(xué)方程為[6]

(5)

將式(1)～(4)代入式(5)得兩軸轉(zhuǎn)矩方程為

(6)

(7)

俯仰軸和方位軸電機電磁轉(zhuǎn)矩方程為

(8)

(9)

式中：KTp、KTa分別為俯仰軸和方位軸電機轉(zhuǎn)矩系數(shù)；Rp、Ra分別為兩軸電樞電阻；Up、Ua分別為兩軸電機電樞端相電壓；np、na分別為兩軸減速器減速比；Kep、Kea分別為兩軸電機電勢系數(shù)。

兩軸運動方程為

式中：折算到俯仰軸和方位軸電機端的電機及負載轉(zhuǎn)動慣量分別為Jp=9.323×10-3kg·m2，Ja=0.033 kg·m2； 粘滯摩擦系數(shù)分別為Bp=1.43×10-4N·m·s/rad，Ba=1.716×10-4N·m·s/rad; 兩軸電勢系數(shù)分別為Kep=0.64 V·s/rad，Kea=0.78 V·s/rad;電樞繞組電阻分別為Rp=2.6 Ω，Ra=1.32 Ω;電機轉(zhuǎn)矩系數(shù)分別為KTp=1.11 N·m·A-1，KTa=1.34 N·m·A-1;np=231,na=192;JOza=1 192 kg·m2,JOyp=474 kg·m2。

(12)

將各參數(shù)數(shù)值代入(12)得耦合系統(tǒng)微分方程為

(13)

2 解耦控制

記兩軸電機輸入相電壓虛擬控制量為

(14)

式中,B(t)為耦合系統(tǒng)輸入矩陣。

基于自抗擾技術(shù)的控制算法為[7]

(15)

(16)

(17)

函數(shù)fhan(q1,q2,r,h)定義為

(18)

由式(14)得火箭炮伺服系統(tǒng)兩軸實際輸入電壓值為：

(19)

3 系統(tǒng)仿真

火箭炮耦合系統(tǒng)兩軸控制器參數(shù)為：r0=500,h=0.01,β1=100,β2=500,β3=3 000,c=1,h1=0.01,r=500。兩軸過渡過程初始值均設(shè)為0，擴張狀態(tài)觀測器初始值均設(shè)為0。

在MATLAB/Simulink中通過S函數(shù)建立仿真模型，耦合系統(tǒng)模型為式(13)所示模型，系統(tǒng)輸入分別為俯仰和方位兩軸實際輸入相電壓Up和Ua，系統(tǒng)輸出分別為火箭炮兩軸負載旋轉(zhuǎn)角度β和γ，仿真時間10 s。由式(13)得耦合系統(tǒng)輸入矩陣為

給定火箭炮耦合系統(tǒng)伺服跟蹤5 s后每0.5 s間隔發(fā)射一次，俯仰軸和方位軸所受燃氣流沖擊力矩和其他負載擾動如圖2所示。

擴張狀態(tài)觀測器對兩軸負載旋轉(zhuǎn)角度的估計值和實際輸出角度的誤差如圖3所示。 由圖3可得擴張狀態(tài)觀測器能很好估計兩軸負載旋轉(zhuǎn)角度值，估計精度較高。

兩軸電機輸入端電壓控制量Up和Ua如圖4所示?；鸺隈詈舷到y(tǒng)兩軸輸入輸出角度誤差如圖5所示。由圖5可得兩軸伺服跟蹤精度高，跟蹤角度誤差小于1mrad，滿足控制性能指標。在燃氣流沖擊力矩和負載擾動條件下，耦合系統(tǒng)有效抑制了發(fā)射平臺振動，使輸入輸出角度誤差限制在1 mrad內(nèi)，保證了后續(xù)射彈精度。

該解耦控制方法和傳統(tǒng)PID控制方法對耦合系統(tǒng)的控制誤差對比如圖6所示。由圖6可得火箭炮耦合系統(tǒng)采用傳統(tǒng)PID控制輸入輸出角度誤差大于1 mrad，不能滿足性能指標。自抗擾控制對耦合系統(tǒng)的控制精度明顯高于PID控制，抑制了系統(tǒng)的耦合效應(yīng)，并有效抑制了燃氣流沖擊對火箭炮系統(tǒng)的影響。

4 結(jié)論

筆者針對火箭炮耦合系統(tǒng)兩軸聯(lián)動時負載耦合的特點，建立了耦合系統(tǒng)的動力矩方程和控制系統(tǒng)耦合微分方程，基于自抗擾控制技術(shù)設(shè)計了兩軸的擴張狀態(tài)觀測器和虛擬控制量從而得到兩軸電機輸入電壓控制量。擴張狀態(tài)觀測器精確估計了兩軸負載的旋轉(zhuǎn)角度和系統(tǒng)總擾動，并將總擾動在控制量中予以補償。同時針對火箭炮伺服系統(tǒng)發(fā)射時受燃氣流沖擊強干擾的特點對耦合系統(tǒng)仿真研究。仿真結(jié)果表明,火箭炮耦合系統(tǒng)采用該自抗擾方法在燃氣流沖擊強干擾條件下具有較好的控制精度，能精確跟蹤系統(tǒng)輸入指令并有效抑制了負載耦合效應(yīng)以及燃氣流沖擊對系統(tǒng)帶來的影響。

References)

[1]JAFAROV E M, TASALTIN R. Robust sliding-mode control for the uncertain MIMO Aircraft model F-18[J]. IEEE Transactions on Aerospace and Electronic Systems, 2000, 36(4): 1127-1141.

[2]HAN Jingqing. From PID to active disturbance rejection control[J]. IEEE Transaction on Industrial Electronics, 2009, 56(3): 900-906.

[3]LIU Bo, XIA Yuanqing, CHEN Jie. Decoupling double loop control system with ADRC[C]∥The 3rd International Conference on Innovative Computing Information and Control.Dalian:[s.n.],2008: 1016-1025.

[4]ZHENG Qing, CHEN Zhongzhou,GAO Zhiqiang. A practical approach to disturbance decoupling control[J]. Control Engineering Practice,2009(17):1016-1025.

[5]XUE Wenchao,HUANG Yi.On performance analysis of ADRC for a class of MIMO lower-triangular nonli-near uncertain systems[J].ISA Transactions,2014,53(4): 955-962.

[6]周長義. 三軸飛行仿真轉(zhuǎn)臺控制系統(tǒng)設(shè)計與控制算法研究[D].長春：中國科學(xué)院長春光學(xué)精密機械與物理研究所，2005. ZHOU Changyi. Design control system and study on control algorithm of a three-axis flying-simulating turntable[D].Changchun: Changchun Institute of Optics, Fine Mechanics and Physics, Chinese Academy of Sciences, 2005.(in Chinese)

[7]韓京清. 自抗擾控制技術(shù)——估計補償不確定因素的控制技術(shù)[M].北京:國防工業(yè)出版社,2009:288-292. HAN Jingqing. Active disturbance rejection control technique：the technique for estimating and compensating the uncertainties[M]. Beijing: National Defense Industry Press, 2009：288-292. (in Chinese)

DecouplingControlofRocketLauncherServoSystemBasedonActiveDisturbanceRejectionTechnique

ZHENG Ying，MA Dawei，YAO Jianyong，LE Guigao

(Mechanical Engineering College, Nanjing University of Science and Technology, Nanjing 210094,Jiangsu, China)

Rocket launcher servo system is a kind of servo system with azimuth axis and pitch axis coupling. For the sake of researching two-axis coupling and strong disturbance of combustion gas flow impact, the two-axis coupling dynamics equations and differential equations of rocket launcher were established. The extended state observer and virtual control variable were designed based on active disturbance rejection control for decoupling. The total disturbance was estimated through extended state observer and system compensation. The real control law was obtained from virtual control variable to control the coupling system. The simulation results indicated that the proposed control method can improve the tracking precision of rocket laun-cher and restrain the vibration of launching platform with two-axis coupling effect and combustion gas flow impact, and the control method can also provide theoretical support and actual value for rocket launcher coupling servo system.

ordnance science and technology； rocket launcher; servo system; two-axis coupling; active disturbance rejection control; decoupling control

2014-06-25；

2014-08-21

國防基礎(chǔ)科研項目(B2620110005)；國家自然科學(xué)基金(51305203)

鄭穎(1984-)，女，博士研究生，主要從事伺服系統(tǒng)控制技術(shù)研究。E-mail：zhengyingzky@163.com

TJ393

A

1673-6524(2014)04-0006-05