基于改進PID的三自由度直升機系統(tǒng)仿真研究

王玲玲, 梁 勇

(海軍航空工程學(xué)院,山東 煙臺 264000)

基于改進PID的三自由度直升機系統(tǒng)仿真研究

王玲玲, 梁 勇

(海軍航空工程學(xué)院,山東 煙臺 264000)

針對三自由度直升機非線性、多變量、強耦合等特性,利用改進的PID控制算法實現(xiàn)直升機俯仰角穩(wěn)定回路控制及橫側(cè)角穩(wěn)定回路控制。首先分析三自由度直升機的三個通道,并建立其動力學(xué)模型。對其中的俯仰通道、橫側(cè)角通道分別采用PD控制,并將橫側(cè)角通道和旋轉(zhuǎn)通道聯(lián)立設(shè)計,為旋轉(zhuǎn)通道設(shè)計PID控制器。其次為提高俯仰角、橫側(cè)角的跟蹤性能,對俯仰角通道和橫側(cè)角通道提出一種基于前饋補償?shù)膹?fù)合PD控制。通過仿真將改進后的PD控制與改進前做比較,結(jié)果表明,復(fù)合PD控制可以提高俯仰角的跟蹤速度,抑制橫側(cè)角的波動,從而使直升機高度、偏航、旋轉(zhuǎn)三個通道運行更加平穩(wěn)。

三自由度直升機; PID控制器; 復(fù)合控制

1 引 言

直升機由于其低空飛行、垂直起降等靈活的飛行方式,在軍用和民用中已經(jīng)得到越來越廣泛的應(yīng)用[1-2]。而由于其本身具有多變量、非線性、通道耦合的特點,也是控制領(lǐng)域中典型的較為復(fù)雜的被控對象[3-4]。因此對其在姿態(tài)、高度方面的研究具有重要的實際和理論意義。

三自由度直升機如圖1所示,是由基座、平衡桿、平衡塊和螺旋槳等組成。平衡桿以基座為支點,進行俯仰和旋轉(zhuǎn)動作。螺旋槳和平衡塊分別安裝在平衡桿的兩端。兩個螺旋槳分別由直流無刷電機驅(qū)動,其速度差可以使平衡桿以基座為軸做旋轉(zhuǎn)動作。平衡桿的旋轉(zhuǎn)軸、俯仰軸和螺旋槳的橫側(cè)軸分別安裝了編碼器用以測量各軸脈沖,并根據(jù)編碼器的轉(zhuǎn)換關(guān)系獲得直升機的實時飛行姿態(tài)信號。

圖1 三自由度直升機系統(tǒng)示意圖Fig.1 Diagram of 3-DOF helicopter system

對該被控對象的研究多用PID控制算法,如文獻[5];或是對PID算法的改進,如模糊PID[6-7]、神經(jīng)網(wǎng)絡(luò)PID[8]。本文先對系統(tǒng)做三個通道的建模仿真,并對俯仰通道、橫側(cè)角回路設(shè)計PD控制,而后以橫側(cè)角為內(nèi)回路,對旋轉(zhuǎn)通道設(shè)計PID控制器。最后,為了提高俯仰角的跟蹤速度,抑制橫側(cè)角的超調(diào),對俯仰通道及旋轉(zhuǎn)通道的內(nèi)回路設(shè)計按前饋補償?shù)膹?fù)合控制。

2 系統(tǒng)建模

根據(jù)系統(tǒng)的特點可以將其分為三個軸(自由度)來分別建模。其中由圖2列寫俯仰軸的力矩平衡方程為

Kcl1(V1+V2)-l1mhg+l2mbg=

Kcl1Vs-Tg

(1)

圖2 俯仰軸Fig 2 Diagram of pitch axis

如果忽略重力擾動力矩Tg,則由式(1)可以得到下面的線性系統(tǒng):

(2)

對于橫側(cè)軸,由圖3列寫力矩平衡方程有

(3)

圖3 橫側(cè)軸Fig 3 Diagram of yaw axis

當(dāng)橫側(cè)角p在一個很小的角度內(nèi)變化時,可以將其線性化,即有:

(4)

3 控制系統(tǒng)設(shè)計

3.1 俯仰控制器設(shè)計

由式(2)易知,俯仰軸系統(tǒng)為II型系統(tǒng),系統(tǒng)不穩(wěn)定,可以設(shè)計PD控制。假設(shè)Kep為俯仰角回

圖4 旋轉(zhuǎn)軸Fig 4 Rotation Axis

路的比例系數(shù),Ked為俯仰角內(nèi)回路的微分系數(shù)。經(jīng)過PD參數(shù)調(diào)試,當(dāng)Kep=0.3、Ked=0.5,其俯仰角跟蹤曲線如圖5所示。可以看到,俯仰角在0s～30s階躍上升至20°,30s～40s是恒速上升階段,40s～50s是角度恒定階段,50s～60s是恒速下降階段。在整個過程中,穩(wěn)態(tài)精度較高,無峰值時間及超調(diào)量,但響應(yīng)速度不夠。

