2. 电子信息系统复杂电磁环境效应国家重点实验室, 洛阳 471003
2. State Key Laboratory of Complex Electromagnetics Environment Effects on Electronics and Information System, Luoyang 471003, China
随着现代战场的日益复杂,传统比例导引已经远远不能满足制导系统的发展需求。人们将先进的控制理论应用于导弹的制导系统中,如最优控制、逆系统控制、H∞控制、微分几何控制、随机系统最优控制、滑模变结构控制等,以解决强对抗条件下的精确制导问题。最优制导律虽然在理论上可以实现零脱靶量,但形式复杂,需要信息多,且对信息误差相当敏感。逆系统控制、H∞控制、微分几何控制、随机系统最优控制等方法虽然具有一定的鲁棒性,但均存在形式复杂、需要信息多的缺点。
滑模变结构以其抗干扰特性和设计简单而成功的应用于导弹制导律设计,但受到滑模控制固有的抖振和渐进稳定特性影响,滑模变结构制导律普遍存在抖振严重、收敛速度慢等局限[1]。克服抖振的方法之一是以饱和函数或边界层代替符号函数,但这使得系统轨迹稳定在滑模面附近而不是滑模面上,进而丧失了滑模控制的鲁棒性[2]。另一种抑制抖振的方法是采取高阶滑模控制,高阶滑模在抑制抖振的同时还能保持对干扰的鲁棒性,消除了相对阶的限制, 提高了控制精度[3]。
二阶滑模是目前应用最为广泛的高阶滑模控制方法,因为它的控制器结构简单且需要信息少。螺旋算法、超螺旋(Super-Twisting, ST)算法、次优算法和给定收敛律算法是二阶滑模中常用的4种算法[4],与其他二阶滑模算法相比,ST算法仅需要滑模变量而不需要滑模变量的一阶导数,因此广泛应用于制导律设计。ST算法的有限时间稳定条件需要已知系统不确定性上界,实际应用中这个界的精确值很难确定,为得到系统的稳定控制,往往选取尽可能大的参数,结果带来系统损坏和剧烈抖振[5]。为此多种自适应ST算法相继被提出[6-8],但这些算法大多假设系统不确定性满足一定形式的假设,且在系统状态距离平衡点较远时收敛速度较慢。
针对上述问题,本文在标准ST算法的基础上引入线性项[9],设计了一种新的自适应律,提出了一种新的快速自适应超螺旋(Fast Adaptive Super-Twisting, FAST)算法,该算法不需要已知系统不确定性的边界且收敛速度较快。首先,利用类二次型Lyapunov函数[10-12]证明了系统的有限时间稳定性,并给出了收敛时间公式。随后,将FAST算法应用于末制导问题,提出了一种新的二阶滑模制导律。最后,通过数字仿真将所提制导律与自适应滑模制导律、ST制导律和光滑二阶滑模制导律进行了对比。仿真结果表明,本文算法具有更高的命中精度、更快的收敛速度和更强的鲁棒性。
1 问题描述和相关引理 1.1 问题描述为了研究导弹拦截目标过程中的制导律,首先建立导弹与目标的相对运动模型。对于非滚转导弹,在末制导过程中,姿态控制系统可以控制导弹不滚转,因而弹目相对运动可以解耦成纵向平面和横向平面的运动。以纵向平面为例,弹目相对运动如图 1所示,横向平面的推导与之类似。
图 1中,M和T分别代表导弹和目标所处位置;r为平面内两者的相对距离;q为弹目视线角;vm和vt分别为导弹和目标的速度;θm和θt分别为弹道倾角和目标航向角;am和at分别为导弹和目标的法向加速度。由图 1可以得出弹目相对运动方程为[13]
(1) |
(2) |
式中:
为便于推导,令导弹与目标的相对径向速度
(3) |
(4) |
令
(5) |
其中:atr和amr分别为目标加速度和导弹加速度在视线方向上的分量;atq和amq分别为目标加速度和导弹加速度在视线法向方向上的分量。
整理式(1)~式(5),得
(6) |
(7) |
将
(8) |
在制导律设计时,将amq和atq分别视为系统的控制量和干扰量。根据准平行接近原理,设计制导律的关键在于如何通过amq控制视线角速率
(9) |
在末制导过程中,由于受到过载能力的限制,导弹和目标实际所能提供的最大侧向加速度是有限的。同时受到导引头角跟踪系统的功率、接收机过载等因素的限制,导引头存在最小作用距离r0,当弹目相对距离小于或等于r0时,制导回路断开。记末制导开始时刻为0,不失一般性制导过程满足如下假设。
假设1 存在常数Am>0, At>0, A1>0, A2>0,使得
(10) |
假设2 系统(8)中的时变参数r(t)满足:
(11) |
引理1[14] 对于非线性系统,有
(12) |
假设存在连续可微函数V(x):U→R满足:
1) V(x)为正定函数。
2) 存在正实数ζ1>0和α∈(0, 1),以及包含原点的开邻域U0⊂U,使得下式成立:
(13) |
则系统(12)有限时间稳定;若U=U0=Rn,则系统(12)全局有限时间稳定。收敛时间treach满足:
(14) |
引理2[15] 对于非线性系统(12),假设存在连续可微函数V(x):U→R满足:
1) V(x)为正定函数。
2) 存在正实数ζ1>0,ζ2>0和α∈(0, 1),以及包含原点的开邻域U0⊂U,使得下式成立:
(15) |
则系统(12)有限时间稳定;若U=U0=Rn,则系统(12)全局有限时间稳定。收敛时间treach满足:
(16) |
考虑一阶系统:
(17) |
式中:x∈R为系统状态(同时也是滑模变量);u∈R和E∈R分别为控制输入和不确定项。定义E=E1(x, t)+E2(x, t),E1(x, t)表示不可微的不确定性,E2(x, t)表示可微的不确定性。
系统(17)的ST算法可表示为[16]
(18) |
式中:sgn(x)为符号函数;k1和k2为待设计的参数。若E1(x, t)=0,
(19) |
显然,k1和k2需要根据不确定性的上界确定。
将式(18)代入式(17),令x1=x,x2=u1,化简后的控制系统为
(20) |
令ρ1=E1(x1, t),
(21) |
式(21)的有限时间稳定性证明及收敛时间估计见文献[4]。
2.2 FAST算法设计假设3 E1(x, t)和E2(x, t)满足:
(22) |
式中:g1和g2为未知正数; ϕ1(x)和ϕ2(x)为滑模变量的函数,对不同的控制律有不同的形式。
针对系统(17),设计FAST算法如下:
(23) |
式中:
(24) |
自适应参数控制器为
(25) |
式中:a、b、c1和c2为任意正数。
将式(23)代入式(17),得到控制系统为
(26) |
式中:
(27) |
自适应参数控制器为
(28) |
令ξT=[ϕ1(x1), x2],由
(29) |
可得
(30) |
式中:
由假设3可知:
(31) |
式(31)的等效形式为
(32) |
式(32)可改写为
(33) |
式中:D=[1,0];
定理1 当系统(26)满足假设3时,存在k1*和k2*使得x1和
证明
令
(34) |
(35) |
(36) |
式中:ε1为足够小的正常数。若
(37) |
则Q11 < 0,Q22 < 0,Q12=Q21=0,于是Q为半负定矩阵。令
(38) |
由分块矩阵的性质可以得到Φ为半负定矩阵。
选取类二次型Lyapunov函数V=ξTPξ,由式(29)和式(30)得
(39) |
结合
(40) |
可得
(41) |
由ϕ1(x1)=|x1|1/2sgn(x1)+x1可得
(42) |
(43) |
因此
(44) |
(45) |
由引理2可知,若k1*、k2*满足式(37),则ξ=[ϕ1(x1), x2]T在有限时间内收敛到0,即x1和
(46) |
证毕
由定理1可知,对于未知常数g1和g2,存在满足式(37)约束的k1*和k2*使得x1和
定理2 当系统(26)满足假设3,控制器参数k1和k2满足式(28),g1和g2为未知数时,x1和
证明
1) 若k1≥k1*, k2≥k2*,且
2) 若k1 < k1*, k2 < k2*,选取类二次型Lyapunov函数:
(47) |
(48) |
式中:
(49) |
显然
(50) |
由定理1的证明过程可知:
(51) |
① 若|x1|>0,则
(52) |
(53) |
结合式(51),得到
(54) |
式中:
(55) |
于是有
(56) |
式中:
(57) |
(58) |
由引理1可知,系统(26)有限时间稳定,且收敛时间满足:
(59) |
② 若|x1|=0,则系统状态到达滑模面,且
由于s很难严格收敛至0,而是在0的一个极小邻域内波动,使得k1和k2过大,进而引起系统不稳定。因此,将自适应参数控制器改进为
(60) |
式中:ε2为很小的正数。
3 制导律设计由准平行接近原理可知,希望
(61) |
式中:c0=0.1。
结合式(7)可得
(62) |
式中:
(63) |
由定理3及式(9)得到FAST制导律为
(64) |
式中:
(65) |
其中:k1和k2的值满足式(60)。
FAST制导律对外界干扰具有鲁棒性,且能够在有限时间内收敛。由制导律的形式可以看出,参数k1和k2随着s的变化实时改变,且不需要已知外部干扰的上界。
4 仿真分析为验证所提制导律的有效性,将FAST制导律(Fast Adaptive Super-Twisting Guidance, FASTG)与自适应滑模制导律(Adaptive Sliding Mode Guidance,ASMG)、光滑二阶滑模制导律(Smooth Second Order Sliding Mode Guidance,SSOSMG)、ST制导律(Super-Twisting Guidance,STG)进行对比。其中,ASMG为一阶滑模制导律,其他为二阶滑模制导律,且4种制导律均采取式(61)作为滑模面。
ASMG为[17]
(66) |
式中:k1=k2=2。
SSOSMG为[18]
(67) |
式中:N=4,k1=3,k2=1,
STG为[19]
(68) |
式中:k1=4,k2=3。
FASTG形式如式(64)所示,参数满足:a=0.5, b=1, c1=c2=1, ε2=0.1。
制导律所需的r、
为了全面分析4种制导律的特点,分别在目标无机动和目标有机动2种情形下对制导性能进行比较。
4.1 目标无机动(情形1)仿真条件:导弹初始位置为(0, 0) km,初始速度为500 m/s,初速度方向为30°,初始过载约束为15g,切向过载为0,法向过载由制导律得到。目标初始位置为(10, 5) km,初始速度为300 m/s,初速度方向为180°,切向过载和法向过载均为0。
MATLAB仿真仿真结果如表 1和图 2~图 4所示。表 1为情形1的仿真结果,其中Δ为脱靶量,treach和
制导律 | Δ/m | treach/s | tf/s | |
ASMG | 0.462 2 | 7.36 | 10.53 | 14.94 |
SSOSMG | 0.518 6 | 12.2 | 21.83 | 14.91 |
STG | 1.175 6 | 6.65 | 12.25 | 14.92 |
FASTG | 0.616 0 | 5.30 | 14.64 | 14.90 |
由图 2及表 1中的Δ和tf可知,4种制导律的弹道平直且差异很小,制导时间接近,脱靶量STG最大,ASMG最小,SSOSMG和FASTG略高于ASMG,由于脱靶量远小于导弹杀伤半径,因此可视为直接命中目标。由图 3及表 1中的treach可知,4种制导律均能够在有限时间内使得s(t)及
总之,在目标无机动的情形下,由于弹道接近直线,与其他方法相比,FASTG的脱靶量和制导时间相近,收敛速度最快,过载最大,其优势并不明显。
4.2 目标有机动(情形2)仿真条件:导弹初始位置为(0, 0) km,初始速度为500 m/s,初速度方向为45°,最大过载为30g,切向过载为0,法向过载由制导律得到。目标初始位置为(2, 2) km,初始速度为300 m/s,初速度方向为0°,切向过载为0,法向过载nt=(5cos t)g。
MATLAB仿真结果如表 2和图 5~图 7所示,其中曲线和变量含义与情形1相同。
制导律 | Δ/m | treach/s | tf/s | |
ASMG | 0.549 4 | — | 20.31 | 12.57 |
SSOSMG | 0.566 2 | 10.91 | 21.30 | 11.92 |
STG | 0.319 7 | — | 20.43 | 11.97 |
FASTG | 0.875 3 | 1.79 | 18.98 | 11.74 |
图 5与图 2相比,导弹弹道弯曲,其中ASMG最高,STG和SSOSMG次之,FASTG最低。表 2中的脱靶量STG最小,ASMG和SSOSMG次之,FASTG最大,由于均远小于导弹杀伤半径,均可视为直接命中目标。制导时间FASTG最短,ASMG最长,STG和SSOSMG介于两者之间。由图 6可知,FASTG能够使得s(t)及
总之,目标机动情形下,弹道弯曲,FASTG制导时间最短,脱靶量相近,收敛特性明显优于其他方法,仅在初始阶段的过载较大。因此,FASTG在此情形下的表现更为优异。
5 结论1) 在标准ST算法的基础上,增加了自适应参数控制器和线性项,提出了FAST算法。在系统不确定性上界未知的前提下,一方面控制器参数能够自适应调节,避免参数过大造成系统不稳定;另一方面系统在远离平衡点时具有更快的收敛速度,提升了标准ST算法的收敛特性。
2) 利用二次型Lyapunov函数证明了FAST算法的有限时间稳定性,与其他证明方法相比,该方法计算较为简单,且能够得到收敛时间的估计公式。
3) 将FAST算法成功地应用于制导律设计。仿真结果表明,本文算法在保留标准ST算法有效抑制抖振、鲁棒性强等优点的同时,具有快速收敛特性且不需要已知不确定性的上界,使得制导系统拥有更高的命中精度和稳定性。
[1] |
谭健.飞翼布局无人机鲁棒滑模非线性飞行控制研究[D].西安: 西北工业大学, 2015: 72-77. TAN J.Research on robust sliding mode nonlinear flight control for fly wing UAV[D].Xi'an: Northwestern Polytechnical University, 2015: 72-77(in Chinese). https://wenku.baidu.com/view/a8afa51d777f5acfa1c7aa00b52acfc788eb9f5c.html |
[2] |
杨洁.高阶滑模控制理论及其在欠驱动系统中的应用研究[D].北京: 北京理工大学, 2015: 68-72. YANG J.Higher-order sliding mode control theory and its application on under actuated systems[D].Beijing: Beijing Institute of Technology, 2015: 68-72(in Chinese). http://www.bigengculture.com/shoufeilunwen/jckxbs/312170.html |
[3] |
陈炳龙.基于二阶滑模算法的航天器相对位姿耦合控制研究[D].哈尔滨: 哈尔滨工业大学, 2015: 77-83. CHEN B L.Research on spacecraft relative position and attitude coupled control on the basis of second-order sliding mode algorithm[D].Harbin: Harbin Institute of Technology, 2015: 77-83(in Chinese). https://wenku.baidu.com/view/9d29b85e4b7302768e9951e79b89680202d86b60.html |
[4] |
李鹏.传统和高阶滑模控制研究及其应用[D].长沙: 国防科技大学, 2011: 73-78. LI P.Research on application of traditional and high-order sliding mode control[D].Changsha: National University of Defense Technology, 2011: 73-78(in Chinese). https://max.book118.com/html/2017/0316/95630926.shtm |
[5] |
韩耀振.不确定非线性系统高阶滑模控制及其在电力系统中的应用[D].北京: 华北电力大学, 2017: 20-21. HAN Y Z.Uncertain nonlinear system higher-order sliding mode control and its application in power system[D].Beijing: North China Electric Power University, 2017: 20-21(in Chinese). |
[6] |
李炯, 张涛, 雷虎民, 等. 非奇异快速终端二阶滑模有限时间制导律[J]. 系统工程与电子技术, 2018, 40(4): 860-867. LI J, ZHANG T, LEI H M, et al. Nonsingular fast terminal second order sliding mode guidance law with finite time convergence[J]. System Engineering and Electronics, 2018, 40(4): 860-867. (in Chinese) |
[7] |
叶继坤, 雷虎民, 赵岩, 等. 基于二阶滑模控制的微分几何制导律[J]. 系统工程与电子技术, 2017, 39(4): 837-845. YE J K, LEI H M, ZHAO Y, et al. Differential geometric guidance law based on second-order sliding control[J]. System Engineering and Electronics, 2017, 39(4): 837-845. (in Chinese) |
[8] |
郭建国, 韩拓, 周军, 等. 基于终端角度约束的二阶滑模制导律设计[J]. 航空学报, 2017, 38(2): 320208. GUO J G, HAN T, ZHOU J, et al. Second order sliding mode guidance law with impact angle constraint[J]. Acta Aeronautica et Astronautica Sinica, 2017, 38(2): 320208. (in Chinese) |
[9] |
HE S M, LIN D F, WANG J. Continuous second-order sliding mode based impact angle guidance law[J]. Aerospace Science and Technology, 2015, 41: 199-208. DOI:10.1016/j.ast.2014.11.020 |
[10] |
TENOCH G, JAIME A, LEONID F. Variable gain super-twisting sliding mode control[J]. IEEE Transactions on Automatic Control, 2012, 57(8): 2100-2105. DOI:10.1109/TAC.2011.2179878 |
[11] |
MORENO J A, OSORIO M. Strict Lyapunov functions for the super-twisting algorithm[J]. IEEE Transactions on Automatic Control, 2012, 57(4): 1035-1040. DOI:10.1109/TAC.2012.2186179 |
[12] |
SHTESSEL Y, TALEB M, PLESTAN F. A novel adptive-gain supertwisting sliding mode controller:Methodology and application[J]. Automatica, 2012, 48: 759-769. DOI:10.1016/j.automatica.2012.02.024 |
[13] |
POLYAKOV A, POZNYAK A. Reaching time estimation for "Super-Twisting" second order sliding mode controller via Lyapunov function designing[J]. IEEE Transactions on Automatic Control, 2009, 54(8): 1951-1955. DOI:10.1109/TAC.2009.2023781 |
[14] |
SHTESSEL Y B, SHKOLNIKOV I A, LEVANT A. Guidance and control of missile interceptor using second-order sliding modes[J]. IEEE Transactions on Aerospace and Electronic Systems, 2009, 45(1): 110-124. DOI:10.1109/TAES.2009.4805267 |
[15] |
WANG Z. Adaptive smooth second-order sliding mode control method with application to missile guidance[J]. Transactions of the Institute of Measurement and Control, 2017, 39(6): 848-860. DOI:10.1177/0142331215621616 |
[16] |
LEVANT A. Sliding order and sliding accuracy in sliding mode control[J]. International Journal of Control, 1993, 58(6): 1247-1263. DOI:10.1080/00207179308923053 |
[17] |
杨鹏飞, 方洋旺, 伍友利, 等. 随机快速光滑二阶滑模末制导律设计[J]. 国防科技大学学报, 2017, 39(4): 131-138. YANG P F, FANG Y W, WU Y L, et al. Terminal guidance law design of stochastic fast smooth second-ordersliding modes[J]. Journal of National University of Defense Technology, 2017, 39(4): 131-138. (in Chinese) |
[18] |
SHTESSEL Y, TOURNES C, SHKOLNIKOV I.Guidance and autopilot for missile steered by aerodynamic lift and divert thrusters using second order sliding modes: AIAA-2006-6784[R].Reston: AIAA, 2006.
|
[19] |
SHTESSEL Y, KOCHALUMMOOTTIL J, EDWARDS C. Continuous adaptive finite reaching time control and second-order sliding modes[J]. IMA Journal of Mathematical Control and Information, 2013, 30(1): 97-113. DOI:10.1093/imamci/dns013 |