Design of Tilting Rotor Control System Based on Gain Scheduling Method

SONG Xiaodong, WU Bin, SANG Tao

JPRMG ›› 2021, Vol. 41 ›› Issue (6) : 23-28.

PDF(8030 KB)
PDF(8030 KB)
JPRMG ›› 2021, Vol. 41 ›› Issue (6) : 23-28. DOI: 10.15892/j.cnki.djzdxb.2021.06.005

Design of Tilting Rotor Control System Based on Gain Scheduling Method

Author information +
History +

Abstract

Analyzing the dynamic model of the tilting four rotor, the gain scheduling controller is designed with tilting angle as the scheduling parameter, with pole allocation by MATLAB software at the equilibrium point, calculating to obtain the control parameters of each equilibrium point. Speed adaptive term is introduced to solve the error in linearization model. The error quaternion method is used as the input of the controller to avoid the ruler angle singular problem while the vertical take-off and landing. Experiments show that this method has better control effect.

Key words

UAV / flight control / gain scheduling / quaternion

Cite this article

Download Citations
SONG Xiaodong, WU Bin, SANG Tao. Design of Tilting Rotor Control System Based on Gain Scheduling Method[J]. Journal of Projectiles, Rockets, Missiles and Guidance, 2021, 41(6): 23-28 https://doi.org/10.15892/j.cnki.djzdxb.2021.06.005

0 引言

随着科学技术的发展,无人机被广泛应用于各个领域。相比于载人机,无人机具有成本低、体积小、研制周期短等优势,更加适合小范围的勘测、侦察等任务。旋翼无人机能够随时随地起降,完成一些近距离、低速任务;虽然固定翼无人机在长远距离工作效率更高,但无法长时间、最低巡航速度以下正常工作。因此,具备垂直起降功能的无人机应运而生。
为实现倾转旋翼无人机多种飞行模态,对其控制系统设计提出了更高的要求。尤其在过渡过程,起始阶段和末尾阶段力学特性不同。以垂直起飞为例,倾转旋翼机在起始阶段通过螺旋桨拉力克服重力;在合适的前向速度下,短舱开始倾转,随着速度的上升,机翼气动力逐渐起主导作用,最终达到机翼升力克服重力,螺旋桨拉力克服阻力的巡航状态。模态转变过程中,无人机具有强烈的非线性特性,传统的线性控制器无法满足控制需求;在进行垂直起降时,由于飞行器的弹道倾角在90°时存在奇异点问题[1],给控制系统设计带来了一定的难度。国内外学者对此提出了多种控制方案。文献[2]采用新型自抗扰滑模控制算法,设计了内外部干扰观测器,将模型误差和耦合视为干扰进行补偿控制;文献[3]提出了一种基于模糊控制的倾转控制方法,使倾转旋翼无人机能够实现平稳过渡飞行;文献[4]采用了非线性动态逆设计了全包线飞行控制率。文献[5]采用了BP神经网络对PID参数进行调整从而满足控制需求,目前这种方法工程应用难度大,并且依赖于可靠的数据收集。文献[6]在研究垂直起降控制器验证过程中,为了避开奇异点问题,设计的航迹也并非真正意义上的垂直于水平面,而是前向有一定的倾角。
文中对倾转四旋翼飞机进行建模,建立了跟随旋翼倾转的短舱坐标系;采用了增益调度的方法,将短舱倾角作为调参变量,将倾角分为多个工作点,实现了对倾转旋翼机过渡过程中高度的稳定控制,使其平稳过渡。同时采用误差四元数方法进行姿态控制,避免了垂直起降过程中欧拉方程出现的奇异点问题。

1 倾转旋翼机模型

1.1 布局设计

研究对象采用常规气动布局[7]。动力采用4点式动力布局,飞机布局和倾转机构如图1图2所示。
图1 倾转机构

Full size|PPT slide

图2 飞机布局

Full size|PPT slide