圖5 PD控制下俯仰軸的角度跟蹤曲線Fig 5 Angle tracking curve of the pitch axis under PD control

3.2 橫側(cè)軸旋轉(zhuǎn)軸控制器設(shè)計

由式(3)知,橫側(cè)軸的橫側(cè)角p由螺旋槳的電壓差提供,且由式(4)知改變直升機橫側(cè)軸的傾斜角大小可以控制直升機的旋轉(zhuǎn)速度。如此根據(jù)橫側(cè)軸及旋轉(zhuǎn)軸之間的相關(guān)性,可以將其合為一個系統(tǒng)進行設(shè)計,如圖6所示。

圖6 橫側(cè)軸旋轉(zhuǎn)軸反饋PID校正框圖Fig 6 PID compensation for yaw and rotation axis

對于橫側(cè)軸部分,同理設(shè)計速度內(nèi)穩(wěn)定回路以實現(xiàn)PD控制,其中Kpp為橫側(cè)角回路的比例系數(shù),Kpd為橫側(cè)角內(nèi)回路的微分系數(shù)。對于旋轉(zhuǎn)軸部分,在反饋后前向通道的前端增加PI控制,從而實現(xiàn)旋轉(zhuǎn)軸PID控制,其中Krp為旋轉(zhuǎn)角回路的比例系數(shù),Krd為微分系數(shù),Kri為積分系數(shù)。

假設(shè)旋轉(zhuǎn)角輸入與俯仰角輸入一致,當(dāng)Kpp=0.3,Kpd=0.2,Krp=2,Krd=0.5,Kri=0.02時可以得到如下仿真曲線。由圖7和圖8可知,旋轉(zhuǎn)角在階躍階段動態(tài)性能較差,斜坡階段有延遲,整個過程有0.2°的穩(wěn)態(tài)誤差。同時,橫側(cè)角的波動較大,這會造成在實際控制中直升機的啟停非常快,使得螺旋槳本體會產(chǎn)生晃動,從而使直升機喪失高度。因此必須要對橫側(cè)角的角度進行進一步的穩(wěn)定控制。

圖7 PID控制下旋轉(zhuǎn)軸的角度跟蹤曲線Fig 7 Tracking curve of angle for rotation axis using PID control

圖8 PID控制下橫側(cè)軸的角度跟蹤曲線Fig 8 Tracking curve of angle for yaw axis using PID control

4 復(fù)合控制的改進

即內(nèi)回路的前饋實際為比例和微分環(huán)節(jié),令

其中,Kfed為前饋部分的微分系數(shù),Kfep為前饋部分的比例系數(shù)。對該算法進行仿真如圖10所示,在Kep和Ked相同的情況下,當(dāng)Kfed=1.2、Kfep=3.5時,增加比例微分的局部復(fù)合控制可以明顯提高系統(tǒng)的動態(tài)性能。

圖9 俯仰軸局部復(fù)合校正框圖Fig 9 Block diagram of compound compensation in part for pitch axis

圖10 局部復(fù)合PD控制下俯仰軸的角度跟蹤曲線Fig 10 Angle tracking curve of the pitch axis under compound PD control in part

其中,Kped為前饋部分的微分系數(shù),Kpep為前饋部分的比例系數(shù)。對該算法進行仿真如下,在圖6中5個參數(shù)Kpp、Kpd、Krp、Krd、Kri不變的情況下,當(dāng)Kped=1.2、Kpep=0.2時,對比圖8與圖12,橫側(cè)角的超調(diào)明顯大幅降低。而橫側(cè)角波動的降低使得旋轉(zhuǎn)角度控制的穩(wěn)定程度更好,如圖11所示。

圖11 橫側(cè)角內(nèi)回路復(fù)合控制下旋轉(zhuǎn)軸的角度跟蹤曲線Fig 11 Angle tracking curve of the rotation axis under compound control for inner loop of yaw axis

5 結(jié) 論

本文分析了三自由度直升機三個通道的建模問題,并針對俯仰角回路設(shè)計了PD控制,以橫側(cè)角為內(nèi)回路,對橫側(cè)角設(shè)計了PD控制,對旋轉(zhuǎn)角設(shè)計了PID控制器。仿真表明俯仰角跟蹤不足,橫側(cè)角波動較大。而后對俯仰角回路和橫側(cè)角內(nèi)回路設(shè)計復(fù)合控制。最后由仿真分析得出,改進后的PID控制可以提高俯仰角的跟蹤速度,大幅降低橫側(cè)角的超調(diào),從而提高旋轉(zhuǎn)角回路的跟蹤性能。

