基于奇异摄动分解的固定翼无人机抗扰动滑模控制
2023-12-16梅平张豪朱涵智苏东彦赵迅
梅平 张豪 朱涵智 苏东彦 赵迅
奇异摄动法;固定翼无人机;滑模控制;干扰观测器;动力学建模
0 引言
固定翼无人机具有续航时间长、巡航范围大、使用成本低、信息感知强等优点,作为高机动性载具能够搭载多种仪器完成相应任务,被广泛应用于巡逻侦察、电子干扰、战场支援、森林灭火、地形测绘等军民用领域.然而,固定翼无人机是典型的具有非完整线性约束的运动体,其动力学模型具有耦合程度高、非线性强等特点[1].同时,风速等外界的扰动对于无人机的飞行影响也较大,对于不同形态的固定翼无人机,飞行姿态与速度的控制效果也不尽相同.因此,固定翼无人机的控制相较于旋翼等其他无人机控制更为复杂,控制难度也更大.
对于固定翼飞行策略优化控制问题,众多国内外优秀学者都有不同的见解、设计与实践.王力等[2]在设计固定翼控制方法时,引入了非线性干扰观测器对复合干扰进行精确估计,同时设计自适应二阶PID滑模控制器消除了切换控制引起的抖震现象.宗群等[3]针对固定翼无人机的姿态和速度控制中存在不确定和外部扰动的问题,设计自适应超螺旋滑模干扰观测器和控制器,从而实现固定翼无人机对速度和姿态命令的有限时间精确跟踪.蒲明等[4]将新型快速Treminal滑模与动态滑模相结合,避免了控制器抖振,设计了近空间飞行器快、慢回路控制器,并采用改进的非线性干扰观测器逼近近空间飞行器复合干扰,进一步提高控制精度.Raza等[5]利用输出反馈控制拓扑为非线性固定翼模型设计鲁棒控制器并且引入不确定性对控制器和观测器的鲁棒性进行了评估.然而,上述文献未对固定翼模型进行解耦合运算,而是直接对角速度回路和速度、姿态回路采用非线性控制设计方法设计控制器,对于高度耦合系统来说这样处理显然难以保证控制的精度和准确性.
在系统理论与控制工程中,建模是一个基本问题.多数物理系统都含有快、慢动态耦合的现象.早期对这类系统的处理方法是简单地忽略快变模态从而降低系统的阶数,然而,大量事实证明,基于这样的简化模型设计的控制效果往往与设计要求相距甚远.比如,电力系统的快动态以毫秒计,但其能量十分巨大,快动态失调是导致电力系统崩溃的主要原因.因此,如果忽略快动态来分析电力系统的稳定性,效果与实际要求相差甚远[6].奇异摄动方法是有效处理这类问题的工具,其思想是首先忽略快变量以降低系统阶数,然后通过引入边界层校正来提高近似程度[7].这两个降阶的系统就可以用来近似原系统的动力学行为[8].在飞机的控制中,速度的变化远快于角度和位置的变化,可以考虑将此类系统建为奇异摄动模型[9].因此,本文考虑到固定翼无人机的快、慢动态耦合特性,首先将其建立成奇异摄动模型,再利用奇异摄动分解能够有效降低系统阶次[10]、消除系统刚性问题的特性,将固定翼无人机的奇异摄动模型分解为以角速度为快变量的角速度回路和以速度、姿态为慢变量的速度、姿态回路,大大降低控制器的设计复杂性[11].
不同于PID控制,滑模控制[12-13]本质上是特殊的非线性控制,它通过控制作用使得系统的状态轨迹运动到合适的切换流形,然后沿此流形逐渐运动到平衡点,系统一旦进入滑模运动,在一定条件下便会对外部的干扰及参数扰动具有不变特性,因此,滑模控制方法具有算法简单、抗干扰性能好以及容易实现等优点,适用于不确定非线性多变量的控制系统[14].但滑模控制因存在不利的抖动,对系统控制会造成影响,为此本文采用改进的滑模控制方法,从而减少传统滑模所产生的抖动现象,降低系统跟踪误差,提高稳定性.
本文的主要工作体现在以下几个方面:
1)建立固定翼无人机的奇异摄动模型;
2)利用奇异摄动时标分解法对上述奇异摄动模型在不同时间尺度内分解,建立解耦的角速度回路和速度、姿态回路;
3)提出改进的滑模控制器,减少系统抖动;
4)提出基于干扰观测器的滑模控制,减少外部干扰.
1 固定翼奇异摄动系统建模
1.1 坐标系的建立与变换
运动中的固定翼无人机的动力学方程通常可以用非线性状态空间形式或独立的一阶常微分方程组表示,由于方程中包含飞行相关的空气动力、转动惯量等因素,且横、纵向运动之间会发生耦合,为有效表示飞机的运动状态,建立合适的坐标系是极其必要的.为了描述固定翼无人机的速度、位置和姿态变化,本文采用机体坐标系和地面坐标系来描述飞机的飞行状态,并且给出相应的变换矩阵.
选取地面上任意一点ob为地面坐标系原点,xb指向正北,yb与xb垂直且指向正东,zb指向地心且与面xbobyb垂直.机体坐标系原点oe位于固定翼无人机质心处,oexe轴指向固定翼机头方向,oeye轴垂直于oexe轴指向飞机右侧,oeze轴垂直于xeoeye指向固定翼机腹.坐标关系如图1所示.
为建立固定翼无人机动力学模型,现将各方向运动由参数表示,各参数及其含义[15]如表1所示.
表1 机体坐标系下运动参数及其含义
地面坐标系下能够表示出固定翼无人机当前的位置与姿态变化,在地面坐标系下,可分别用θ,ψ,Φ表示固定翼无人机的俯仰、滚转、偏航角,xb,yb,zb表示无人机在地面坐标系下的位置.
1.2 固定翼无人机动力学建模
在不影响实验及算法的基础上,为方便分析,本文将做出如下假设:
假设1:将整架飞机视为刚体,且在运动时间间隔内忽略油量或电量消耗,认为飞机质量为常量.
假设2:由于无人机是具有较小质量和体积的舵机,故可忽略飞机转动部件的陀螺效应及操作控制系统的动力学特性影响.
假设3:飞机质量分布关于xeze平面对称,即D,F为0.忽略地球自转对飞机的影响且重力加速度g不随着飞机的运动而改变.
则可将固定翼无人机非线性模型[15]表示为
(1)
式(1)中各参数含义见表1.
气动力与气动力矩的表达式(包含系统产生的推力与推力矩)如式(2)、(3)所示:
(2)
(3)
CYδAδA+CYδRδR,
ClδAδA+ClδRδR,
CnδAδA+CnδRδR,
(4)
表2 空气动力系数计算参数
1.3 奇异摄动模型建立
为满足奇异摄动法对系统进行快慢分解的要求[17-18],可将各状态参数表示为矩阵与行列式的形式,其表示方法如式(5)所示.
(5)
由于固定翼无人机线速度和角度相较于角速度变化慢[9],因此能够将线速度与角度作为慢变量、角速度作为快变量进行处理.由式(1)、(5)可将动力学模型表示为
(6)
其中,各矩阵表达式如下:
式中,D1,D2分别为系统所受到的内外部扰动,将式(6)进行移项整理化简后可得:
(7)
奇异摄动系统是带有小参数ε的系统,时标分解法在奇异摄动分解领域具有重要的作用.其原理为假设一个系统整体能够分解为快变化(非主导因素)和慢变化(主导因素)的系统,快子系统较慢子系统的变化速率更快,达到稳定时所用的时间也更少.引入小参数ε(0<ε<1),令z1=εz,可将式(7)表示为
(8)
1.4 快慢子系统分解
奇异摄动法能够根据不同的时间尺度将系统分解为近似于原系统的快子系统与慢子系统,从而得到系统的近似解,即快变量与慢变量,通过为两个近似子系统分别设计控制方法以达到预期的控制目标.令快子系统的控制输入为uf,慢子系统的控制输入为us.
假设慢子系统的时间尺度为t,输入为us(t),则令ε=0,代入式(8),可求得近似解:
zs=-G(xs)-1[G2(xs)+G3(xs)us+D2(x,z,t)].
(9)
将式(9)代入式(8)可得慢子系统表达式:
(10)
其中,A(xs)=f2(xs)-F1(xs)G(xs)-1G2(xs),U(xs,us)=[f3(xs)-F1(xs)G(xs)-1G3(xs)]us,
式(10)即为慢子系统数学模型.
由于z=zs+zf,u=us+uf.因此,在新的时间尺度τ(τ=t/ε)下,能够求得:
G3(xs)(us+uf)+D2(x,z,t),
(11)
代入式(9)可得快子系统的数学模型为
(12)
综上,式(10)、(12)共同构成了解耦后的固定翼无人机快慢子系统模型,其中,xs为慢子系统线速度、角度向量,zf为快子系统角速度向量.
2 干扰观测器的设计
由于系统存在不确定性以及外界的干扰,为了尽量减小外界扰动对固定翼无人机控制系统产生的影响,提升系统的控制精度,本文引入了干扰观测器对外界扰动进行逼近.
由文献[19-20]提出的非线性干扰观测器(Nonlinear Disturbance Observer,NDO)结构简单且运算量较小,同时能够获得较高精度的估计值,本文采用此方法对系统内外部的扰动进行估计.假设系统的内外部干扰及其变化率有界,且其界限满足:
(13)
针对慢系统设计的干扰观测器形式如下:
(14)
(15)
求解式(15)可得:
(16)
由式(13)可得补偿误差的上下限:
(17)
3 基于干扰观测器的滑模控制器设计
分别为奇异摄动法分解后的快慢子系统设计滑模控制器能够有效地提升系统的控制精度和速度,其系统控制结构如图2所示.
图2 基于奇异摄动的抗干扰滑模控制Fig.2 Schematic diagram of anti-disturbance sliding mode control based on singular perturbation
本设计采用奇异摄动时标分解法,将固定翼无人机系统飞行控制问题转化为不同的回路,分别设计飞行控制器,此方法在提高不同回路的控制精确性的同时能够显著提高快回路的控制响应速度.
3.1 基于干扰观测器的角度回路滑模控制器设计
对慢子系统设计滑模控制[10,13,18]:
(18)
其中,Xc为给定的系统期望值,Xs为系统的实际输出值,Cs为增益矩阵.
(19)
(20)
本文采用tanh函数代替sign函数,该切换项具有饱和函数特性且比饱和函数更加平滑,能够有效减少滑模控制率的抖动现象,可以保证平滑切换,从而提高系统的稳定性和控制精度.采用李雅普诺夫方程证明稳定性时,该函数具有与sign函数相似的性质,具体可见参考文献[23-24].
将式(18)代入式(17)并用李雅普诺夫方程:
对V求导可得:
(21)
3.2 角速度回路滑模控制器设计
对于快系统
(22)
设计滑模控制,可令滑模面Sf=Cfze,其中ze=zc-zf.
(23)
其中,
设所期望的到达率为
(24)
则相应的变结构控制率为
(25)
(26)
4 仿真与分析
由文献[16]可获得仿真所需的固定翼无人机质量、翼展、面积等数据,再由风洞实验可获得对应的固定翼气动力参数数据.
本文仿真是基于Matlab程序中的Simulink运行的,仿真目标是对奇异摄动方法解耦后的机体坐标系下固定翼无人机速度及角速度进行控制.仿真所采用的固定翼无人机质量m=20.64 kg,翼展b=1.96 m,受力面积S=1.37 m2,三轴上的转动惯量Ixe=1.607 3 kg/m2,Iye=7.508 5 kg/m2,Ize=7.186 5 kg/m2,惯性积J=-0.561,其余参数见表2.
给定期望值Xc为
(40H(t)-20,10H(t)-5,10H(t)-5,
2H(t)-1,2H(t)-1,2H(t)-1)T,
其中,
(27)
给定zc期望值为(2H(t)-1,2H(t)-1,2H(t)-1)T.NDO中参数取值如下:
(28)
图3所示为解耦后的慢系统仿真曲线.
图3 解耦后的基于扰动观测器滑模控制线速度及姿态角仿真对比Fig.3 Simulation comparison of linear velocity and attitude angle of sliding mode control based on disturbance observer after decoupling
从图3可以看出,采用tanh函数代替传统滑模控制函数能够很好地消除抖动现象,从而达到提高系统稳定性效果.图3a—d分别为有无扰动观测器情况下的慢系统线速度与姿态角输出曲线,可以看出,当面对内外部的不确定扰动时,系统很难有效地对扰动做出调整,降低了系统的控制精度,同时也无法保证系统能够追踪期望曲线.因此,面对未知扰动时,加入扰动观测器是很有必要的,对于本身与外部扰动数值相差过大的量,干扰观测器也能够很好地对扰动值进行估计抵消.
图4为带扰动观测器的快系统角速度输出曲线与未解耦的原系统滑模控制系统的角速度输出对比,可以看出,对于采用奇异摄动方法解耦后的快系统,在新的时间尺度τ下单独设计的控制器和扰动观测器能够使得角速度快速达到期望值,相较于传统滑模控制,解耦后的快子系统具有更快的响应速度和更好的稳定性,同时能够抵消大部分外界和内部的干扰.从而说明对于快、慢动态耦合的系统,奇异摄动分解方法和扰动观测器能够快速有效地达到期望控制,同时提高系统的稳定性.
图4 带扰动观测器的快系统与未解耦原系统滑模控制角速度输出仿真对比Fig.4 Simulation comparison of angular velocity output of sliding mode control between fast system with disturbance observer and uncoupled original system
5 结论
针对固定翼无人机速度、姿态的高精度控制,本文采用奇异摄动时标分解方法将固定翼耦合系统分解为慢变的速度回路和快变的角速度回路,同时对解耦后的快、慢系统分别设计基于非线性干扰观测器的改进滑模控制方法.仿真结果表明:本文提出的方法有效地减少了滑模控制所产生的抖震现象,提高了固定翼无人机系统的抗干扰能力;对于采用时标分解解耦的无人机系统,时标分解技术能够降低控制器设计的复杂性和提高系统控制的精度.