倾转旋翼无人机在垂直起降模式飞行时,通过4个电机的差动进行姿态控制,与四旋翼无人机控制方案相同。在过渡飞行模式中,机体纵向平面z轴方向上,既存在螺旋桨拉力在垂直方向的分力,也存在机翼的气动升力。巡航模式时旋翼产生的拉力用于克服阻力。
倾转旋翼机基本参数如表1所示。考虑前后翼干扰问题、发动机干扰效应,进行空气动力学分析,通过DATCOM气动估算、CFD分析修正,确保气动参数具有一定的可信度。
表1 倾转旋翼机基本参数
参数 数值 参数 数值
起飞重量/kg 5.0 翼展/m 1.13
巡航速度/(m/s) 20.0 航程/km 10.0
单电机最大推力/N 25 翼面积/m2 0.286

1.2 数学模型

首先定义固连于电机的短舱坐标系Ot,如图3所示,其原点与机体坐标系重合,该坐标系随电机倾转而绕其y轴旋转。倾转旋翼机在悬停状态,定义短舱坐标系x轴方向与机体x轴同向,y轴方向与机体轴y轴方向相同[8]
图3 短舱坐标系

Full size|PPT slide

建立无人机空间六自由度模型:
x˙=LTbgvb
(1)
mdvbdt+ωb×vb=Fb
(2)
ϕ·θ·ψ·=1sinϕtanθcosϕtanθ0cosϕ-sinϕ0sinϕcosθcosϕcosθpqr
(3)
Iω·+ω×Iω=M
(4)
式中:下标b代表机体坐标系; LbgT为地面系列机件系的坐标转换矩阵;x为空间位置;p,q,r为机体系下相对于地面系的旋转角速度;I为机体转动惯量矩阵,其表达式为:
I=0.21800.04100.67500.04100.914
(5)
作用在无人机上的力主要包含动力Fmotor,t,动力矩 Mmotor,t[9]
Fmotor,t=00-T1-T2-T3-T4
(6)
Mmotor,t=(-T1+T2+T3-T4)ly(T1-T2+T3-T4)lxM1+M2-M3-M4
(7)
式中:下标t代表短舱坐标系;T为电机推力,下标1、2、3、4为电机序号。
气动力和气动力矩为:
Faero,t=12ρV2SwingLtbLbwCD0CL
(8)
Maero,t=12ρV2SwingLtbc¯wing0Cm0+r×LbwCD0CL
(9)
其中:CLCD分别为升力系数和阻力系数;Lbw为气流坐标系到机体坐标系的转换矩阵;Ltb为机体坐标系到短舱坐标系的转换矩阵; c¯wing为平均气动弦长。

2 控制系统

倾转旋翼机从垂直起飞到巡航的转换是一个具有强烈非线性特性的过程[10] 。文中在高度控制中,采用增益调度方法。其基本思想是在整个飞行包线内,将模型分为多个平衡工作点,每个平衡点处通过小扰动线性化方法得到线性模型,每个平衡点处设计线性控制器,最后利用插值拟合的方法使其成为参数可变的全局控制器。如图4所示,内环所需的期望倾转角度和期望高度由外环制导回路产生。
图4 控制系统

Full size|PPT slide

2.1 高度控制

在垂直起降转换到平飞过程中,短舱坐标系与机体坐标系的夹角从 转换至 。根据增益调度法的原理,将该过程每间隔5°选取一个平衡点。每个平衡点对应一个倾转角度δd,n,根据倾转旋翼机在平衡点处受力和力矩平衡,可推导出:
12ρSwing(CLCDcotδd,n)·vx02(δd,n)=mg
(10)
T0(δd,n)=(12ρvx02δd,nSwingCD)2+(mg12ρvx02δd,nSwingCL)2=Tx02+Tz02
(11)
式中:Tx0和tz0为平衡状态时,机体坐标系下推力沿x轴和z轴方向的分量;vx0为平衡速度;δd,n为第n个平衡点的期望倾转角。
根据式(11)即可得到所有工作点达到平衡状态所需要的水平速度和推力大小。通过Matlab计算各个工作点平衡状态如图5所示。
图5 水平速度、推力与倾转角度关系

Full size|PPT slide

