鲁棒自适应控制的靶机蛇形机动控制律设计

■棒自适应控制的靶机蛇形机动控制律设计李雪兵;李春涛;坤娅【摘要】针对样例靶机航向不稳定的问题，首先设计了增稳控制律，其次，根据蛇形机动动力学非线性特性，采用线性最优二次型鲁棒自适应动态补偿的混合控制方法，设计了横侧向蛇形机动指令跟踪控制律,实现滚转角和航迹角快速响应的同时兼顾快速消除侧滑角.同时，根据蛇形机动过程中通道之间的耦合效应，进行了解耦补偿控制.通过分析蛇形机动过程中各物理量的运动关系，设计出蛇形机动控制指令.最后，在Matlab/Simulink环境下进行了数值仿真验证，从仿真结果可以看出，蛇形机动控制律可以有效克服外界扰动，维持良好的指令跟踪的响应品质.％Inordertosolvetheproblemofdirectionalinstabilityofthetargetdrone,thestabilityaugmentationcontrollawisdesignedasthebasisforsubsequentcontrollawdesigns.Then,accordingtothenonlineardynamiccharacteristicsofSmaneuver,ahybridcontrolmethodconsistingofrobustservomechanismlinearquadraticregulatorandadaptivedynamicoffsetsisusedtodesignthetrackingcontrollawoflateralSmaneuvercommand,whichcanmaketherollangleandflight-pathanglerespondquicklyaswellaseliminatethesideslipanglerapidly.InordertodecreasethecouplingeffectamongchannelsintheprocessofSmaneuver,thedecouplingoffsetscontrollawisdesigned.TheSmaneuvercontrolcommandisdesignedbyanalyzingthemotionrelationshipbetweenphysicalquantitiesintheprocessofSmaneuver.AnumericalsimulationunderMatlab/Simulinkenvironmentiscarriedout.TheresultsshowthattheSmaneuvercontrollawcanovercometheexternaldisturbanceseffectivelyandtrackcommandswell.【期刊名称】《电光与控制》【年(卷)，期】2018(025)005【总页数】8页(P56-63)【关键词】无人机;控制律;蛇形机动;鲁棒自适应控制;耦合补偿;机动指令【作者】李雪兵;李春涛;坤娅【作者单位】南京航空航天大学自动化学院浦京210016浦京航空航天大学自动化学院，南京210016;南京航空航天大学自动化学院，南京210016【正文语种】中文【中图分类】V2490引言当无人机被锁定时，如何摆脱来袭武器追击，以提高无人机执行任务时的生存率，这给机动控制技术造成巨大的困难。根据歼击机躲避来袭武器的经验可知，机动飞行能有效地降低被击落的概率，而蛇形机动是摆脱锁定追击、降低来袭武器命中率的最有效机动方式之一。蛇形机动可以增大来袭武器的跟踪误差，降低被击落的风险，对提高战场生存率大有裨益。但是蛇形机动时各通道之间耦合严重、控制指令变化剧烈、气动参数摄动大，易激发出严重的非线性，给无人机的控制造成巨大的难题，传统基于小扰动线性化的控制策略显得难以应对，然而，现代控制理论技术的发展和成熟为机动飞行控制带来契机［1］。为了克服蛇形机动中不确定性因素的影响，保证系统的鲁棒性和稳定性，采用鲁棒伺服控制(RSLQR)加自适应控制(MRAC)的策略［2］。鲁棒伺服控制保证系统的稳定性，自适应控制对模型中的不确定性进行在线补偿，共同实现对控制指令精确、快速的跟踪［3］。1问题表述蛇形机动是指周期性改变无人机的滚转角，使无人机产生周期性的航向变化，以及类似蛇类爬行路线的水平航迹曲线。在蛇形机动中，航迹角和滚转角的响应能力是影响无人机蛇形机动交替变化的关键环节。航迹角和滚转角的响应速度越快，单位时间内形成的蛇形轨迹越多，则无人机的蛇形机动能力越强；反之，则越弱。因此，如何设计出具有良好控制品质的航迹角和滚转角回路是蛇形机动飞行的一项关键技术。2无人机动态模型简化在惯性参考系中，描述任意时刻的运动状态需6个自由度，即3个质心运动和3个角运动。为简化建模过程，采用〃平板地球假设”、“地面坐标系即惯性坐标系”、“质量不变”假设条件，运用牛顿定律建立六自由度模型［4］。根据运动方程组可得=P+tan0(Qsin中+Rcos中)(1)式中：p,q,r分别表示滚转、俯仰、偏航角速率冲,e分别表示滚转角、俯仰角。运用基于小扰动线性化原理简化得表示俯仰角配平稳态值。在无侧滑情况下，稳定轴角速率(Ps,Rs)与机体轴角速率(P,R)有如下关系，即(2)假设配平迎角为a0,从式(2)求解(P,R)得(3)将式(3)代入得=(cosa0+sina0tan00)Ps+(cosa0tan00-sina0)Rs⑷迎角、俯仰角以及爬升角满足a=0-Y，代入式(4)得⑸根据小侧滑角P假设，侧滑角动态方程为(6)式中：SR/V/g分别表示方向舵、空速、重力加速度；Y*表示*物理量弓|起的侧力。根据以上分析，无人机横侧向线性动态方程为⑺将式(7)改写为(8)式中：⑼P，S,b,I*分别表示密度、参考面积、展长以及相应轴的转动惯量；8A为副翼舵;L*,N*分别为物理量*引起的滚转力矩和偏航力矩；ClB为滚转静稳定性导数；为滚转阻尼导数；为滚转交叉动导数；Cl8A为滚转操纵导数；Cl8R为操纵交叉耦合导数，偏航通道相关系数意义同理［5］。显然，上述非线性的数学模型不足以完全刻画实际无人机的运动模型。因为无人机除了惯性耦合和操纵耦合之外，还存在舵面操纵效率偏差、气动数据库不准确、外界大气环境扰动、油耗导致重心变化、传感器安装位置偏差等未知扰动和不确定因素。蛇形机动时，横侧向运动剧烈、交叉耦合严重，为保证蛇形机动的控制品质，必须针对上述因素进行克服，降低它们对系统的影响。为了便于分析，本文设舵面效率偏差为八，模型中所有未知有界扰动为w，所有不确定因素为f(x)。根据上述分析，可得无人机的非线性数学模型为(10)式中:xuRn是系统的状态量;uuRm是控制输入量;AuRmxm是具有正对角元素的未知常数对角矩阵，体现控制通道中存在的舵效偏差;f(x)代表蛇形机动中所有不确定因素;wx表示和状态量相关的未知有界干扰［6］。为了克服无人机蛇形机动过程中的有界干扰和不确定因素，本文提出了一种以鲁棒伺服控制为主，自适应控制为辅的控制器架构，控制结构如图1所示。鲁棒伺服控制策略是通过引入积分提高系统的型别，达到抑制扰动的目的。自适应控制方法是把跟踪误差作为一个新的状态变量引入到原系统中进行系统增广，令增广系统中含有不确定因素项为零，可得到参考模型。将原系统输出和参考模型输出进行在线补偿，使系统的输出跟踪参考模型的输出，达到补偿系统中任意形式不确定性的目的。最后，将鲁棒伺服控制器和自适应控制器组成一种并联的控制结构，此结构综合了两者的特点，不仅可以提高抑制扰动的能力，提高系统的鲁棒性，而且还可以克服模型中潜在的不确定性，改善系统的响应品质［7］。图1鲁棒自适应控制结构Fig.1Robustandadaptivecontrolstructure3控制律设计3.1横侧向增稳控制律设计样例无人机采用“八”形尾气动布局，其滚转静不稳定(ClB>0),故需要增稳设计。通过引入角速率和气流角反馈达到增稳的目的，增稳的控制律为(11)式中：K表示增益系数；项增大荷兰滚阻尼比，改善荷兰滚的〃滚摆”效应；耶郎项增强航向稳定性导数Cnp，起到增稳的作用，提高飞机对航向的恢复能力；项增加滚转阻尼，改善滚转效应；K&AB项主要产生滚转力矩增大滚转静稳定性，使滚转静稳定性导数Cip<0,且保证无人机滚摆比Pmax/Rmax在合理的范围，改善荷兰滚发散振荡效应［8］。3.2航向通道控制律设计蛇形机动时航向通道除增稳之外，还必须具备协调转弯、快速消除侧滑角的能力［9］。在气流坐标系下，根据侧力Y的运动方程(12)式中,(-Psina+Rcosa)体现气流角之间的交叉耦合效应，在Y=0,a«0°情况下，可简化为(13)从控制时机来看，在相位上超前侧滑角90°，提前了侧滑角的控制时机，有利于抑制侧滑角的产生。同时引入侧滑角积分，提高了系统型别，具备消除侧滑角稳态误差的能力［10］。由于无人机运动存在耦合，恒定滚转角产生的附加恒定偏航角速率Rb为(14)该附加偏航角速率信号会使无人机在滚转过程中产生不期望的恒定偏航运动，故需要对运动耦合进行补偿。本文采用滚转角反馈加高通滤波的补偿策略，滚转角补偿策略为(15)高通滤波器是为滤掉副翼操纵耦合弓I起的方向舵输出量，以避免产生不期望的偏航运动，提高转弯时的机动性。根据上述分析，得到了最终的方向舵控制律为(16)式中，t为滤波时间常数。3.3滚转通道控制律设计根据六自由度运动学方程，在惯性坐标系下的侧向速度方程为g=ucos0sinip+v(sin中sin0sinip+cos中cosip)+w(-sin中cosip+cos中sin0sinp)(17)式中：u,v,w分别表示体轴系三轴速度；p表示偏航角。在纵向俯仰角较小并且稳定飞行的状态下，w”0,sin0-00故可对上式进行简化得g=ucos0sinp+vcos中cosp(18)从式(18)看出，快速建立侧向速度主要取决于快速建立v和p。而从p的角度看，的运动学方程为(19)滚转角中决定了因此快速建立滚转角是控制蛇形机动飞行的关键。本文的控制策略将滚转通道作为机动的主控通道，航向通道控制律设计已经进行介绍，故以下主要对滚转通道进行设计。为了便于设计，本文选取迎角0°,海拔高度1km,指示空速为141m/s为典型工作设计点，利用小扰动线性化的原理得滚转通道的配平线性化的方程为(20)考虑横侧向未知有界扰动wx、不确定因素f(x)和舵面效率偏差A,将式(20)改写为(21)式中：C=[57.3];D=[0];wx=[wP]。针对滚转通道，为了构造鲁棒伺服控制结构，首先定义跟踪误差e=ycmd-y，其积分为y为输出，ycmd为控制指令。跟踪指令信号有无消除稳态误差的能力取决于系统的型别和控制指令的类型。本文考虑控制指令ycmd为常值信号，则要求系统为I型或I型以上的系统。取e作为一个新的状态变量，从而构建了一个新的伺服模型，其结构为(22)式中：计算可控性矩阵可知，该系统可控。考虑无限时间区间上的二次性能指标函数，即(23)式中，权重Qq阵和Rr阵分别为为了保证误差e为零且矩阵可观测，选取Rr,Qq分别为单位矩阵，对角阵diag(q1,q2)。采取单一变量法，通过分析q1,q2对滚转角速率时频域响应的影响可以发现，q2对滚转角速率时频域特性影响较小，故选取q2=1。图2所示为q1在不同权重时对滚转角速率的时频域特性的影响。图2滚转角速率时频域响应Fig.2Timefrequencyresponseofrollanglerate综合滚转角速率时频域特性的响应品质，选取q1=15,q2=1，再利用Qq阵和Rr阵求解黎卡提方程(24)即可求得最优反馈增益矩阵即KLQR则以滚转角速率为内回路的鲁棒伺服控制器结构为(25)当系统存在未知有界扰动时，运用RSLQR的方法强化对指令误差的控制作用，保证闭环系统的稳定性［11］。根据滚转角速率阶跃响应可知，系统快、准、稳地跟踪控制指令。滚转角速率的其他响应品质见表1,其中，ts为上升时间，wb为带宽，h为幅值裕度，Y为相位裕度。表1滚转角速率响应品质Table1Responsequalityofrollangleratets/swb/(rad・s-1)h/dBy/(°)1.02.77889.0在完成基于RSLQR的滚转角速率内环控制律设计之后设计外环滚转角控制器，根据无人机角运动方程可得=P+(Rrcos中+Qqsin中)tan0(26)滚转角的控制选取比例控制结构Pcmd=K^A(中-中cmd)(27)结合滚转角时频域特性的要求，运用根轨迹的设计方法得滚转角参数K^A=-0.8O综上所述，滚转角的控制律结构为(28)根据图3可以看出，滚转角满足设计要求。图3滚转角阶跃响应及开环伯德图Fig.3Stepresponseandopen-loopBodediagramofrollangle鲁棒伺服的控制策略虽然可以保证控制系统的鲁棒性，但对模型中存在不确定扰动却无法克服，而克服模型中的不确定因素，自适应控制有先天性优势，以下主要给出自适应的设计过程。令等式中wx=0，即只考虑系统存在不确定因素A和f(x)时，则等式简化为(29)式中，f(x)是系统动态中所有不确定因素。针对蛇形机动，f(x)主要与P/p/R/SR相关。记为f(x)=f1(P)+f2(B)+f3(R,8R)(30)由以上分析可知：航向通道主要作用是实现协调转弯消除侧滑角，故忽略f2(B)的影响；f3(R,8R)体现的是操纵交叉耦合不确定性，此项耦合在设计控制律之初已经考虑且与方向舵带来的滚转力矩和副翼操纵滚转力矩相比可基本忽略不计。同时假设简化后不确定函数可写成已知基本函数和未知常值系数的线性组合，故蛇形机动过程中不确定因素简化为f(x)=f1(P)=0T^(xp)。(31)假设ycmd表示系统要跟踪的常数有界指令，跟踪误差为ey，则引入指令误差项作为新的状态量，对原系统进行增广即可得(32)假设最终控制输入u=ubl+uad，设计目的是通过自适应补偿输入uad来抵消A和f(x)对系统的影响。经过鲁棒伺服设计之后，控制输入ubl为(33)将u=ubl+uad代入式(33)改写状态方程为(34)而ubl=-KLQRx，将其代入式(34)最终得O(35)重新定义回归矢量和未知参数增广矩阵即(36)令即得理想参考模型为根据确定参考模型为(38)所以系统对不确定因素的补偿输入为(39)式中，为自适应参数矩阵。将式(39)代入式(35)得(40)为了保证自适应控制系统的闭环稳定性，设计径向无界的二次Lyapunov函数(41)式中：为自适应速率；e=x-xref为增广之后状态量的误差；为Lyapunov方程的对称正定解，沿式(41)轨迹对V求时间微分得(42)应用矢量恒等式aTb=tr(baT)得(43)选取自适应律则(44)这就证明了的一致最终有界性。假设自适应速率分别为「u,「0，它们分别对应于x和①(xp),故系统的自适应律为(45)则总的控制输入为(46)即综合舵效以及滚转阻尼导数对滚转回路的影响，取f(x)=f1(P)=KPP，根据不确定性分析取A=0.7,KP=-1，这些特定的选择对应于控制有效性水平MSA和滚转阻尼MP,而且不确定性是有意选择的，目的是使得LQR闭环短周期开环动态不稳定。经过调试，最终选取自适应率「bl=50,「P=10。线性条件响应如图4所示，RSLQR在无扰动时控制效果良好，但是在扰动存在时控制动态性能变差，而加入自适应后系统输出动态性能明显改观，证明自适应在线补偿策略起到很好的作用。图4系统的指令跟踪性能Fig.4Trackingperformanceofsysteminstruction综上，蛇形机动时横侧向控制结构如图5所示。图5横侧向蛇形机动控制律Fig.5Lateral-directionalflightcontrollawofSmaneuver4蛇形机动指令假设飞机初始航迹角为0°、最大侧向位移L、最大航迹角中max、航迹角指令Wmd。图6所示为一个蛇形机动周期的示意图。控制的目标是通过滚转角控制航迹角，使其在给定范围内交叉变化。图6蛇形机动飞行过程与控制指令生成对应关系Fig.6Therelationshipbetweenflightprocessandcontrolinstructionsgeneration图中,A',B',C',D'的航迹角分别为A,(^cmd),B,(^cmd)/C,(-^cmd)/D,(-^cmd)，其物理意义为当飞机的航迹角大于或者等于航迹角指令时，就需要通过控制改变滚转角以减小航迹角。为了得到合理的控制指令，首先对蛇形机动的运动轨迹进行分析。下面分析蛇形机动半个周期的运动状态。如图6a所示，飞机从初始状态右滚，到达A'点时，即w=wmd,为了减小航迹角，飞机需要进行左滚。因响应需要时间，故航迹角会由^cmd增大至中max,记此点为E'。当航迹角再由中max减小至Wmd,此时飞机到达B'点。飞机到达B'点，因飞机当前处于左滚，航迹角会继续减小，当航迹角由中cmd减小到0°时，记此点为F',此时惯性系下的侧向位移达到最大值L。此时需要减小侧向位移，所以飞机继续保持左滚。当航迹角由0°减小至-wmd处时，飞机到达C'点。飞机到达C'点，即午-wmd，此时需要右滚以增大航迹角。同样，航迹角会先减小至鸣max再恢复到-wmd。此时飞机到达D'点。飞机到达D'点，飞机处于右滚，有利于航迹角减小，当航迹角由-中cmd增加到0°,此时侧偏距为0m。蛇形机动侧向位移响应的半个周期结束。按照此过程分析，滚转角、航迹角与侧向位移之间的相位关系见图6b。根据图6b的相位关系，确定基于滚转角控制的蛇形机动指令形式为(47)5蛇形机动控制律仿真根据上述蛇形机动各物理量的动态变化过程，最终选取蛇形机动的控制指令为：滚转角指令wmd和航迹角指令wmd。在包线范围内，为了充分发挥样例无人机蛇形机动的能力，选取滚转角指令wmd=25。，选取航迹角指令wmd=20。。贝U根据式(47)选取蛇形机动控制指令为选取海拔高度在1km，指示空速141m/s的初始飞行状态进入蛇形机动。下面选取无扰动、风扰动以及参数摄动3种情况在非线性环境下仿真。1） 无扰动情况。为了清晰地看出机动轨迹，图7给出水平面内两个机动轨迹周期，其余信号只给出一个周期内变化情况。在无干扰情况下，根据仿真曲线可以看出，在蛇形机动过程中侧滑角误差保持在±0.5°以内，说明方向舵协调消除误差策略起到良好的效果;根据滚转角速率响应可以看出，蛇形机动过程中滚转角速率峰值达到38（°）/s且响应平稳无超调，说明控制策略兼顾了快速性和控制品质的要求，进一步证明了控制策略的合理性和有效性。图7正常无风扰动条件Fig.7Normalnowinddisturbanceconditions2） 风扰动情况。为了验证控制律的鲁棒性，需要验证无人机在风扰动情况下的机动品质。在惯性坐标系下加入±15m/s的顺逆风干扰。仿真情况如图8所示。图8顺逆风扰动条件Fig.8Downwindandupwinddisturbanceconditions根据图8可知，样例靶机在惯性坐标系下加入顺逆风后，机动飞行中各物理量较无风条件下无明显的变化，说明本文采用的鲁棒伺服控制为主、自适应为辅的主辅架构控制结构可以较好地克服大气环境变化带来的不确定性和未知扰动，进一步证明了控制策略的可行性和合理性。3） 参数摄动情况。选取蛇形机动的参数摄动主要包括副翼舵舵效、方向舵舵效各衰减30%和重心后拉偏0.2m，仿真结果如图9所示。图9参数摄动条件Fig.9Parameterinterferenceconditions通过对副翼舵舵效、方向舵舵效以及重心位置分别进行拉偏仿真测试，从仿真测试结果前后对比可明显看出，样例靶机在参数摄动的干扰条件下，各物理量响应均在正常的范围内，无明显波动，说明设计的控制律可以容忍并克服此项干扰，从而证明了本文所采取的控制策略具有很强的抗扰动性能。综合仿真结果可以看出：在无风标定情况下机动指令的选取和控制律的设计满足了蛇形机动的目标，符合控制的需求；风干扰虽然影响了航迹角的响应，造成滚转角响应的提前或滞后，导致水平面内蛇形轨迹表现出一定的不对称性，但是各信号量品质和标定情况相差无几，依然满足设计指标；参数摄动的情况下，由于设计控制律的强鲁棒性，保证了参数摄动情况下控制量零误差、高动态、无超调地跟踪控制指令，控制效果良好，满足设计需求。6结束语本文以某靶机为研究对象，采用了以鲁棒伺服控制为主，以自适应控制为辅的控制策略，设计了蛇形机动的控制律。鲁棒伺服控制保证控制系统的鲁棒性能，结合自适应的补偿原理，保证了在不确定性存在的条件下依然能良好地跟踪控制指令。仿真曲线表明，在蛇形机动过程中，滚转角能够快速、稳定、零误差地跟踪控制指令且快速消除侧滑角。同时，为了验证控制律的抗扰动能力，对样例靶机在气动系数、重心位置拉偏以及风扰动环境下进行仿真测试，测试结果表明蛇形机动控制律具有良好的鲁棒性，这也更加证明本文采用的鲁棒伺服加自适应主辅架构的控制策略具有良好的理论研究和工程应用价值。参考文献WISEKA,LAVRETSKYE,HOVAKIMYANN,etal.Ve-rifiableadaptivecontrol:UCAVandaerialrefueling[C]//AIAAGuidan