直升机是一种利用旋翼提供升力和推进力的飞行器,与固定翼飞机相比,它可以实现低空、低速飞行,并能垂直起降和空中悬停,因此直升机在军用和民用方面有了很大的发挥空间[1]。而且由于直升机是一种多输入多输出的非常复杂的被控对象,其对控制理论的研究和应用有着重要的工程意义,因此直升机也同样成为控制理论研究中的一种广泛研究对象。本文所研究的对象是三自由度直升机实验平台,它是一种由2个水平旋翼提供升力,与另一侧的平衡块构成的一种飞行器实验装置,可以围绕立柱模拟飞行器俯仰、偏转姿态,同时通过2个水平旋翼提供的升力差模拟飞行器的倾斜姿态,如图1所示。
图1 三自由度直升机系统示意图
Fig1.Diagram of 3-DOF helicopter system
目前,对该对象的研究多用来解决对飞行姿态的控制,采用的算法多为PID控制算法,如文献[2-3];或是对PID算法的改进[4],如模糊PID[5-8]、神经网络PID等[9-10]。理想条件下PID的相关控制算法已经能够达到较好的控制效果。而当参数变化时或者受到外界不确定性干扰时,为了保证较好的控制效果,国内外研究学者也做了若干研究,如U.Pérez-Ventura[11]研究的当执行机构的电压变化时,采用连续螺旋算法确保控制的鲁棒性;YANG Qiwei[12]则是通过对系统控制输入输出解耦,对各自解耦的部分采用非奇异终端滑模控制来保证鲁棒性;Hicham Chaoui[13]则是针对结构性和非结构性不确定性分别设计自适应控制和参考模型,来应对不确定性对系统的影响。本文研究在跟踪频率变化信号或者恶劣噪声环境下,如何改善传统PID算法中的微分项对控制效果带来的不利影响。本文以积分重构的思想,用控制量的积分代替被控量的误差微分估计,即采用广义比例积分控制算法(GPI)来实现飞行器的角度控制[14-15],对姿态控制抗外界干扰的研究具有一定的参考价值。
对图1系统中的俯仰轴、横侧轴、旋转轴分别进行力矩分析,忽略重力矩和干扰力矩,建立三轴模型为:
(1)
式(1)中:ε、p分别为俯仰轴、横侧轴角度;γ为旋转轴角速度;Je、Jp、Jt分别为俯仰轴、横侧轴、旋转轴转动惯量; Kc为螺旋桨电机的升力常数;l1为螺旋桨到俯仰轴支点的距离;lp为螺旋桨到横侧轴支点的距离;Us为2个电机电压之和;Ud为2个电机电压之差;G3为2个螺旋桨的等效重力。参数建模示意如图2所示。
图2 参数建模示意图
Fig.2 Diagram of modeling
由式(1)可知,俯仰轴、横侧轴、旋转轴的被控对象传递函数依次为:
(2)
(3)
(4)
式(2)~(4)中,各常变量参数的含义及取值如表1所示。
表1 三自由度直升机系统参数
Table 1 System parameters of 3-DOF helicopter
变量含义数值单位Kc电机升力常数12N/VG3螺旋桨等效重力4.259 1NJe俯仰轴转动惯量1.814 5kg·m2Jp横侧轴转动惯量0.031 9kg·m2Jt旋转轴转动惯量1.814 5kg·m2l1螺旋桨到支点的距离0.88mlp螺旋桨到横侧轴支点的距离0.17m
设计GPI控制器来完成姿态控制,指标要求如表2所示。
表2 各通道姿态控制的指标要求
Table 2 Requirements for attitude control of each channel
σ/%tp/sts/sess俯仰轴≤5≤2≤52%误差带内横侧轴≤5≤2≤52%误差带内旋转轴≤5≤5≤102%误差带内
由前文俯仰通道的模型可知,俯仰角ε与控制输入电压Us之间的关系式为:
(5)
式(5)中,d为常值干扰信号。
假设在理想情况下,期望的俯仰角ε*与期望的控制输入电压之间的关系式为:
(6)
由式(5)~式(6)可得:
(7)
式(7)中:对式(7)积分可得:
(8)
在PID控制器设计中,需要对被控量的误差微分进行测量并控制,这其中在噪声环境下或期望信号快速变化的情况下,就容易引入干扰,影响控制系统的动态性能。而从式(8)可以发现被控量的误差微分和控制输入的误差积分 eUsdτ存在一定的关系,因此可以假设:
(9)
将式(9)代入式(8)有:
(10)
仍然延续PID控制律的设计思路,此时,可以令控制输入的误差eUs为[14-17]:
(11)
即控制输入仍然是通过被控量误差的比例积分微分控制。
将式(11)代入式(7),此时可以求出控制律下的特征多项式方程,即:
(12)
此时,公式中有被控量误差的微分估计对式(12)求导,有:
(13)
由于式(11)对被控量误差进行了积分重构,使得再对式(12)求二次导后,可以通过式(7)和式(9)求导后变成从而使被控量的误差估计在其高阶导时,可以等于其实际值的高阶导,则有:
(14)
易得复数域下的特征方程为:
s4+λ3s3+λ2s2+λ1s+λ0=0
(15)
继续对式(9)求导,得:
(16)
(17)
同时对式(12)求二阶导,并将式(16)和式(17)代入后有:
(18)
对式(18)进行拉氏变换,得:
(19)
由此便得到控制输入和俯仰角偏差之间的传递关系为:
(20)
由前文横侧通道的模型可知,简化后的横侧角p与控制输入电压Ud之间的关系式,和俯仰角ε与控制输入电压Us的关系式类似,都是二阶关系,因此,与上述过程同理设计可得横侧通道的GPI控制律,有:
(21)
以及GPI控制下的特征方程为:
s4+β3s3+β2s2+β1s+β0=0
(22)
同理,亦可得到控制输入eUd和横侧角偏差ep之间的传递关系为:
(23)
由前文旋转通道的模型可知,旋转角速度与横侧角p之间的关系式有:
(24)
假设,在理想情况下,期望的旋转角速度与期望的横侧角p*之间的关系式为:
(25)
由式(24)~式(25)可得:
(26)
对式(26)积分可得:
(27)
令
(28)
此时,设计GPI控制律,有:
(29)
将式(29)代入式(26),有:
(30)
对式(30)求二次导,有:
(31)
对式(26)和式(28)分别求导,可得:
(32)
将式(32)代入式(30)可得:
(33)
对式(33)进行拉普拉斯变换,得:
(1+τ3)s3+τ2s2+τ1s+τ0=0
(34)
则式(34)就是旋转通道GPI控制下的特征方程,通过配置τi(i=0,1,2,3)使系统稳定且达到指标要求。
继续对式(28)求导,有:
(35)
对式(29)求二阶导,并将式(35)代入后,有:
(36)
对式(36)进行拉氏变换得:
(37)
由此便得到横侧角偏差ep和旋转角速度偏差之间的传递关系为:
(38)
根据指标要求可以绘制出3个通道期望的闭环零极点范围。由于俯仰通道和横侧通道的期望一致,因此可以绘制这2个通道的闭环零极点范围,如图3所示。同时根据主导极点的概念,可以设置一对远离虚轴的负实极点,对旋转通道来说,由于是三阶系统,可以设置一个远离虚轴的负实极点,则3个通道的系统响应完全可以由各自的一对复数极点来决定。
图3 极点配置示意图
Fig.3 Diagram of poles distribution
由此,式(15)、式(22)所表征的四阶系统,式(34)所表征的三阶系统,都降阶为二阶系统进行讨论。
对于俯仰通道来说,假设复数极点为s1,2,负实数极点为s3,4,则有:
(s-s1)(s-s2)(s-s3)(s-s4)=
s4+λ3s3+λ2s2+λ1s+λ0=0
由此可确定控制律参数λi(i=1,2,…,4),同理可确定横侧通道控制律参数βi(i=1,2,…,4)以及旋转通道控制律参数τi(i=0,1,2,3)。
3.5.1 俯仰通道仿真分析
根据式(20)可以得到俯仰通道GPI控制系统结构图,如图4。
图4 俯仰通道结构图
Fig.4 Block diagram of pitching channel
而λi已由极点配置决定,接下来就是调整λi去满足指标要求。
在阶跃输入下,根据极点配置,调整一组GPI控制参数至最佳响应,当λ0=153,λ1=730.2,λ2=948.17,λ3=60.8时,同时根据相近的极点配置,设置PID参数分别为Kp=4.154 2,Kd=5.293 7,Ki=0.876 6,得到PID的响应曲线如图5所示。
图5 相近极点配置下俯仰轴的阶跃响应曲线
Fig.5 Step response of pitch axis with similar poles assignment
同样,在阶跃输入下,βi不变,在恰好满足指标需求的条件下,取一组PID参数,得到响应曲线如图6,此时PID参数分别为Ki=0.001,Kp=2,Kd=0.8。
当系统需要跟踪频率快速变化的指令时,我们假设现在输入是此时GPI参数仍然不动,在上述2组PID参数情况下,系统响应曲线如图7、图8。
图6 调整PID参数至最佳时俯仰轴的阶跃响应曲线
Fig.6 Step response of pitch axis when PID parameters are adjusted to the best
图7 相近极点配置下俯仰轴的正弦响应曲线
Fig.7 Sine response of pitch axis with similar poles assignment
图8 调整PID参数至最佳时俯仰轴的正弦响应曲线
Fig.8 Sine response of pitch axis when PID parameters are adjusted to the best
通过以上仿真曲线可以看出,PID在相近极点配置下,并没有满足性能指标要求,而在能够满足指标要求的参数搭配下,由于其提高了快速性,降低了超调量,而丧失了一定的对频率快速变化信号的跟踪能力,如果系统中一旦出现高频干扰,其跟踪性能将会进一步丧失,这一点从PID算法的抗干扰分析中也可以看出。而且我们从GPI和PID这2个控制器附加的开环零极点也能看出,GPI比PID多增加了一个位于左半平面远离虚轴的极点,相应地,其快速性指标要优于PID控制,跟踪不同信号下的适应性更好。
在横侧通道和旋转通道中,应用GPI和PID控制也有类似的结论,因此后续只讨论GPI作用下的姿态控制和角速度控制,不再对GPI控制与PID控制做分析比较。
3.5.2 横侧通道仿真分析
根据式(23)可以得到横侧通道GPI控制系统结构图,如图9。
图9 横侧通道结构图
Fig.9 Block diagram of transverse channel
在阶跃输入下,根据极点配置,调整一组GPI控制参数至到最佳响应,此时β0=288,β1=739.2,β2=948.32,β3=60.8,得到横侧轴的阶跃响应曲线见图10,易知满足指标要求;当输入横侧轴的频率响应曲线如图11所示,系统能较好地跟踪正弦指令。
图10 横侧轴的阶跃响应曲线
Fig.10 Step response of transverse axis
图11 横侧轴的正弦响应曲线
Fig.11 Sine response of transverse axis
3.5.3 旋转通道仿真分析
根据式(38)可以得到旋转通道GPI控制系统结构图,如图12。
图12 旋转通道GPI控制结构图
Fig.12 Block diagram of GPI control for roll channel
在阶跃输入下,根据极点配置,调整一组GPI控制参数至最佳响应,此时τ0=11.25,τ1=91.5,τ2=237.05,τ3=30.4,得到旋转角速度的阶跃响应曲线见图13,易知满足指标要求;当输入旋转角速度的正弦系统响应如图14所示,系统能较好地跟踪正弦指令。
图13 旋转角速度的阶跃响应曲线
Fig.13 Step response of rotational angular velocity
图14 旋转角速度的正弦响应曲线
Fig.14 Sine response of rotational angular velocity
3.5.4 横侧通道和旋转通道的串级GPI控制
由式(1)知,改变直升机横侧轴的倾斜角大小可以控制直升机的旋转速度。如此根据横侧轴及旋转轴之间的相关性,可以将其设计为串级控制,其中,旋转通道的横侧角输出作为横侧通道横侧角的期望值,横侧与旋转的串级控制如图15所示。
图15 横侧与旋转的串级控制
Fig.15 Cascade control of transverse channel and roll channel
阶跃下的旋转角速度响应曲线如图16,阶跃下的横侧轴横侧角响应曲线如图17。
图16 串级控制旋转轴角速度响应曲线
Fig.16 Angular velocity response of cascade control in roll channel
图17 串级控制下的横侧角响应曲线
Fig.17 Transverse angle response with cascade control
通过以上3个通道的仿真实验,不难看出,在相同极点配置下,PID并没有满足性能指标要求。虽然其有自身的一套参数可以满足,但由于其提高了快速性,降低了超调量,而丧失了一定的对频率快速变化信号的跟踪能力,因此相对于PID来说,本文设计的GPI控制具有更好的跟踪适应性。
本文以三自由度直升机为研究对象,在姿态控制中,当跟踪频率变换较快的信号或系统当中充满高频信号时,常规的PID算法中的微分项对此类信号较为敏感,造成算法的参数适应性较差,不易满足指标要求等问题,本文在积分重构思想基础上,以控制量的积分代替被控量的误差微分估计,并通过高阶求导,使被控量的误差微分估计等于其实际值,从而使控制算法可以实际可操作。如此设计的广义比例积分算法可以使被控对象在恶劣噪声环境下实现姿态控制,满足指标要求,且具有较高的适应性。
[1] 唐永哲.直升机控制系统设计[M].北京:国防工业出版社,2000:51-57.
Tang Y Z.Helicopter control system design[M].Beijing:National Defense Industry Press,2000:51-57.
[2] Zhao X X.The 3 Dof helicopter control system based on PID Controller[J].Journal of Shandong Electric Power College,2009,12(04):52-55.
[3] 杨慧萍,高贯斌,那靖.三自由度直升机实验平台及姿态跟踪控制器设计[J].机械与电子,2015(05):69-72.
Yang H P,Gao G B,Na J.Design of 3 DOF helicopter experimental platform and the attitude tracking controller[J].Mechanical and electronic 2015(5):69-72.
[4] 王玲玲,梁勇.基于改进PID的三自由度直升机系统仿真研究[J].系统仿真技术,2016(04):270-274.
Wang L L,Liang Y.Research of Simulation on 3-DOF Helicopter System Based on Improved PID[J].System Simulation Technology,2016(04):270-274.
[5] 吴琼,王强,兰文宝,等.基于模糊自适应PID三自由度直升机控制器的研究[J].黑龙江大学工程学报,2014,5(02):87-91.
Wu Q,Wang Q,Lan W B,et.Study of 3-DOf helicopter controller based on fuzzy adaptive PID[J].Journal of Heilongjiang Hydraulic Engineering College,2014,5(02):87-91.
[6] 葛金来,张承慧,崔纳新.模糊自整定PID控制在三自由度直升机实验系统中的应用[J].信息与控制,2010,39(03):342-347.
Ge J L,Zhang C H,Cui N X.Fuzzy self-tuning PID control in the 3-DOF helicopter experimental system[J].Information and Control,2010,39(03):342-347.
[7] 王宏,林子健,王玲玲.基于模糊控制的三自由度直升机系统仿真研究[J].电子测量技术,2017,40(10):113-117.
Wang H,Lin Z J,Wang L L.Simulation research of three degree of freedom helicopter system based on fuzzy control[J].Electronic Measurement Technology,2017,40(10):113-117.
[8] 贾森,王新华,龚华军,等.基于模糊PID 的直升机增稳控制系统设计与实现[J].电子测量技术,2015,38(11):70-73.
Ja S,Wang X H,Gong H J,et al.Design and implementation of stability augmentation control system for small unmanned helicopter based on fuzzy PID[J].Electronic Measurement Technology,2015,38(11):70-73.
[9] 马云飞.三自由度直升机模型的PID神经网络控制研究[J].沈阳大学学报,2010,22(04):15-17.
Ma Y F.PID neural network controller of 3-DOF helicopter model[J].Journal of Shenyang University,2010,22(04):15-17.
[10] 于鉴,徐锦法.无人直升机发动机PID自适应控制系统[J].系统仿真学报,2008,20(23):6466-6469.
Yu J,Xu J F.Engine PID adaptive control system for unmanned helicopter[J].Journal of system simulation,December 2008,20(23):6466-6469.
[11] Pérez-Ventura U,Fridman L,Capello E,et al.Fault tolerant control based on continuous twisting algorithms of a 3-DoF helicopter prototype[J].Control Engineering Practice,2020,101:104486.
[12] Yang Q W,Yang R.Nonsingular terminal sliding mode based passive fualt-tolerant control of a 3-DOF helicopter system[J].IFAC Papers Online,2018,51(24): 1368-1372.
[13] Chen Y H,Yang X B,Zheng X L.Adaptive neural control of a 3-DOF helicopter with unknown time delay[J].Neuro Computing,2018,307:98-105.
[14] Luo D W.The research of compliance control for end-effector of fruit picking robot[D].Zhenjiang:Jiangsu University,2014:24-29.
[15] 崔庆梁.基于干扰观测器的三自由度模型直升机控制技术[D].南京:南京航空航天大学,2016:19-21.
Cui Q L.Disturbance observer based control for a three degree freedom of model helicopter[D].Nanjing:Nanjing University of Aeronautics and Astronautics,2016:19-21.
[16] 王茜,侯保林,姚来鹏,等.基于干扰观测器的弹药传输机械臂非线性连续时变反馈控制[J].兵工学报,2020,41(11):2179-2188.
Wang Q,Hou B L,Yao L P,et al.Nonlinear continuous time-varying feedback control of an ammunition transfer manipulator based on disturbance observer[J].Acta Armamentarii,2020,41(11):2179-2188.
[17] 何杰,朴继军,朱玲瑞,等.先进微陀螺器件及微惯性测量单元最新研究进展[J].压电与声光,2019,41(03):410-415.
HE J,BU J J,ZHU L R,et al.Recent Research Progress of Advanced Micro-gyroscope Devices and MIMU[J].Piezoelectrics & Acoustooptics,2019,41(3):410-415.
Citation format:WANG Lingling, WU Feilong.Attitude Control of 3-DOF Helicopter System Based on Algorithm of GPI[J].Journal of Ordnance Equipment Engineering,2021,42(12):254-260.