基于序列凸规划的拦截弹中制导轨迹优化

引用格式：李炯，张锦林，邵雷，等.基于序列凸规划的拦截弹中制导轨迹优化［J］.航空兵器，2023，30（1）：37-43.

LiJiong，ZhangJinlin，ShaoLei，etal.MidcourseGuidanceTrajectoryOptimizationofInterceptorMissileBasedonSequentialConvexProgramming［J］.AeroWeaponry，2023，30（1）：37-43.（inChinese）

摘要：针对强非线性多约束条件下拦截弹中制导轨迹优化问题，基于序列凸规划方法和捕获区域，提出一种针对固定时间约束下的轨迹优化算法。序列凸优化方法求解复杂多项式具有高效的计算效率，但在轨迹优化问题中应用序列凸规划有控制变量的强非线性和固定时间内终端约束难以收敛两大难点。首先，采用仿射变量将问题转化为仿射系统，并将仿射系统进行凸化与离散化，来解决非线性问题，然后，提出一种终端约束加权松弛化方法来解决固定时间内终端约束难以收敛问题，并将中制导问题转化为序列凸规划问题。仿真结果表明，所提算法能较快地生成符合多约束条件的拦截弹中制导轨迹。

关键词：序列凸规划；中制导；轨迹优化；捕获区域；多约束;高超声速;拦截弹

中图分类号：TJ765

文献标识码：A

文章编号：1673-5048（2023）01-0037-07

DOI：10.12132/ISSN.1673-5048.2022.0115

0引言

目前高超声速武器由于速度快、射程远等优势，对空天安全提出巨大的挑战［1-2］。拦截弹的中制导在拦截此类目标时，可以为具有飞行约束的末制导提供良好的拦截态势［3］，具有重要研究意义。

中制导轨迹优化是在拦截弹动力学模型基础上，根据预测的捕获区域，解算满足过程约束和终端约束的制导指令［4-5］。文献［6］考虑拦截弹捕获区，提出一种基于高斯伪谱法的中制导轨迹优化方法，具有很高的精度。文献［7］提出了一种基于邻域最优控制理论的高超声速拦截中弹道在线优化修正算法。文献［8］提出一种终端时间固定的广义拟谱模型预测静态规划方法，成功用于中制导拦截。文献［9］在模型预测静态规划理论的基础上，提出一种多阶段最优轨迹规划与制导方法。虽然模型预测静态规划能应用于中制导，但拦截弹拦截过程中，可能存在超出过程约束的现象。

近年来，凸优化方法因为解的存在性［10］和求解复杂多项式高效的计算效率，在航空航天领域得到了广泛的应用［11］。文献［12］将强非线性的飞行器再入的最优控制问题，转化成凸优化问题。文献［13］结合基于凸优化的算法和伪谱非线性规划方法，构建了一个两阶段轨迹优化框架。文献［14-15］介绍了一种凸化非凸约束的松弛技术，采用正则化技术对松弛程度进行约束。文献［16］结合伪谱方法和凸优化方法，提出一种新的大气再入制导阻力能量方案，能够无损凸化公式。文献［17］将多约束的再入问题表述成一个容易求解的二阶锥规划序列。文献［18］提出一个非常规的收敛条件，使序列凸规划方法以较少的迭代次数收敛到原问题的可行解。文献［19］提出一种基于自定义自适应网格细化的序列凸规划方法，在保证收敛解可行性的同时，可以减少网格点的数量。文献［20］提出一种拉格朗日伪谱凸优化方法，在考虑过程约束的同时，解决火星大气进入末端高度最大化问题。以上文献表明，凸优化方法在解决非线性多约束问题上有很多的应用与优势。

拦截弹中制导拦截问题是强非线性多约束的轨迹优化问题。首先，通过仿射变量将拦截弹的非线性动力学模型，转化为仿射系统动力学模型。其次，以目标的预测点形成的捕获区域为终端约束，并提出终端约束加权松弛化方法解决固定时间中制导终端约束难以收敛问题。然后，以过载、热流密度、动压等作为过程约束，将模型与约束依次松弛化、线性化和离散化，将固定时间的中制导拦截问题转化为序列凸规划问题。最后，通过多种场景对本文算法的有效性与鲁棒性进行了验证。

1中制导问题的建立

1.1仿射动力学模型和控制约束

拦截弹在中段制导阶段采用无动力滑翔，动力学模型建立在地面固定坐标系上［14］，x轴和z轴分别指向东和北，和h轴组成右手系，忽略地球自转影响，拦截弹在平坦的地面上空，动力学模型经无量纲化处理后如下：

x·=Vcosθcosψ

z·=Vcosθsinψ

h·=Vsinθ

V·=－D－sinθ/r2

θ·=Lcosσ/V－cosθ/（Vr2）

ψ·=Lsinσ/（Vcosθ）（1）

式中：（x，z，h）为拦截弹的位置坐标；r=1+h为地心到拦截弹的直线距离；V为地球相对速度，以g0re比例缩放，g0为在地球表面re处的重力加速度；θ为弹道倾角；ψ为弹道偏角。