定义状态空间 X=[v~·x,v·z,z·]T,给定期望的倾转角δd,n,在相应的平衡点处有 v·x=0和 v·z=0,从而得到线性化不确定模型为:
X·=AX+Bu
(12)
其中: A= fX; B= fu,忽略舵面产生的阻力,代入式(12)展开后可得:
v˜˙xv˙zz˙=1mρSwingvx0δd,nCD00ρSwingvx0δd,nCL000m0v˜xvzz+1mTx0T0sin δd,nTz0T0sin δd,n0Tx0T0cos δd,nTz0T0cos δd,n12ρSwingvx02δd,nCL,δvert000ΔTxΔTzδvert
(13)
式中:ΔTx和ΔTz为机体坐标系下发动机推力增量沿x轴和y轴方向的分量;δvert为升降舵面的偏转角。
定理1 若线性定常系统{A,B}的可控矩阵
Sc=BABA2BAn1B
(14)
则系统状态完全可控的充要条件是该可控矩阵满秩,即rankSc=n
根据定理1可以证明该系统在-90°δd<0时满秩,完全可控。在0°时,由于前向速度较低,升降舵面不足以产生足够的控制力矩。根据爬升速度和高度误差设计高度控制器,同时对前向速度进行控制,设计状态反馈矩阵为:
ΔTxΔTzδvert=-kvx(δd,n)000-kvz(δd,n)-kz(δd,n)0kδvert,vz(δd,n)kδvert,z(δd,n)v~xvzz
(15)
式中, kvx(δd,n), kvz(δd,n),kz(δd,n), kδvert,vz(δd,n), kδvert,z(δd,n)∈R>0为增益系数。以δd,n为调度变量,通过Matlab对该系统每个工作点进行极点配置,得到每个参数的增益调度表。通过仿真试验,将极点配置在-4附近时系统具有较好的动态特性,得到的增益调度关系曲线如图6图10所示。
图6 kvx与倾转角度关系

Full size|PPT slide

图7 kvz与倾转角度关系

Full size|PPT slide

图8 kz与倾转角度关系

Full size|PPT slide

图9 kδvert,vz与倾转角度关系

Full size|PPT slide

图10 kδvert,z与倾转角度关系

Full size|PPT slide

通过对5个参数计算结果简单分析,可直观地判断其合理性。图6为参数 kvx增益调度关系曲线,该参数通过机体轴向速度误差控制轴向的推力。在期望速度下,阻力大小与速度平方成线性关系,忽略模态转换对阻力特性造成的影响时,系统的阻力变化较小,因此该参数变化范围也较小。图7图8 kvzkz增益调度关系曲线,根据式(15)可知,通过PD型控制器对z轴方向推力分量进行控制。当倾转旋翼机垂直起降时,气动升力接近0,此时该参数数值较大以满足推力控制需求。图9图10 kδvert,vz kδvert,z增益调度关系曲线,由图可知,在-15°左右该参数急剧下降,原因是在0°~-15°范围内,倾转旋翼机的巡航速度较小,气动舵面效率低。当达到-15°倾转角后,气动舵面开始发挥主要操纵作用,并随着速度升高,舵效增强,参数变小以减少系统的超调量。实际使用时,该增益调度表通过地面计算,在线查表的方式,大大地降低了飞控系统计算量。
由于计算时忽略了舵面等因素对平衡速度的影响,并且真实阻力系数与气动估算得到的系数存在偏差,在实际飞行控制中,倾转旋翼机在各个平衡点的期望速度与计算值有一定偏差。当以期望速度飞行不足以提供足够升力时,高度降低,导致下沉,vz变大。可通过对过程中工作点的水平平衡速度进行更新解决该问题,设计更新律为:
v˙x0=σvz
(16)
其中σ∈R>0为自适应增益。

2.2 姿态控制

