变体飞行器制导与控制技术专栏
传统鱼雷导引设计主要是以提前角导引律为主,通过射击三角形的几何关系设计鱼雷航向来达到导引目的。这种导引设计方法的命中精度在很大程度上依赖于目标信息测量参数的准确性,而且需要舰船处于合理攻击方位,在战机稍纵即逝的战场环境中,存在很大局限性和被动性。在攻击水面舰艇和潜艇时,需要对目标进行垂直命中攻击,这样可以造成敌舰最大程度的损毁。从国内外收集的文献可知,国内外鱼雷在垂直命中领域基本还是采用射击三角形的原理设计鱼雷的航向角,以达到垂直命中的目的,这种方法过于依赖目标信息参数测量的准确性,可以说是失之毫厘谬以千里,而且还是在目标不作机动的情况下才有效,当目标作机动时,连命中都成问题,更谈不上垂直命中。文献[1]应用变结构控制理论设计了反鱼雷鱼雷水平面拦截导引律。文献[2-3]应用变结构控制理论设计了机动目标拦截的变结构制导律,文中弹目相对运动关系是建立在弹目加速度基础上的,而鱼雷很难进行加速度的精确控制。文献[4]设计了无人机垂直命中导引律。论文针对传统鱼雷导引律不能垂直命中的问题,提出了基于变结构控制的鱼雷垂直命中导引方法,根据鱼雷与目标舰船运动关系模型,推导了鱼雷与目标舰船视线角状态方程,应用变结构控制理论设计控制器,使得鱼雷与目标舰船视线和目标舰船航向之间的夹角控制在45°角,以确保鱼雷垂直命中目标舰船。由于控制器采用变结构控制进行设计的,对目标参数信息测量误差和目标机动具有强鲁棒性,确保鱼雷稳定地以垂直命中的方式攻击目标舰船,而不受目标信息测量误差影响,并能够准确命中非机动目标和机动目标。
在平面内,鱼雷-目标舰船相对运动关系如图1 所示。由图1可以导出如下关系式[5-6]:
(1)
式中: R为鱼雷与目标舰船之间的相对距离;为R相对时间的导数;Vt和Vm分别为目标速率和鱼雷速率;qz为视线角,为qz相对时间的导数;φzt和φzm分别为目标舰船和鱼雷的速度方向角。
图1 鱼雷-目标舰船相对运动关系曲线
Fig.1 Torpedo-target warship relative motion geometry
为便于推导,令把它们代入式(1)后对式(1)对时间求一阶导数,得到
(2)
(3)
令:
(4)
(5)
(6)
(7)
把式(4)~式(7)代入式(2)和式(3),并注意到式(1),得到
(8)
(9)
把代入式(9),得到
(10)
式(10)即为鱼雷与目标相对运动时视线角变化的数学模型。
本文的导引律设计以鱼雷与目标舰船相对运动时视线角变化的数学模型,即式(10)为基础,取uqz为控制量,通过设计uqz,使得视线角qz趋于零。取则式(10)可用如下状态方程描述[6]:
(11)
式中: uqz为控制量; wqz为干扰量。
基于导引律的控制目的,选取切换平面为
s=c·(x1-(φzt(0)-π/4-π)+x2
(12)
其中:c为正常数; φzt(0)为目标舰船初始航向角。由于c>0,显然在滑模面s=0上,视线角是稳定地趋于φzt(0)-π/4-π的,即系统是自稳定的[7],由此可以保证视线角与目标舰船航向成45°夹角,当鱼雷与目标舰船航速相当时,鱼雷与目标舰船成垂直角度相遇;当鱼雷与目标舰船航速相差较大时,根据射击三角形关系,可以适当调整视线与目标舰船航向夹角,以保证鱼雷垂直命中目标舰船。
取Lyapunov函数V=s2/2,将V相对于时间微分得到:
(13)
设计控制器:
(14)
其中,ε为大于零的常数。
将式(14)代入式(13)得:
(15)
因式(15)中第一项小于零,第二项只要满足ε>|wq|也小于零,所以有即有s→0。所以控制器时,能够使s→0,其中项是滑模可达条件,εsgn(s)项使系统具备强鲁棒性[8-9]。
因为有将代入即得:
(16)
由式(16)可以求得鱼雷航向角,由于sgn(s)存在抖振,无法由航向角φzm的变化来获取sgn(s),所以以(其中δ为极小正常数)来替代sgn(s),以消除变结构控制的固有抖振,由Lyapunov稳定性理论可以证明采用替代sgn(s)后的控制器能够将视线角与目标航向夹角控制在45°角度附近一个很小的邻域内[10-11]。至此,鱼雷垂直命中导引律设计完成。
在上述设计的变结构控制导引律下,可以推导鱼雷命中目标舰船的弹道模型,由前面导引律模型和鱼雷与目标运动关系,可以建立鱼雷攻击目标舰船的垂直命中弹道的计算模型:
(17)
式(17)中参数在前面均有说明。
式(17)中有7个未知数,7个方程,存在唯一解,根据求解得到的鱼雷航向角φm和目标的航向角φt,可以绘出鱼雷攻击目标舰船的弹道轨迹。
仿真中假设鱼雷和目标舰船航速恒定,分别为20 m/s、20 m/s,初始视线角x1(0)=π/4,初始距离R=500 m,鱼雷初始航向角φm(0)=π/4,目标舰船初始航向角φt(0)=π,并取c=2。
根据以上初始条件,采用龙哥库塔法对式(17)求数字解,仿真步长取ts=0.001 s,仿真时间取T=25 s仿真结果如下:
1) 目标舰船不作机动,且航向角为φt(0)=3π/2,鱼雷初始航向角为φm(0)=π/2。
图2—图6是由方程组(17)求数字解得到的结果,图7是根据求得的鱼雷与目标航向角,在已知速率的情况下,绘制根据鱼雷和目标舰船运动轨迹得到的弹道曲线。由图2可见,鱼雷与目标舰船的视线角在控制器uqz作用下过渡到0.785角度并保持不变,此时鱼雷航向与目标舰船航向保持垂直,由图7可见,鱼雷垂直命中目标舰船。控制量uqz曲线光滑,在工程上有利于实现。
图2 鱼雷与目标舰船视线角曲线
Fig.2 Line-of-sight angle between torpedo and target
图3 鱼雷与目标舰船视线角速度曲线
Fig.3 Line-of-sight angle rate between torpedo and target
图4 鱼雷航向角曲线
Fig.4 Heading angle rate of torpedo
图5 鱼雷与目标距离曲线
Fig.5 Distance between torpedo and target
图6 控制量uqz曲线
Fig.6 Waveform of controller uqz
图7 鱼雷攻击目标舰船弹道曲线
Fig.7 Trajectory of torpedo intercepting target warship
2) 目标舰船不作机动,且航向角为φt(0)=3π/2,鱼雷初始航向角为φm(0)=π/4。
图8—图12为方程组(17)求数字解得到的结果,其中图8表明,鱼雷与目标舰船的视线角在控制器uqz作用下过渡到0.785 4角度并保持不变,此时鱼雷与目标舰船航向保持垂直,由图13可见,鱼雷垂直碰撞目标舰船。
图8 鱼雷与目标舰船视线角曲线
Fig.8 Line-of-sight angle between torpedo and target shipwarship
图9 鱼雷与目标舰船视线角速度曲线
Fig.9 Line-of-sight angle rate between torpedo and target
图10 鱼雷航向角曲线
Fig.10 Heading angle rate of torpedo
图11 鱼雷与目标距离曲线
Fig.11 Distance between torpedo and target
图12 控制量uqz曲线
Fig.12 Waveform of controller uqz
图13 鱼雷攻击目标舰船弹道曲线
Fig.13 Trajectory of torpedo intercepting target warship
3) 目标舰船航向角为φt(0)=3π/2-π/10,鱼雷初始航向角为φm(0)=π/2。
图14—图18为方程组(17)求数字解得到的结果,其中图14表明,鱼雷与目标舰船的视线角在控制器作用下过渡到0.471角度,图19是根据求得的鱼雷与目标航向角绘制的鱼雷和目标舰船运动轨迹,由图19可见,鱼雷在控制器uqz作用下迅速而平滑地调整航向角,并稳定地以垂直方式直接命中目标舰船。
从仿真结果可以看出,在控制器的作用下,鱼雷与目标舰船视线角过渡到稳定值,并保持不变,从鱼雷攻击目标舰船弹道可以看出,鱼雷以垂直命中角度直接碰撞目标舰船,验证了本文所设计的鱼雷垂直命中导引律。
图14 鱼雷与目标视线角曲线
Fig.14 Line-of-sight angle between torpedo and target ship
图15 鱼雷与目标视线角速度曲线
Fig.15 Line-of-sight angle rate between torpedo and target
图16 鱼雷航向角曲线
Fig.16 Heading angle rate of torpedo
图17 控制量uqz曲线
Fig.17 Waveform of controller uqz
图18 鱼雷与目标距离曲线
Fig.18 Distance between torpedo and target
图19 鱼雷攻击目标舰船弹道曲线
Fig.19 Trajectory of torpedo intercepting target warship
1) 鱼雷与目标舰船之间的视线角能够稳定控制在指定角度,确保鱼雷以垂直命中方式直接碰撞目标舰船。
2) 本文采用变结构控制器,具有强鲁棒性,能够对控制器参数测量误差进行抑制,在工程上具备很强的可实现性。
[1] 刘宇.基于变结构控制的反鱼雷武器导引律[J].火力与指挥控制,2010(10):87-90.
Liu Y.Anti-torpedo weapon guidance law based on variable structure control[J].Fire Control & Command Control,2010,25(10):87-90.
[2] Jinraj V Pushpangathan,Harikumar Kandath,Ajithkumar Balakrishnan.Hit-to-kill accurate minimum time continuous second-order sliding mode guidance for worst-case target maneuvers[J].Proceedings of the Institution of Mechanical Engineers,2021,235(07):729-744.
[3] Chen Zhongyuan,Chen Wanchun,Liu Xiaoming,et al.Three-dimensional fixed-time robust cooperative guidance law for simultaneous attack with impact angle constraint[J].Aerospace Science and Technology,2021,110(05):106523.1-106523.16.
[4] 翁兴伟,黄长强,刘子阳.无人攻击机垂直命中目标的末制导律研究[J].兵工学报,2008,29(02):184-187.
Weng X W,Huang C Q,Liu Z Y.Study on the terminal guidance law of hitting the target vertically for UCAV[J].ACTA ArmamentarⅡ,2008,29(02):184-187.
[5] Kim Boseok,Kim Young-Won,Cho Namhoon,et al.Collision-geometry-based optimal guidance for high-speed target[J].Aerospace Science and Technology,2021,115(07):106766.1-106766.15.
[6] Cheng Zhongtao,Wu Hao,Wang Bo,et al.Fixed-time convergent guidance law with impact angle control[J].Complexity,2020,56(06):134-143.
[7] 马克茂,马杰.机动目标拦截的变结构制导律设计与实现[J].宇航学报,2010,31(06):1589-1594.
Ma K M,Ma J.Design and implementation of variable structure guidance law for maneuvering target interception[J].Journal of Astronautics,2010,31(06):1589-1594.
[8] 高为炳.变结构控制理论基础[M].北京:中国科学技术出版社,1990.
Gao W B.Theory of variable structure control[M].Beijing:China Science Press,1990.
[9] 高磊,徐德民,任章.被动式鱼雷的自适应变结构制导律设计[J].兵工学报,2001(05):280-283.
Gao L,Xu D M,Ren Z.Adaptive variable structure guidance law for passive torpedo[J].Acta ArmamentarⅡ,2001,19(05):280-283.
[10] 丁浩,由文立,腾达.一种新型鱼雷非线性变结构导引律设计[J].鱼雷技术,2011,19(01):35-38.
Ding H,You W I,Teng D.A new nonlinear variable structure guidance law for torpedo[J].Torpedo Technology,2011,19(01):35-38.
[11] Kuo T C,Huang Y J,Chang S H.Sliding mode control with self-tuning law for uncertain nonlinear systems[J].ISA Trans,2008,47(02):171-178.
[12] Li X Q,Decarlo R A.Robust sliding mode of uncertain time-delay systems[J].Int J of Control,2003,76(13):1296-1305.
[13] Huang Y J,Kuo T C.Robust output tracking control for nonlinear time-varying robotic manipulators[J].Electrical Engineering,2005,87(01):47-55.
[14] Lee H,Kim E,Kang H J,et al.A new sliding-mode control with fuzzy boundary layer[J].Fuzzy Sets and Systems,2001,120(01):135-143.
Citation format:ZHANG Xiyong.Design of torpedo vertical hitting guidance law based on variable structure[J].Journal of Ordnance Equipment Engineering,2022,43(10):66-71.