圖12 橫側(cè)角內(nèi)回路復(fù)合控制下橫側(cè)軸的角度跟蹤曲線Fig 12 Angle tracking curve of the yaw angle under compound control for inner loop of yaw axis

[1] 楊慧萍,高貫斌,那靖.三自由度直升機實驗平臺及姿態(tài)跟蹤控制器設(shè)計[J].機械與電子,2015(5):69-72.

YANG Huiping,GAO Guanbin,NA Jing.Design of 3-DOF Helicopter Experimental Platform and the Attitude Tracking Controller[J].Mechanical and Electronic,2015 (5) :69-72.

[2] 吳瓊,王強,蘭文寶等.基于模糊自適應(yīng)PID三自由度直升機控制器的研究[J].黑龍江大學(xué)工程學(xué)報,2014,5(2):87-91.

WU Qiong,WANG Qiang,LAN Wenbao,et.Study of 3-DOf helicopter controller based on fuzzy adaptive PID[J].Journal of Heilongjiang Hydraulic Engineering College,2014,5(2):87-91.

[3] 于鑒,徐錦法.無人直升機發(fā)動機PID自適應(yīng)控制系統(tǒng)[J].系統(tǒng)仿真學(xué)報,2008,20(23):6466-6469.

YU Jian,XU Jinfa.Engine PID Adaptive Control System for Unmanned Helicopter[J].Journal of system simulation,December,2008,20(23):6466-6469.

[4] 葛金來,張承慧,崔納新.模糊自整定PID控制在三自由度直升機實驗系統(tǒng)中的應(yīng)用[J].信息與控制,2010,39(3):342-347.

GE Jinlai,ZHANG Chenghui,CUI Naxin.Fuzzy self-tuning PID control in the 3-DOF helicopter experimental system[J].Information and control,June,2010,39(3):342-347.

[5] 趙笑笑.基于PID控制器的三自由度直升機控制系統(tǒng)[J].山東電力高等專科學(xué)校學(xué)報,2009,12(4):52-55.

ZHAO Xiaoxiao.The 3-Dof Helicopter Control System Based on PID Controller[J].Journal of Shandong Electric Power College,2009,12(4):52-55.

[6] GAO Junshan,XU Xinghu,HE Chen.A Study on the Control Methods Based on 3-DOF Helicopter Model[J].Journal of Computers,2012,7(10):2526-2533.

[7] 賈森,王新華,龔華軍,等.基于模糊PID 的直升機增穩(wěn)控制系統(tǒng)設(shè)計與實現(xiàn)[J].電子測量技術(shù),2015,38(11):70-73.

JA Sen,WANG Xinhua,GONG Huajun,et al.Design and implementation of stability augmentation control system for small unmanned helicopter based on fuzzy PID[J].Electronic measurement technology,November,2015,38(11):70-73.

[8] 馬云飛.三自由度直升機模型的PID神經(jīng)網(wǎng)絡(luò)控制研究[J].沈陽大學(xué)學(xué)報,2010,22(4):15-17.

MA Yunfei.PID Neural Network Controller of 3-DOF Helicopter Model[J].Journal of Shenyang University,2010,22(4):15-17.

[9] 劉金琨.先進PID控制的MATLAB仿真[M].北京:電子工業(yè)出版社,2011. LIU Jinkun.Matlab Simulation of Advanced PID Control[M].Beijing:Publishing House of Electronics Industry,2011.

王玲玲 女(1984-),安徽銅陵人,講師,主要研究領(lǐng)域為控制系統(tǒng)仿真與實現(xiàn)。

梁 勇 男(1976-),山東煙臺人,博士,副教授,主要研究領(lǐng)域為控制系統(tǒng)設(shè)計與仿真。

Research of Simulation on 3-DOF Helicopter SystemBased on Improved PID

WANGLingling,LIANGYong

(Department of Control Engineering,Naval Aeronautical and Astronautical University,Yantai 264001,China)

For nonlinear,multi-variable,strong coupling characteristics of 3-DOF helicopter,an improved PID control algorithm was used to realize the control of pitch angle loop and yaw angle loop.Firstly,the dynamic model was established on the analysis for three channels of 3-DOF helicopter,and PD control was adopted for its pitch channel and yaw channel.Considering the relation between yaw channel and rotation channel,both two channels were designed as one system and PID control was used in rotation channel.In order to improve the tracking performance of pitch angle and yaw angle,a method with compound PD control based on feedforward compensation was proposed,which applied to pitch channel and yaw channel individually.The improved PD contvol was compared with that before improvement by simulation.The results show that the improved method could increase the tracking speed of elevation angle,suppress fluctuations in travel angle,which made height channel,yaw channel and rotating channel of helicopter run more smoothly.

3-DOF helicopter; PID controller; compound control

TP 15

A