在高度控制系统中,通过升降舵面对俯仰角进行控制,从而控制飞行器的高度变化。因此姿态控制中只再解决滚转和偏航两个方向的控制问题。当倾转旋翼机的电机从0°倾转至-90°时,飞机进入巡航状态,同时也导致状态方程中欧拉角度出现奇点[11] 。因此,文中基于四元数法设计姿态控制器,避免了奇点问题。由于四元数直接表示姿态具有双值性,即正负均可表示同一姿态角,因此在控制系统中采用姿态误差四元数方法。该方法实质上是将用于表征姿态的四元数旋转至期望姿态下的四元数。定义基于短舱坐标系的四元数:
Qt=ηtqt=cosΦ2vsinΦ2
(17)
式中:ηt为四元数标量部分;qt为向量部分。垂直起飞转换至巡航模式时,倾转机构由0°转换至-90°。定义期望姿态四元数Qd=[ηd qd]T
根据四元数的计算方法,误差四元数可表示为:
Qe=Qe(ηe,qe)=Qd(ηt,qt)Qd(-ηd,qd)
(18)
ηe=qdTqt+ηdηt
(19)
qe=ηdqtηtqdqd×qt
(20)
式中:下标e表示差值;下标d表示期望值;上标×代表向量叉积,表达形式为:
qd×=0-qd3qd2qd30-qd1-qd2qd10
(21)
角速度四元数可以用短舱坐标系Ot旋转至期望坐标系Od来表示,即
ωtt,d=ωtt,qQeωdd,q
(22)
根据式(4),可得到基于四元数的动力学模型为:
Iω˙tt,d=I((ωtt,d)×Qeωdd,qQeω˙dd,q)(ωtt,d+Qeωdd,q)×I(ωtt,d+Qeωdd,q)+μ+d
(23)
η·e=-12qTeωtt,d
(24)
q·e=12(qe×ωtt,d+ηe ωtt,d)
(25)
其中:μ为旋翼产生的控制力矩;d为除了旋翼产生的控制力矩以外的力矩。式(23)~式(25)描述了基于短舱坐标系的姿态四元数旋转至期望四元数的过程。倾转前后机构的变化导致系统惯量I的不确定性增强,为了消除I项的误差[12],定义:
=J(α)Γ
(26)
其中Γ=[I11 I22 I33 I23 I13 I12]T,α∈R3×1,J(α)为关于α的转换算子,其表达式为:
J(α)=α1000α3α20α20α30α100α3α2α10
(27)
Γ代入式(23)中得到:
Iω·tt,d=f(ωtt,d,Qe, ωdd,q,ω·dd,q)Γ+μ+d
(28)
定义 ω~=ωtt,d+K1qe,代入式(28)可得:
Iω~=[J(K1qe)+f(ωtt,d,Qe,ωdd,q,ω·dd,q)]Γ+μ+d
(29)
设计姿态控制器的输出量μ的表达式为:
μ=fωtt,d,Qe,ωdd,q,ω˙dd,q+JK1qeΓK1qeK2ω˜K20t ω˜dt
(30)
式中:k1,k2>0;K1,K2为对称正定矩阵,积分项用于补偿d,下面分析系统的稳定性。
选取李雅普诺夫函数为:
V=12ω˜TI ω˜+k1[qeTqe+(η1)2]
(31)
对式(31)进行求导得到:
V˙=ω˜T{[J(K1qe)+f(ωtt,d,Qe,ωdd,q,ω˙dd,q)]Γ+μ+d}k(qeTK1Tqe)
(32)
进一步求解,得到:
V˙=ω˜TK2ω˜k(qeTK1Tqe)
(33)
式中,k>0,可知 V·0当且仅当 ω~=0qe=0时等号成立,稳定性得证。

3 实验验证

所设计的验证模型机质量为5 kg,巡航攻角设计为3°。控制芯片采用Cortex-A9,惯导系统采用L3GD20H角速率传感器、LSM303D加速度计和磁航向计,其他航电为GPS和压差空速计。
设计航迹为在机体坐标系(x,y,z)=(0,0,0)处垂直起飞至30 m高度,再沿着(x,y,z)=(210 m,0 m,30 m)、(210 m,410 m,30 m)、(0 m,410 m,30 m)和(0 m,410 m,30 m)四个点组成的矩形航迹飞行后,在(0 m,0 m,30 m)处垂直降落。转弯过程采用BTT转弯,倾转过程设计为:
δd=-90+18t,-18t,
该飞行航迹包含垂直起降、过渡转换和巡航3个阶段。 在飞行过程中,根据倾转角度进行查表,得到合适的控制增益。
对飞行日志进行分析,通过Matlab生成飞行轨迹三维图(如图11所示)以及各惯性系下坐标轴方向位移(如图12所示)。
图11 三维航迹图

Full size|PPT slide

图12 沿轴向位移

Full size|PPT slide

