舰载机着舰下滑道随航母运动而时刻变化, 为确保舰载机着舰过程中精确地跟踪下滑轨迹, 需要设计鲁棒性强, 准确度高及跟踪快速的控制方法。通常将着舰过程抽象为路径跟踪问题, 即控制舰载机以给定速度在期望路径上运动[2]。经典路径跟踪控制方法包括L1跟踪法[3]、追踪法[4]、向量场跟踪法[5]以及视线(LOS)制导方法[6]等。国内****在该方向也取得不少成果。李英杰等[7]提出基于线性矩阵不等式的舰载机纵向着舰H∞控制, 实验表明具有良好的高度跟踪能力, 着舰跟踪精度较高。邵敏敏等[8]提出基于H2预见控制的舰载机自动着舰控制方法, 该方法不仅可以很好地抑制舰尾流的扰动, 还能更好的跟踪着舰, 优化控制过程。甄子洋等[9]提出无人机自动撞网着舰轨迹自适应跟踪控制, 适用于模型参数未知的实用系统, 具有较强的鲁棒性能。2018年, 甄子洋等[10]提出了基于H2预见控制设计的IGC控制器, 用来保证跟踪性能, 同时提出粒子滤波法用来预测和补偿甲板运动, 仿真结果表明, 在甲板运动以及舰尾流的扰动下, 具有良好的跟踪性能。2020年, 甄子洋等[11]提出自适应Super-Twisting控制, 该方法可以有效解决一类高阶非线性系统的不确定性跟踪控制问题, 具有良好的着舰性能。上述控制器均采用以舰载机进场初始条件为基础, 预先设定下滑道。初始条件包含初始高度、舰载机与航母之间初始相对速度、初始下滑角等。但是舰载机着舰需要跟踪时变移动路径, 仅以初始条件为依据, 会产生较大跟踪误差。
针对这一问题, 近年提出一种考虑路径运动问题的移动路径跟踪(Moving Path Following, MPF)控制方法。MPF可实现时变光滑曲线路径跟踪, 使控制目标平滑收敛到所需路径上。文献[12]把MPF方法应用到机器人控制中, 通过在Serret-Frenet坐标系中推导新的误差方程来研究MPF问题。文献[13]将MPF方法应用到固定翼无人机中, 使其满足理想的时间和空间约束, 进而收敛到所需路径中。本文通过改进时变向量场方法提出一种新型MPF方法, 在满足假设条件的同时, 可实现全局收敛。将所设计MPF方法应用到着舰控制中, 对舰船的前进运动进行实时补偿, 使舰载机收敛到理想下滑轨道。
本文主要贡献如下:①提出新型MPF方法, 适用于三维时变路径的实时跟踪。②建立舰载机非线性模型, 以反步法[14-16]为框架设计着舰控制器。③针对舰尾流扰动问题, 设计非线性干扰观测器[17-19]对其进行实时估计。全系统稳定性分析和对比仿真验证所提方法满足控制目标且跟踪误差较小。
1 移动路径跟踪设计 定义rlon=[xb, zb]T和rlat=[xb, yb]T分别为被控对象在纵向和横向平面内的位置坐标。期望路径由纵向φlon(rlon, t)=0和横向φlat(rlat, t)=0表示, t为时间变量。横向平面运动如图 1所示, 纵向运动具有相同性质。φlat定义了一系列曲线, 当r1=[x1, y1]时, 有φlat(r1, t)=c1>0, c1为跟踪误差; 同理, 当r2=[x2, y2]时, 有φlat(r2, t)=c2 < 0, c2为跟踪误差; 当被控对象位置r3=[x3, y3]位于期望路径上时满足φlat(r3, t)=0, 此时误差为0。
图 1 期望路径表示与跟踪误差定义 Fig. 1 Definition of desired path and tracking error |
图选项 |
假设1??期望路径φlon:R2→R和φlat:R2→R为光滑C2曲线, 满足:
式中:‖·‖为向量的Euclidean范数或者矩阵的Frobenius范数;
经典向量场路径跟踪控制方法只能跟踪固定路径φlon和φlat, 针对移动路径存在时间约束情况, 闭环系统的性能和稳定性将不能被保证。此时时间变量t在φlon和φlat中不能省略。以横向运动为例, 跟踪路径φlat(rlat, t)在点rlat=[xb, yb]T处的跟踪误差由c表示。定义Lyapunov函数Vlat:
(1) |
对式(1)求导得
(2) |
式中:
设计MPF控制即时变向量场制导律:
(3) |
式中:klat>0为控制参数;
式(3)中:
对比经典向量场制导方法, 本文设计的时变向量场方法增加了
(4) |
式(4)与经典向量场方法具有相似形式。因此, 所设计的时变向量场制导律是解决固定路径跟踪与MPF的通用方法。
设计期望航向角为
(5) |
同理, 设计纵向向量场制导律:
(6) |
式中:klon>0为控制参数; τlon为单位切向量; nlon为单位法向量。设计期望爬升角:
(7) |
式中:χ为航向角。
总结MPF控制方法性能如下。
定理1??若期望路径φlat和φlon满足假设1, 式(3)、式(5)~式(7)所示时变向量场制导律可控制对象渐近收敛到移动路径。
证明??将式(3)代入式(2)得
(8) |
式中:
则式(8)变为
式中:εχ=χ*-χ为航向角跟踪误差。
同理, 设计纵向运动的Lyapunov函数为Vlon=
式中:
若仅考虑制导回路, 即内环控制器实现期望航向角χ*和期望爬升角γ*的快速跟踪且跟踪误差为零, 有
2 着舰控制应用 本节首先引入舰载机动力学模型, 然后将所提出的MPF方法应用到自主着舰控制中。舰载机自主着舰控制器分解为3个部分, 分别为制导控制系统、姿态控制系统和进场功率补偿系统, 各部分间通过虚拟控制关联。在反步法中引进虚拟控制的本质是一种静态补偿的思想, 前面的子系统必须通过后面的子系统虚拟控制, 即确定适当的虚拟反馈, 才能达到镇定的目的。本文要求制导控制系统保证飞机沿着期望的移动路径下滑; 姿态控制系统对舰载机的姿态进行控制; 进场功率补偿系统保证飞机以恒定的迎角下滑。总体设计框架如图 2所示。
图 2 控制系统框架 Fig. 2 Architecture of control system |
图选项 |
2.1 舰载机模型 定义坐标系如下:Ogxgygzg为惯性坐标系; Opxpypzp为航迹坐标系; Obxbybzb为机体坐标系; Osxsyszs为航母坐标系, Op和Ob为舰载机的几何中心, 如图 3所示。
图 3 整体几何框图 Fig. 3 Geometric illustration of frames |
图选项 |
舰载机模型可表示如下[20]:
(9) |
(10) |
(11) |
(12) |
式中:x、y、z为惯性坐标系位置; α、β和μ分别为航迹坐标系中的迎角、侧滑角和速度滚转角; σ为安装角; p、q、r分别为机体坐标系中, 角速度ωx、ωy、ωz在机体坐标系中的投影; Ix、Iy、Iz和Ixz分别为舰载机的惯性矩和惯性积; L、M和N分别为滚转力矩、俯仰力矩和偏航力矩; Y、D和C分别为升力、阻力和侧力; T为推力; m为质量; g为重力加速度; dv、dχ、dγ、dp、dq、dr为舰尾流等引起的外部未知干扰。附录A给出了变量的详细方程。
假设2??未知干扰dv、dχ、dγ、dp、dq、dr及其导数
假设3??舰载机为刚体, 沿平面Obxbzb对称, 忽略舰载机旋转部分影响且假设所有变量有界。
假设4??为避免奇异性, 假设俯迎角θ, 爬升角γ, 侧滑角β有界且满足:
副翼、升降舵和方向舵的动力学模型为
本文采用协调转弯, 期望侧滑角β*=0, 且当β足够小时, 有
(13) |
迎角的导数为
(14) |
式中:Tmax为最大推力。
根据式(9)~式(14), 将舰载机模型整理为如下仿射形式:
式中:x1=[y, z]T; x2=[χ, γ]T; ν=[ν1, ν2]T, [ν1, ν2]T=[sin μ, αcos μ]T为虚拟控制量; x3=[θ, β, μ]T; x4=[p, q, r]T; uact=[δa, δe, δr]T; Q为动压; df=[dχ, dγ]T; dm=[dp, dq, dr]T; dα为外部扰动; 表达式fi、bi(i=1, 2, 3, 4)详细方程见附录B。
2.2 制导控制律 本小节基于第1节MPF方法设计外环制导控制律, 即设计期望爬升角γ*与期望航向角χ*。目前大部分自主着舰论文中着舰轨迹由进场阶段航母与舰载机的初始信息决定。但是实际着舰时(见图 4), 航母运动是时变的。因此根据预先设定的固定下滑道着舰, 可能会产生极大的跟踪误差。采用MPF方法可有效解决期望路径移动问题, 实现对航母前进运动的实时补偿。
图 4 期望路径的几何图示 Fig. 4 Geometric illustration of desired paths |
图选项 |
定义自主着舰下滑期望路径为
(15) |
(16) |
式中:γs为固定路径的理想爬升角; hs为甲板超过海平面的高度; ps和qs分别为甲板在纵向和横向平面的运动; xs为航母惯性坐标系中的位置; θs为中心线与驾驶舱间的角度。
基于时变向量场的MPF控制方法, 由式(3)、式(6)设计期望速度:
由式(5)和式(7)设计期望爬升角和航向角为
定义制导回路Lyapunov函数V1=
(17) |
由期望路径式(15)和式(16)可知, ‖nlon‖=
(18) |
式(18)将在后续稳定性证明中用到。
注1??若不采用本文MPF设计方式, 即基于传统固定路径方式设计跟踪控制, 则得如下期望速度形式:
后文仿真中将对2种制导方式的效果进行对比。
2.3 姿态控制律 本小节设计内环姿态控制律。控制输入为uact=[δa, δe, δr]T, 包括副翼、升降舵和方向舵的偏角。uact的计算分为3步, 包含航迹控制、角度控制以及角速率控制。
在反步法设计中, 引入指令滤波器解决微分膨胀问题[22]。指令滤波器设计如下:
式中:x*为命令信号; xref=g1和
第1步(航迹控制):为了提供外部未知干扰的估计值并补偿其影响, 设计干扰观测器如下:
(19) |
式中:
又已知θ=γ+α, 则
针对跟踪误差εχ=χ*-χ, 定义Lyapunov函数
(20) |
式中:k2为航迹控制环的控制参数; b21=b2(1, 1), f21=f2(1)。设计航迹环控制器:
(21) |
将式(20)和式(21)代入
式中:
(22) |
式中:
第2步(角度控制):定义ε3=x3*-x3, 取Lyapunov函数
(23) |
对V3求导得
式中:k3∈R3×3为角度控制环的控制参数矩阵; ε4=x4*-x4。定义ζ3=‖b3‖∞,
(24) |
第3步(角速率控制):设计干扰观测器估计外部扰动如下:
(25) |
式中:
取Lyapunov函数
(26) |
式中:k4∈R3×3为角速率控制环的控制参数矩阵。
由
式中:
2.4 进场功率补偿系统 进场功率补偿系统目的是控制油门开度δp使舰载机保持恒定迎角[23-24], 设计干扰观测器:
(27) |
式中:
基于式(14), 取Lyapunov函数
(28) |
式中:εα=α*-α; kα为控制参数。定义估计误差为
2.5 稳定性分析 对整个着舰控制器的性能总结如下。
定理2??假设舰载机满足假设1~4, 按照式(21)、式(23)和式(26)设计控制器, 采用式(19), 式(25)和式(27)进行外部干扰估计, 进场功率补偿系统按照式(28)设计, 则舰载机全部状态有界且收敛至移动路径。
证明??定义完整的Lyapunov函数:
对V求导得
已知εγ=(γ*+α)-(γ+α)=εθ, 则有εμ2+εθ2≤ε3Tε3, 因此
定义
(29) |
对式(29)两边积分可得
由上式可得
????????????????证毕
3 仿真验证 基于F/A-18A舰载机非线性模型[25]对所提基于时变向量场的MPF控制方法进行仿真验证, 并与传统控制方法进行对比分析。舰载机初始参数设置为:纵向初始误差φlon=10 m, 横向初始误差φlat=5 m, 初始速度Vk0=69 m/s, 其他状态初始值为:α0=θ0=6°, χ0=9°, γ0=μ0=β0=0°, p0=q0=r0=0(°)/s, 初始舵偏角δa=δe=δr=0°, 初始推力T=13 kN。选取控制参数:klon=0.5, klat=0.63, k2=0.5, k3={1.5, 0, 0;0, 1.5, 0;0, 0, 1.5}, k4={2, 0, 0;0, 2, 0;0, 0, 2}, kα=5。干扰观测器参数设定为:ldf=diag{5, 10}, ldm=diag{5, 5, 5}, dα=40。指令滤波器参数设定为:ω2=40, ω3=ω4=diag{40, 40, 40}, ξ2=2, ξ3=diag{5, 1, 1}, ξ4=diag{1, 1, 1}。
仿真中, 假设航母斜角甲板与船体轴线夹角θs=9°, 航母前进速度为13.89 m/s。同时考虑了航母甲板运动与舰尾流干扰对着舰的影响。仿真中选取纵向和横向方向的甲板运动表达式为
根据美国军用标准, 舰载机在距离航母800 m时遇到舰尾流影响, 舰尾流在纵向和横向的表达式为
其中:v为横向舰尾流; w为纵向舰尾流; v1和w1为大气紊流; w2为舰尾流稳态分量; w3为舰尾流周期分量; v4和w4为舰尾流随机分量。
非线性干扰观测器对纵向舰尾流与横向舰尾流的估计效果如图 5所示。可知, 非线性干扰观测器可以准确地观测舰尾流幅值, 可将观测结果反馈至控制器中进行补偿, 从而消除外界扰动对控制系统影响, 有效抑制舰尾流干扰。
图 5 非线性干扰观测器对舰尾流的估计 Fig. 5 Nonlinear disturbance observer estimates air wake |
图选项 |
本文方法与传统向量场方法的期望路径跟踪误差如图 6、图 7所示。可知, 在甲板运动与舰尾流的影响下, 所提出移动路径跟踪控制方法可以实现精准的路径跟踪。舰载机期望路径随航母运动而不断运动, 在移动路径跟踪制导律与所设计的姿态控制律作用下, 舰载机可准确跟踪移动路径, 与航母运动啮合, 最终实现着舰。同时, 由于传统方法未考虑期望路径的时变影响, 存在明显的跟踪误差, 对着舰安全造成隐患。
图 6 甲板运动与舰尾流的纵向跟踪误差 Fig. 6 Tracking error in longitudinal plane with deck motion and air wake |
图选项 |
图 7 甲板运动与舰尾流的横向跟踪误差 Fig. 7 Tracking error in latitudinal plane with deck motion and air wake |
图选项 |
图 8为舰载机着舰过程中姿态角的变化曲线, 图 9为副翼、升降舵、方向舵的控制输入。可知, 舰载机通过调整爬升角γ调整纵向轨迹, 通过调整航向角χ与滚转角μ调整侧向轨迹, 着舰过程中, 进场功率补偿系统维持恒定迎角。
图 8 甲板运动与舰尾流的姿态角变化 Fig. 8 Diversification of attitude angle with deck motion and air wake |
图选项 |
图 9 甲板运动与舰尾流的舵面变化 Fig. 9 Diversification of control surface with deck motion and air wake |
图选项 |
4 结论 1) 本文设计基于时变向量场的移动路径跟踪方法以消除目标运动的影响, 并将所提方法应用到自主着舰控制场景中。
2) 着舰控制器基于舰载机非线性模型设计, 综合考虑甲板运动、舰尾流干扰等因素影响, 设计干扰观测器进行实时估计与补偿。
3) 所提非线性控制器与经典着舰控制方法兼容, 可同时满足移动路径和固定路径场景, 具有通用性。
4) 理论分析与数值仿真证明所提控制方案可满足控制目标, 验证其具有良好着舰性能。
未来将在现有设计框架下增加故障因素的补偿设计, 并开展半物理仿真及实际试飞验证。
5 附录A
(A1) |
(A2) |
式中:CY、CD、CC分别表示升力、阻力、侧力系数; CL、CM和CN分别为滚转、俯仰和偏航力矩的系数; l为机翼的跨度; c为平均动力; δa、δe和δr分别为副翼、升降舵和方向舵的偏角; δp为油门杆的位置; Tmax为最大推力; T为当前推力。
6 附录B
(B1) |
(B2) |
(B3) |
(B4) |
(B5) |
(B6) |
(B7) |
(B8) |
(B9) |
(B10) |
(B11) |
(B12) |
参考文献
[1] | 张智, 朱契丹, 张雯. 航母舰载机全自动引导着舰技术[M]. 哈尔滨: 哈尔滨工程大学出版社, 2016: 3-4. ZHANG Z, ZHU Q D, ZHANG W. Aircraft carrier automatic carrier landing technology[M]. Harbin: Harbin Engineering University Press, 2016: 3-4. (in Chinese) |
[2] | 朱丽红.带有时变惯性阵无人艇的路径跟踪[D].哈尔滨: 哈尔滨工程大学, 2018: 4-6. ZHU L H.Path following with time-varying inertial array unmanned boat[M].Harbin: Harbin Engineering University, 2018: 4-6(in Chinese). |
[3] | PARK S, DEYST J, HOW J.A new nonlinear guidance logic for trajectory tracking: AIAA-2004-4900[R].Reston: AIAA, 2004. |
[4] | SAFWAT E, ZHANG W, WU M, et al.Robust path following controller for unmanned aerial vehicle based on carrot chasing guidance law using dynamic inversion[C]//The 18th International Conference on Control, Automation and System.Piscataway: IEEE Press, 2018: 1444-1450. |
[5] | 马振宇, 祝小平, 周洲, 等. 全翼布局无人机滑跑轨迹跟踪方法对比与试验[J]. 飞行力学, 2019, 37(6): 72-78. MA Z Y, ZHU X P, ZHOU Z, et al. Comparison and test of running path following methods for full-wing UAV[J]. Flight Dynamics, 2019, 37(6): 72-78. (in Chinese) |
[6] | ZHENG Z W, SUN L, XIE L H. Error-constrained LOS path following of a surface vessel with actuator saturation and faults[J]. IEEE Transactions on Systems, Man, and Cybernetics:Systems, 2018, 48(10): 2168-2216. |
[7] | 李英杰, 吴文海, 韩维元. 基于线性矩阵不等式的舰载机纵向着舰H∞控制[J]. 飞行力学, 2005, 23(3): 48-51. LI Y J, WU W H, HAN W Y. H∞ control of the longitudinal carrier landing system for carrier aircraft based on LMI[J]. Flight Dynamics, 2005, 23(3): 48-51. DOI:10.3969/j.issn.1002-0853.2005.03.013 (in Chinese) |
[8] | 邵敏敏, 龚华军, 甄子洋, 等. 基于H2预见控制的舰载机自动着舰控制方法[J]. 电光与控制, 2015, 22(9): 68-71. SHAO M M, GONG H J, ZHEN Z Y, et al. An H2 preview based antomatic landing control method for carrier based aircraft[J]. Electronics Optics & Control, 2015, 22(9): 68-71. (in Chinese) |
[9] | 甄子洋, 陶钢, 江驹, 等. 无人机自动撞网着舰轨迹自适应跟踪控制[J]. 哈尔滨工程大学学报, 2017, 38(12): 1922-1927. ZHEN Z Y, TAO G, JIANG J, et al. Adaptive tracking control of automatic net landing trajectory for carrier-based unmanned aerial vehicle[J]. Jouurnal of Harbin Engineering University, 2017, 38(12): 1922-1927. (in Chinese) |
[10] | ZHEN Z Y, JIANG S Y, JIANG J. Preview control and particle filtering for automatic carrier landing[J]. IEEE Transactions on Aerospace and Electronic Systems, 2018, 54(6): 2662-2674. DOI:10.1109/TAES.2018.2826398 |
[11] | ZHEN Z Y, YU C J, JIANG S J, et al. Adaptive Super-Twisting control for automatic carrier landing of aircraft[J]. IEEE Transactions on Aerospace and Electronic Systems, 2020, 56(2): 984-997. DOI:10.1109/TAES.2019.2924134 |
[12] | YURI A K, DEHECTOR G M, ANTON V P, et al. Guiding vector field algorithm for a moving path following problem[J]. IFAC PapersOnLine, 2017, 50(1): 6983-6988. DOI:10.1016/j.ifacol.2017.08.1340 |
[13] | WANG Y Z, WANG D W, ZHU S Q. Cooperative moving path following for multiple fixed-wing unmanned aerial vehicles with speed constraints[J]. Automatica, 2019, 100: 82-89. DOI:10.1016/j.automatica.2018.11.004 |
[14] | OLIVEIRA T, AGUIAR A P, ENCARNACAO P. Moving path following for unmanned aerial vehicles with applications to single and multiple target tracking problems[J]. IEEE Transactions on Robotics, 2016, 32(5): 1062-1078. DOI:10.1109/TRO.2016.2593044 |
[15] | 张超, 张胜修, 刘毅男, 等. 约束自适应反步法及其在飞行控制中的应用[J]. 控制工程, 2014, 21(3): 430-435. ZHANG C, ZHANG S X, LIU Y N, et al. Constrained adaptive backstepping with application to flight control[J]. Control Engineering of China, 2014, 21(3): 430-435. DOI:10.3969/j.issn.1671-7848.2014.03.027 (in Chinese) |
[16] | 吴文海, 张杨, 胡云安, 等. 舰载机着舰非线性反演控制方法研究进展[J]. 系统工程与电子技术, 2018, 40(7): 1578-1587. WU W H, ZHANG Y, HU Y A, et al. Research development in nonlinear backstepping control method of carrier-based aircraft landing[J]. Systems Engineering and Electronics, 2018, 40(7): 1578-1587. (in Chinese) |
[17] | AN H, LIU J, WANG C, et al. Approximate backstepping fault-tolerant control of the flexible air-breathing hypersonic vehicle[J]. IEEE/ASME Transactions Mechatronics, 2016, 21(3): 1680-1691. DOI:10.1109/TMECH.2015.2507186 |
[18] | 杨晓骞.不确定条件下高超声速飞行器轨迹优化与控制方法研究[D].长沙: 国防科学技术大学, 2016: 58-59. YANG X Q.Research on trajectory optimization and control approach for hypersonic vehicle under uncertainty[D].Changsha: National University of Defense Technology, 2016: 58-59(in Chinese). |
[19] | XIANG W B, XIAO Y W, RUI Z, et al. Tracking differentiator design for the robust backstepping control of a flexible air-breathing hypersonic vehicle[J]. Journal of the Franklin Institute, 2015, 352(4): 1739-1765. DOI:10.1016/j.jfranklin.2015.01.014 |
[20] | ADAMS R J, BUFFINGTON J M, BANDA S S. Design of nonlinear control laws for high-angle-of-attack flight[J]. Journal of Guidance, Control, and Dynamics, 2012, 17(4): 737-746. |
[21] | CHAKRABORY A, SEILER P, BALAS G J. Susceptibility of F/A-18 flight controllers to the falling-leaf mode:Linear analysis[J]. Journal of Guidance, Control, and Dynamics, 2011, 34(1): 73-85. DOI:10.2514/1.50675 |
[22] | 徐倩, 王肖, 吴洁, 等. 基于扩张状态观测器和指令滤波器的导弹姿态控制[J]. 飞行力学, 2018, 36(1): 52-55. XV Q, WANG X, WU J, et al. Attitude control of missile based on extended state observer and command filter[J]. Flight Dynamics, 2018, 36(1): 52-55. (in Chinese) |
[23] | 甄子洋, 王新华, 江驹, 等. 舰载机自动着舰引导与控制研究进展[J]. 航空学报, 2017, 38(2): 127-148. ZHEN Z Y, WANG X H, JIANG J, et al. Research progress in guidance and control of automatic carrier landing of carrier-based aircraft[J]. Acta Aeronautica et Astronautica Sinica, 2017, 38(2): 127-148. (in Chinese) |
[24] | 张志冰, 甄子洋, 江驹, 等. 舰载机自动着舰引导与控制综述[J]. 南京航空航天大学学报, 2018, 50(6): 734-744. ZHANG Z B, ZHEN Z Y, JIANG J, et al. Review on development in guidance and control of automatic carrier landing of carrier-based aircraft[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2018, 50(6): 734-744. (in Chinese) |
[25] | NAPOLITANO M, PARIS A, SEANOR B, et al.Estimation of the longitudinal aerodynamic parameters from flight data for the NASA F/A-18 HARV[C].Proceedings of the 21st Atmospheric Flight Mechanics Conference, 2013: 469-478. |