无量纲阻力和升力加速度如下：

L=0.5ρ（Vg0re）2CLS/（mg0）（2）

D=0.5ρ（Vg0re）2CDS/（mg0）（3）

式中：S为拦截弹受力参考面积；CD和CL为拦截弹的阻力系数和升力系数，与攻角α和马赫数有关；m为拦截弹的质量，大气密度ρ（h）=ρ0e－hre/H，ρ0=1.225kg/m3，H=7.11km。

定义控制变量归一化系数λ：

λ=CL/CL（4）

CD=CD［1+λ2］/2（5）

式中：C*L和C*D分别为某马赫数下最大升阻比对应的升力系数和阻力系统，可通过气动数据表插值得到。

由上式，可将式（2）～（3）转化为

L=L^λ（6）

D=D^［1+λ2］/2（7）

式中：升力加速度L^=qSC*L；阻力加速度D^=qSCD/2。

目前的动力学模型仍不是控制仿射系统，下面构建仿射变量：

u1=λcosσu2=λsinσu3=λ2（8）

通过仿射变量可将式（1）转化为

dx/dt=Vcosθcosψdz/dt=Vcosθsinψdh/dt=VsinθdV/dt=－0.5［1+u3］D^－sinθ/r2

dθ/dt=u1L^/V－cosθ/（Vr2）

dψ/dt=u2L^/（Vcosθ）（9）

在仿射系统中，控制量u必须满足：

u21+u22=u3（10）

本文假设归一化系数λ非负，上限为λ-，则u3的取值范围为

0≤u3≤u-3（11）

式中：u-3=λ-2。假设倾侧角σ的取值范围在区间（－90°，90°）内为［σmin，σmax］，则

u1tan（σmin）≤u2≤u1tan（σmax）（12）

1.2过程约束和边界约束

拦截弹中制导拦截过程中需要满足过程约束，否则可能出现拦截弹失控现象。其中，过程约束主要有过载约束、热流密度约束及动压约束等：

n=L2+D2=u3L^2+（1+u3）2D^2/4≤nmax（13）

Q·=kQρ0.5（Vg0re）3.15≤Q·max（14）

q=0.5ρ（Vg0re）2≤qmax（15）

过程约束可写为

L（h，V，u3）≤L-（16）

式中：L-为拦截弹过程约束允许的最大值。

假设拦截弹中制导的初始状态为x0，初始时刻为t0，则初始条件约束为

x（t0）=x0（17）

拦截弹的终端约束由捕获区域确定，最佳终端条件为零控拦截状态。假设预测的拦截弹中制导结束时的零控拦截状态是xp=［xp;zp;hp;～;θp;ψp］。上述零控拦截状态对拦截弹的速度大小没有要求，但为了有效摧毁目标，拦截弹速度越大越好，速度约束在目标函数中加以体现。

拦截弹中制导结束时刻为tf，则终端约束为

x（tf）=xp（18）

由于拦截弹是在指定时间飞向指定空域，如果终端约束采用式（18）强等式约束，可能会造成可行域内无解的情形。本文提出终端约束加权松弛化方法对强等式约束式（18）进行松弛，以确保问题存在可行解，表达如下：

xf－xp=κ1ω1

zf－zp=κ1ω2

hf－hp=κ1ω3

θf－θp=ω4

ψf－ψp=ω5（19）

式中：松弛系数ω=［ω1，ω2，ω3，ω4，ω5］在目标函数中约束；κ1为权重系数，为状态量的权重接近。

1.3目标函数和中制导问题描述

为了有效摧毁目标，以拦截弹的最大速度为主要目标函数，加上终端约束松弛系数，目标函数为

J0=－c1Vf+c2ωTω（20）

综上所述，原始的拦截弹中制导拦截问题就转化成终端时间固定的最优控制问题P1：

P1：minJ0

s.t.式（9）～（12），（16）～（17），（19）

2凸化与离散化

2.1凸化

问题P1仍是一个非线性强约束问题，需要对仿射变量松弛化和对约束线性化，才能将问题P1转化成凸优化问题P2，之后将问题P2进行离散化，转化成序列凸规划问题P3，以便于算法求解。

2.1.1仿射变量松弛化

从式（10）～（12）可以看出，仿射变量约束为强等式约束，强约束会造成问题P1的非凸，为将问题P1凸化，将式（10）松弛为

u21+u22≤u3（21）

为保证松弛后的仿射变量的有效性，目标函数上增加c3∫tft0ψ（t）dt项，来确保仿射变量满足式（10）约束。

2.1.2约束的线性化

式（9）可以表述为

x·=f（x）+B（x）u（22）

f（x）=VcosθcosψVcosθsinψVsinθ－0.5D^－sinθ/r2cosθ/（Vr2）0（23）

B（x，t）=03×103×103×1

00－0.5D^

L^/V00

0L^/（Vcosθ）0（24）

u=［u1，u2，u3］（25）

利用一阶泰勒展开式对式（20）关于参考轨迹（x*，u*）线性化可得

x·=f（x*）+A（x*）（x－x*）+B（x*）u（26）

式中：A（x*）=f（x）xx=x*。