通过图11图12可以看到,验证机能够从原点垂直起飞至30 m,并且在此后的转换过程中基本达到高度稳定的要求。此过程中,验证机的滚转和俯仰姿态角以及对应的控制舵面输出如图13图14所示;由空速计采集的空速信息如图15所示。由图15可以看到,验证机在30 s达到设定的巡航速度,气动力生效。由图13可以看到在43 s、58 s和80 s左右验证机进行BTT转弯,滚转角度约为23°,在90 s~100 s中,减速并从巡航模式转换为垂直降落模式。由图15可以看出巡航速度进行自适应修正,逐渐趋近于16 m/s。
图13 姿态角曲线

Full size|PPT slide

图14 舵面偏转角

Full size|PPT slide

图15 飞行速度

Full size|PPT slide

4 结论

文中所设计的倾转旋翼机全局控制器能够满足垂直起降、过渡过程和固定翼巡航3个模式下的控制要求。在转换过程中通过增益调度的方法实现控制面的逐渐切换,该方法采用离线计算,在线查表的方式,具有计算量小,易于工程实现的优势。利用四元数表征姿态的方法有效避免了欧拉角奇异的问题,试飞验证表明能够满足高度稳定和姿态稳定的控制要求。

References

[1]
路平, 肖文健. 倾转机身无人机俯仰角奇异问题研究[J]. 飞行力学, 2013, 31(5):429-432.
[2]
潘震, 池程芝, 张竞凯, 等. 基于自抗扰滑模理论的倾转旋翼飞行器非线性姿态控制研究[J]. 航空兵器, 2018(6):44-49.
[3]
张飞, 路平, 江涛, 等. 基于模糊控制的倾转三旋翼无人机过渡模式操纵策略研究[J]. 电光与控制, 2018, 25(4):32-36.
[4]
FRANCESCO G D, MATTEI M, EGIDIO D. Incremental nonlinear dynamic inversion and control allocation for a tilt rotor UAV[C]// AIAA. Proceedings of AIAA Guidance, Navigation, and Control Conference. Reston: AIAA, 2014: 13-17.
[5]
陈晓, 王晓燕, 王新民, 等. 改进的倾转旋翼机平稳过渡控制系统设计[J]. 计算机工程与应用, 2019, 155(21):253-259.
[6]
唐胜景, 李梦婷, 刘真畅, 等. 串置翼垂直起降无人机过渡机动飞行控制[J]. 系统工程与电子技术, 2019, 41(6):1342-1350.
针对新型串置翼布局推力矢量无人机在垂直起降、过渡机动飞行过程中强非线性、强耦合及控制冗余的问题,采用动态逆控制方法设计全局控制系统,无需针对不同飞行模式切换控制策略。在此基础上,提出二级递进式控制分配策略,将序列二次规划、链式递增方法相结合,对航迹回路和姿态回路的控制量进行综合优化分配。同时,根据任务需求及飞行状态,基于离线数据库在线实时更新直接力控制分配目标函数权值。采用松弛约束策略,局部放宽非线性优化问题约束,增加优化求解速度。仿真结果表明该控制器能够有效跟踪高机动目标航迹。
[7]
HUSAIN Z, ABDULLAH M Z, YAP T C. Two-dimensional analysis of tandemstaggered airfoils using computational fluid dynamics[J]. International Journal of Mechanical Engineering Education, 2005, 33(3): 195-207.
[8]
鲁可, 刘春生, 汪正中, 等. 倾转旋翼飞行器飞行力学建模及验证分析[J]. 系统工程与电子术, 2017, 39(4):910-916.
[9]
范和平. 基于QFT的倾转旋翼飞行器控制律设计[D]. 南京: 南京航空航天大学, 2017.
[10]
高阳, 吴文海, 周思羽. 垂直/短距起降飞机非线性动力学建模与仿真[J]. 哈尔滨工业大学学报, 2019, 51(4):115-122.
[11]
蒋睿, 魏蛟龙, 岑朝辉. 基于四元数反馈的卫星姿态控制系统仿真模型建立[J]. 系统仿真学报, 2009, 21(19):6260-6265.
[12]
AHMED J, VINCENT T C, BERNSTEIN D S. Adaptive asymptotic tracking of spacecraft attitude motion with inertia matrix identification[J]. Journal of Guidance, Control and Dynamics, 1998, 21(5): 684-691.
PDF(8030 KB)

42

Accesses

0

Citation

Detail

Sections
Recommended

/