关于制导律国内外开展了大量的研究.其中应用最为广泛的是比例导引(proportional navigation),其控制方式是令导弹加速度指令与弹目相对速度及视线角速率成比例[2].但当目标做大机动飞行时,比例导引难以保证准确命中目标.文献[3]提出了一种真比例制导率,通过控制导弹垂直于视线方向的加速度大小补偿目标机动,达到了减小脱靶量的效果.谷志军和陈磊[4]针对动能拦截器顺轨拦截问题设计了一种比例导引律降低了导弹的需用过载,但该方法仅适用于导弹速度大于目标速度的情况.
随着控制理论的研究深入,许多****提出了基于现代控制理论的制导律设计方法.如最优制导律[5, 6, 7],滑模制导律[8, 9, 10, 11],backstepping制导律[12, 13],动态面制导律[14, 15]等.李浩和佘浩平[6]以弹目相对位置及相对速度为约束,设计了一种弹道成型的最优制导律.Indig等[7]利用最优控制理论,提出了一种改进比例制导律.朱战霞等[1]利用终端滑模理论设计了适用于动能拦截器的末段制导律,通过在滑模面的设计中引入非线性函数,使得跟踪误差在有限时间快速收敛到零,但在初始阶段该方法的需用过载偏大.张运喜等[8]提出了一种基于有限时间收敛的滑模变结构制导律,实现了制导系统的视线角速率快速收敛到零,由于该制导律针对的是地面固定目标,故并未考虑目标机动.Rao和Ghose[10]针对目标机动设计了一种新型滑模变结构制导律,该制导律将目标的加速度及加速度的导数视为未知有界变量,并在控制量设计中对其补偿.但该方法容易令导弹需求的法向过载过大,并产生高频抖振现象.刁兆师和单家元[13]利用backstepping的思想,设计了一种考虑自动驾驶仪动态特性并含有攻击角约束的制导律,但该方法会导致微分膨胀.为解决微分膨胀问题Qu和Zhou[14]考虑导弹自动驾驶仪二阶动态特性,设计了一种基于动态面理论的制导律.
在实际应用中,由于系统的某些状态量及目标某些参数难以测量,故对设计制导律所需要的未知量的估计显得尤为重要.Zarchan[16]和Shima等[17]分别利用卡尔曼滤波(KF)及扩展卡尔曼滤波(EKF)的方法对系统的状态量及目标的参数进行估计.Zhu等[18]利用扩张状态观测器(ESO)对目标的加速度实时估计,并利用滑模控制理论设计了一种变结构制导律.Zhang等[19]利用积分滑模控制方法设计制导律,并将目标的机动视为有界干扰并通过非线性干扰观测器对其实时估计,通过控制视线角速率有限时间趋近于零从而命中目标.
综上所述,在拦截打击目标时,大多是针对导弹速度大小恒定,通过控制弹目视线角速率有限时间收敛至零为目标设计的制导律.而这种方式使导弹以曲线弹道实现对目标的拦截,同时对于动能拦截武器也难以获得最大的碰撞速度.
针对动能拦截器轴向加速度不为零的情况,本文设计了一种基于碰撞航线(collision course)的滑模制导律.该制导律的核心思想,即利用姿态控制发动机瞬间改变弹体姿态,产生用于改变速度方向的需用法向过载,使导弹的速度矢量始终指向预期的碰撞点,直至完成对目标的拦截.在制导律设计过程中,将未知的目标机动视为有界干扰,利用非线性干扰观测器(NDO)对其实时估计,并把估计值用于对目标机动的补偿,实现对目标的精确打击.
1 弹目相对运动模型目标的拦截问题,通过合理的解耦,可以将三维问题转化为两个相互垂直平面内的二维问题,分别在两平面内独立设计对应的制导律.为研究方便,本文选择在纵向平面场景内研究.图 1描述了导弹与目标在笛卡儿惯性坐标系Oxy下的相对运动关系.分别定义导弹M和目标T各参数变量的下标为m和t.
图 1 弹目拦截几何Fig. 1 Missile and target engagement geometry |
图选项 |
为了简化问题,假设导弹和目标均为质点,忽略导弹和目标所受重力,且导弹的自动驾驶仪及姿态控制系统均具有理想动态特性.在极坐标系下弹目的相对运动学方程为
式中:r和$\dot r$分别为弹目相对距离及其变化率;λ和$\dot \lambda $分别为视线角及其变化率;γt为目标的航迹角;γm为导弹的航迹角;Vt和Vm分别为目标和导弹的速度;Vr和Vλ分别为弹目相对速度沿视线(Line of Sight,LOS)和垂直视线方向上的分量.定义两个变量:
假设导弹可以通过火箭发动机获得沿弹轴方向恒定的加速度,忽略推力偏心.且能够通过推力矢量发动机实时改变弹体姿态即改变弹体的攻角α,从而使沿弹轴的加速度am可以指向需求的方向,则导弹速度的变化率$\dot V$m和航迹角变化率$\dot \gamma $m满足如下关系:<
为方便研究,假定目标运动速度Vt恒定且其加速度at的方向始终垂直于速度的方向,满足如下关系:
2 基于碰撞航线的制导律设计在本节中,设计一种基于碰撞航线的制导律,使拦截器能够沿平直弹道运动至预期的碰撞点.
当导弹与目标处于碰撞航线上时,同一时间内导弹与目标在垂直于视线方向的运动距离相同,则存在如下关系:
假设导弹加速度am的值恒定,且目标做非机动匀速运动,整理式(8)有
式中:tgo(time-to-go)为从当前时刻至完成拦截所需要的时间.当导弹与目标处于并保持在碰撞三角形航线上运动时,存在如下关系[20]:
对tgo求导有
式中:$\dot V$r=Vλ2/r+atsinθt+amcos(α+θm)为弹目相对速度在视线方向的变化率.为确保导弹始终在碰撞航线上运动,将式(10)带入式(9)中可得
式中:θmr为导弹保持碰撞航线所需θm的值;$\bar V$m=Vm+amtgo/2为导弹沿碰撞航线运动的平均速度,其导数为
定义状态变量x=sinθm-sinθmr,并对x求导可得如下角度误差跟踪系统:
式中:ω1=amsinθtcosαVt/$\bar V$m2;ω2=amycos(α+θm);y=amsinθttgoV/2$\bar V$m2Vr.
为实现跟踪误差的收敛,本文利用滑模控制理论来进行制导律的设计.选取滑模面S=x根据滑模运动可达性条件选择如下趋近律:
式中:k>0,σ>0,0<η<1.显然式(15)所描述的趋近律能够使系统的状态量在有限时间内从初值收敛到S的邻域内.
由于系统(14)的控制量α与导弹法向过载aeqm存在如下关系:
为分析方便,取u=ameq=amsinα为闭环系统虚拟控制量,联立式(14)和式(15)有
从式(17)可以看到,目标的加速度出现在控制量中.由于实际导弹拦截中,目标的加速度难以直接测量,因此采用NDO对目标的加速度进行估计.
引理 1[21] 考虑如下单输入单输出(SISO)非线性系统:
式中:ψ为系统的状态量;u∈R为充分光滑的系统输入;g(t)为充分光滑的不确定函数.
定理 1[22] 考虑上述非线性系统(18),假设u和ψ可测,g(t)有界且存在Lipschitz常数L>0使得|g(m-1)(t)|<L,则有如下观测器:
假设参数λi足够大的,并忽略输入噪声,系统的状态量及干扰的估计值将有限时间收敛,即
式(19)中参数λi的选取方法可参考文献[23],随着λi的增大,观测器的收敛速度加快,但观测误差将增大,同时对噪声更加敏感,降低了观测器的估计性能.因此,需要在仿真和实际应用中合理地选取λi的值.
对式(2)求导得
式中:atλ=atcosθt为目标垂直于视线方向的加速度.设计观测器如下:
文献[23]给出了NDO的稳定性证明.假设Vλ,Vr,r,γm,λ可测,且目标法向加速度at有界,则|atλ|≤atλmax,|$\dot a$tλ|≤$\dot a$tλmax,其中atλmax,$\dot a$tλmax分别为目标加速度及其导数的上界[21].由定理1可知观测器参数L>$\dot a$tλmax,并通过合理地选择λ0,λ1,NDO的观测误差e=$\hat a$t-at将趋近于零,则z0和z1分别收敛于Vλ和-atλ.
目标加速度at的估计值可表示为$\hat a$t=$\hat a$tλ/cosθt.联立式(17)和式(21),基于碰撞航线的导弹滑模制导律(NDOGC)虚拟控制量为
3 稳定性分析考虑如下非线性系统[24]:
式中:f:U×R→Rn在U×R连续;U为原点x=0的一个开邻域.
定理 2 对于系统(23),给定任意初始时刻t0的初始状态x(t0)=x0∈U,存在一个依赖于x0的收敛时间T≥0,使系统方程以x0为初始状态的解x(t)有定义,且有
当t∈[t0,T(x0)),φ(t;t0,x0)∈U\{0},那么系统的平衡点x=0是局部有限时间收敛的,如果U=Rn,则平衡点是全局有限时间收敛的.
引理 2[24] 考虑式(23)所描述的非线性系统,假设V(x)是定义在原点的邻域$U \subset R$的C1光滑正定函数.存在实数1>β>0及ρ>0,使得$\dot V\left( x \right) + \rho {V^\beta }\left( x \right)$是定义域$U \subset R$的半负定函数,则存在定义域${U_0} \subset U \subset R$,使得定义在${U_0} \subset R$上的任意V(x)均能以有限时间收敛至原点.若Trr为V(x)收敛至零的时间,则
式中:x0为原点x=0某一开邻域中的任何一点.如果U0=Rn且V(x)是径向无界的(V(x)→+∞,当||x||→+∞),那么系统(23)的原点是全局有限时间收敛的.
定义如下的Lyapunov函数:
由式(26)对时间t求导可得
式中:W≥|ω1|+|ω2|;c=cosθt/$\bar V$m+ysinθt;e为观测器观测误差.假设存在实数δ满足0<δ≤1,整理式(27)有
如果V(η+1)/2>(|Sce|+|SW|)/2(η+1)/2(1-δ)σ,有$\dot V$≤-2(η+1)/2σδV(η+1)/2,则$\dot V$+2(η+1)/2·σδV(η+1)/2为定义域上半负定函数.
由引理2可知,随着V减小,闭环系统满足V(η+1)/2>(|Sce|+|SW|)/2(η+1)/2(1-δ)σ,系统的收敛性得证.且S满足:
式中:0<δ0<1.函数V收敛至零的时间满足式(30):
式中:S0为S的初值.
因此,当NDO稳定时,通过合理地调节参数k,σ使$\dot V$<0,闭环系统(14)的轨迹将会以有限时间收敛至滑模面S=0的邻域内.
参数k,σ能够保证当滑模面S较大时,系统状态量能以较大的速度趋近于滑动模态,且随k,σ增大系统有限时间收敛性越好,S的收敛速度越快.但过大的k,σ会导致系统的控制量过大,并产生抖振.通过调整参数η的值,可保证系统状态量远离滑动模态(S较大)时,能以较大的速度趋近于滑动模态,当系统状态量趋近滑动模态(S较小)时,保证较小的控制增益,以降低抖振.
4 仿真结果及分析导弹在惯性坐标系中的初始位置为xm(0)=50 000 m,ym(0)=0 m,目标的初始位置为xt(0)=yt(0)=0 m.导弹的初始航迹角γm0∈[90°,160°],目标的初始航迹角γt0∈[0°,90°],导弹的加速度am=20 g.
由于式(22)中的符号函数sgn(S)会导致控制量的抖振,从而导致制导精度下降.选择Sigmod函数代替,表达式为
式中:ε为边界层;参数a为幅值增益可调节sig(S,a,b)函数的幅值;参数b为指数因子可调节sig(S,a,b)函数的近似线性区间的范围.本文选取的参数分别为a=2,b=40,ε=0.2.
由于1≥|sinα|≥ameq/am,从式(22)中可以看出当cosθm→0时会令|ameq|→∞,远大于导弹所能够提供的最大加速度,故对其限幅为
基于有限时间收敛理论设计的制导律(FTCG)是以零化视线角速率为目标设计的,本文利用FTCG与NDOGC相对比,分析两类制导律的不同.FTCG采用如下形式[9]:
式中:N为大于2的常数;μ>0;0≤n<1;f为目标加速的上界.
两种制导律相关参数分别为k=3,σ=5,η=0.5,L=80,λ0=1.5,λ1=1.1,N=10,μ=1.5,n=0.5,f=80.
4.1 拦截非机动目标选取导弹和目标的初始航向角分别为γm0=160°和γt0=20°,导弹和目标的初始速度分别为Vm0=1 500 m/s和Vt0=3 000 m/s,仿真结果如图 2、图 3所示.
图 2 导弹和非机动目标相对运动轨迹Fig. 2 Trajectories of missile and nonmaneuvering target relative motion |
图选项 |
图 3 导弹和非机动目标的攻角变化Fig. 3 Variation of angle of attack for missile and nonmaneuvering target |
图选项 |
在NODGC制导律的作用下,导弹命中目标需要9.94 s,脱靶量为0.18 m,命中时刻导弹的速度为3 431.3 m/s,对于FTCG制导律,命中目标需要10.87 s,脱靶量为0.38 m,命中时刻的速度为2 942.8 m/s.
从仿真结果可以看出,两种制导律都可以有效地命中目标.从图 2可以看出,在NDOGC制导律的作用下,导弹的速度方向始终指向碰撞点,运动轨迹近似一条直线.在制导律FTCG的作用下,导弹通过改变航迹角使视线角速率趋近于零,这种方式迫使导弹以曲线运动轨迹命中目标.从图 3可以看出,导弹在NDOGC制导律的作用下,消除了初始航向误差后,攻角近似为零,使导弹获得更高的命中速度,这对提高动能拦截器的杀伤效果是非常重要的.对比制导律FTCG,为保持视线角速率趋近于零需要不断地调整导弹的攻角并最终收敛于常值,直至命中目标.这说明导弹的加速度方向与速度方向不重合,难以充分利用导弹的加速度提高自身动能.
4.2 拦截机动目标选取导弹和目标的初始航向角分别为γm0=160°和γt0=20°,导弹和目标的初始速度分别为Vm0=1 500 m/s和Vt0=3 000 m/s,目标以加速度at=8 g sin(0.5t)做正弦机动.仿真结果如图 4、图 5所示.
图 4 导弹和机动目标相对运动轨迹Fig. 4 Trajectories of missile and maneuvering target relative motion |
图选项 |
图 5 导弹和机动目标的攻角变化Fig. 5 Variation of angle of attack for missile and maneuvering target |
图选项 |
在NODGC制导律的作用下,导弹命中目标需要10.28 s,脱靶量为1.32 m,命中时刻导弹的速度为3 425.3 m/s,对于FTCG制导律,命中目标的时间为12.21 s,脱靶量为4.06 m,命中时刻的速度为2 369.2 m/s.
从仿真结果可以看出,在目标做大机动运动时,制导律NDOGC的脱靶量更小,命中时间更短,命中速度更高.如图 4可知,相比于制导律FTCG,制导律NDOGC使导弹的运动轨迹更加平直,命中目标耗时更短.其控制量变化如图 5,由于NDO对目标加速度的实时估计,并在控制量中对目标加速度变化带来的扰动进行了有效的补偿,降低了导弹需求的法向过载,故制导律NDOGC的攻角变化范围更小,更有利于弹体的飞行稳定.
考虑NDO对目标加速度的观测性能,如图 6所示.观测器的估计值$\hat a$t可以稳定地跟踪目标加速度的实际值at,说明本文的干扰观测器具有良好的性能,估计误差较小.
图 6 目标加速度的估计Fig. 6 Estimation of target acceleration |
图选项 |
如图 7所示,设计的状态反馈控制律能够保证滑模面在有限时间趋近于零,实现基于碰撞航线的拦截策略.
图 7 滑模面随时间变化曲线Fig. 7 Curve of sliding mode surface changing with time |
图选项 |
4.3 可拦截区域分析可拦截区域是评判制导律的主要指标之一,是在有效拦截目标并满足一定约束条件下的导弹与目标初始航迹角的集合.
本文定义当脱靶量小于5 m即认为能够有效拦截目标.选取导弹和目标的初始航向角集合分别为γm0∈[90°,160°]和γt0∈[0°,90°],导弹和目标的初始速度分别为Vm0=1 500 m/s和Vt0=3 000 m/s,目标的最大过载为5g.
仿真结果如图 8、图 9所示.图中MISS表示导弹脱靶,HIT表示导弹命中目标.由结果可以看出,制导律NDOGC的可拦截区域远大于FTCG.
图 8 FTCG的拦截区域Fig. 8 Capture zone of FTCG |
图选项 |
图 9 NDOGC的拦截区域Fig. 9 Capture zone of NDOGC |
图选项 |
NDOGC仅在γm0∈[90°,140°],γt0∈[0°,17°]的小部分区域难以拦截目标,在余下区域均可成功拦截.而FTCG在γt0∈[0°,17°]及γt0∈[34°,90°]的大部分区域都难以命中目标.故制导律NDOGC可适用的弹目初始航向角范围更广.
4.4 可拦截目标速度范围对导弹而言,成功拦截目标的速度区间也反应了制导律的适用范围.由于篇幅所限,本文仅以导弹和目标的初始航向角分别为γm0=120°及γt0∈{20°,40°,60°}为例,分析两种制导律的适用范围.导弹的初始速度为Vm0=1 500 m/s,目标以加速度at=5g sin(0.5t)做正弦机动.
仿真结果如表 1,在导弹初始航迹角、初始速度及加速度恒定的条件下,制导律NDOGC在目标初始航迹角分别为20°,40°,60°的条件下所拦截目标的速度范围均明显大于制导律FTCG.仿真结果表明,对于高速机动目标拦截,NDOGC更加适用.
表 1 两种制导律拦截目标的速度范围Table 1 Velocity range of intercepting target for two guidance law
γm0/(°) | FTCG Vt0/(m·s-1) | NDOGC Vt0/(m·s-1) |
20 | 0~4 472 | 0~5 832 |
40 | 0~2 586 | 0~3 905 |
60 | 0~2 163 | 0~3 877 |
表选项
5 结 论针对动能拦截器在大气层外拦截机动目标且目标加速度不可测等问题,本文提出基于NDO和碰撞航线的新型滑模制导律.并与以零化视线角速率为目标设计的有限时间收敛制导律对比,本文所述制导律能够保证导弹以更短的时间、更小的过载、更大的末端速度实现对目标的拦截.同时,扩展了导弹的可拦截区域及可拦截目标的速度范围,具有较好的工程应用前景.
参考文献
[1] | 朱战霞,韩沛,陈鹏.基于非线性Terminal滑模的动能拦截器末制导律设计[J].西北工业大学学报, 2013, 31(2):233-238. Zhu Z X, Han P, Chen P.Design of nonlinear Terminal SMGL(sliding-mode guidance law) for KKV(kinetic kill vehicle)[J].Journal of Northwestern Polytechnical University, 2013, 31(2):233-238(in Chinese). |
Cited By in Cnki (4) | |
[2] | Yuan L C.Homing and navigational courses of automatic target-seeking devices[J].Journal of Applied Physics, 1948, 19(12):1122. |
Click to display the text | |
[3] | Garnell P.Guided weapon control systems[M].Oxford:Pergamon Press, 1980:238-240. |
[4] | 谷志军,陈磊.大气层外动能拦截器顺轨拦截技术研究[J].宇航学报, 2007, 28(5):1195-1198. Gu Z J, Chen L.Research on interception along track for exoatmospheric[J].Journal of Astronautics, 2007, 28(5):1195-1198(in Chinese). |
Cited By in Cnki (4) | |
[5] | 张友安,黄诘,孙阳平.带有落角约束的一般加权最优制导律[J].航空学报, 2014, 35(3):848-856. Zhang Y A, Huang J, Sun Y P.Generalized weighted optimal guidance laws with impact angle constraint[J].Acta Aeronautica et Astronautica Sinica, 2014, 35(3):848-856(in Chinese). |
Cited By in Cnki (9) | |
[6] | 李浩,佘浩平.基于理想视线的弹道成型最优导引律[J].兵工学报, 2014, 35(8):1200-1204. Li H, She H P.Trajectory shaping guidance law based on ideal line-of-sight[J].Acta Armamentarii, 2014, 35(8):1200-1204(in Chinese). |
Cited By in Cnki | |
[7] | Indig N, Ben-Asher J Z, Farber N.Near-optimal spatial midcourse guidance law with an angular constraint[J].Journal of Guidance, Control, and Dynamics, 2014, 37(1):214-223. |
Click to display the text | |
[8] | 张运喜,孙明玮,陈增强.滑模变结构有限时间收敛制导律[J].控制理论与应用, 2012, 29(11):1413-1418. Zhang Y X, Sun M W, Chen Z Q.Sliding-mode variable structure finite-time convergence guidance law[J].Control Theory & Applications, 2012, 29(11):1413-1418(in Chinese). |
Cited By in Cnki (3) | |
[9] | Zhou D, Sun S, Teo K L.Guidance laws with finite time convergence[J].Journal of Guidance, Control, and Dynamics, 2009, 32(6):1838-1846. |
Click to display the text | |
[10] | Rao S, Ghose D.Terminal impact angle constrained guidance laws using variable structure systems theory[J].IEEE Transactions on Control Systems Technology, 2013, 21(6):2350-2359. |
Click to display the text | |
[11] | Ran M P, Wang Q, Hou D L, et al.Backstepping design of missile guidance and control based on adaptive fuzzy sliding mode control[J].Chinese Journal of Aeronautics, 2014, 27(3):634-642. |
Click to display the text | |
[12] | 舒燕军,唐硕.轨控式复合控制导弹制导与控制一体化反步设计[J].宇航学报, 2013, 34(1):79-85. Shu Y Y, Tang S.Integrated guidance and control backstepping design for blended control missile based on NDO[J].Journal of Astronautics, 2013, 34(1):79-85(in Chinese). |
Cited By in Cnki (9) | |
[13] | 刁兆师,单家元.考虑自动驾驶仪动态特性的含攻击角约束的反演递推制导律[J].宇航学报, 2014, 35(7):818-826. Diao Z S, Shan J Y.Back-stepping guidance law with autopilot lag for attack angle constrained trajectories[J].Journal of Astronautics, 2014, 35(7):818-826(in Chinese). |
Cited By in Cnki (1) | |
[14] | Qu P P, Zhou D.A dimension reduction observer-based guidance law accounting for dynamics of missile autopilot[J].Proceedings of the Institution of Mechanical Engineers, Part G:Journal of Aerospace Engineering, 2013, 227(7):1114-1121. |
Click to display the text | |
[15] | Zhou D, Qu P P, Sun S.A guidance law with terminal impact angle constraint accounting for missile autopilot[J].Journal of Dynamic Systems, Measurement, and Control, 2013, 135(5):51009. |
Click to display the text | |
[16] | Zarchan P.Representation of realistic evasive maneuvers by use of shaping filters[J].Journal of Guidance, Control, and Dynamics, 1979, 10(4):434-439. |
Click to display the text | |
[17] | Shima T, Oshman Y, Shinar J.Efficient multiple model adaptive estimation in ballistic missile interception scenarios[J].Journal of Guidance, Control, and Dynamics, 2002, 25(4):667-675. |
Click to display the text | |
[18] | Zhu Z, Xu D, Liu J, et al.Missile guidance law based on extended state observer[J].IEEE Transactions on Industrial Electronics, 2013, 60(12):5882-5891. |
Click to display the text | |
[19] | Zhang Z, Li S, Luo S.Terminal guidance laws of missile based on ISMC and NDOB with impact angle constraint[J].Aerospace Science and Technology, 2013, 31(1):30-41. |
Click to display the text | |
[20] | Ratnoo A, Ghose D.Collision-geometry-based pulsed guidance law for exoatmospheric interception[J].Journal of Guidance, Control, and Dynamics, 2009, 32(2):669-675. |
Click to display the text | |
[21] | Bhat S P, Bernstein D S.Finite-time stability of continuous autonomous systems[J].SIAM Journal on Control and Optimization, 2000, 38(3):751-766. |
Click to display the text | |
[22] | Shtessel Y B, Shkolnikov I A, Levant A.Smooth second-order sliding modes:Missile guidance application[J].Automatica, 2007, 43(8):1470-1476. |
Click to display the text | |
[23] | Levant A.Higher-order sliding modes, differentiation and output-feedback control[J].International Journal of Control, 2003, 76(9-10):924-941. |
Click to display the text | |
[24] | Hong Y.Finite-time stabilization and stabilizability of a class of controllable systems[J].Systems & Control Letters, 2002, 46(4):231-236. |
Click to display the text |