约束全程满足的高超声速飞行器绕障飞行最优控制系统技术方案

本发明专利技术公开了约束全程满足的高超声速飞行器绕障飞行最优控制系统，用于对飞行器在特定条件下(指定航点、规避禁飞区等)的轨迹进行控制。所述的约束全程满足的高超声速飞行器绕障飞行最优控制系统由飞行器传感器，飞行器绕障飞行控制器，飞行器运动方程、航点和禁飞区等约束条件、目标函数，飞行器倾斜角最优控制策略构成。高超声速飞行器从指定初始位置出发后，飞行器绕障飞行控制器自动执行内部的优化算法，得到使高超声速飞行器在全程满足所有飞行约束条件的前提下，飞行时间最短的轨迹优化倾斜角最优控制策略。本发明专利技术能够根据高超声速飞行器不同的飞行经度、飞行纬度、速度和飞行航向角快速地得到轨迹优化控制策略，使高超声速飞行器获得最短飞行时间。

Optimal control system for obstacle around flight of hypersonic vehicle

【技术实现步骤摘要】
约束全程满足的高超声速飞行器绕障飞行最优控制系统
本专利技术涉及高超声速飞行器绕障飞行轨迹优化领域，尤其涉及约束全程满足的高超声速飞行器绕障飞行最优控制。在高超声速飞行器从指定初始位置出发后能够给出高超声速飞行器轨迹优化控制策略并转换为飞行器倾斜角控制指令，在全程满足所有约束条件的前提下，使高超声速飞行器获得更短的飞行时间。
技术介绍
高超声速飞行器是飞行速度大于5Ma的临近空间飞行器，可以实现全球快速精准打击和到达任务，其相关技术受到了全球军事强国的广泛关注，已经成为了世界航空航天领域一个极其重要的发展方向。高超声速飞行器以其极高的飞行速度和大跨度的飞行距离在军事战略上具有十分重要的意义，并日益受到世界各国的高度重视。在高超声速飞行器的研究中，为了满足特定的包括指定飞行航点(完成军事侦察或空中加油任务)和规避禁飞区(军事敏感地带)等军事要求，大量的国内外学者投身到高超声速飞行器绕障飞行的课题中，研究如何在全程满足所有约束条件的前提下，更快、更准地完成指定飞行任务，进一步提高高超声速飞行器的打击速度和打击精度。因此，高超声速飞行器绕障飞行最优轨迹设计问题越来越受到国内外军事强国的关注，是当前国内外研究的热点和难点。
技术实现思路
为了使高超声速飞行器飞行时间更短，提高高超声速飞行器的打击范围，本专利技术的目的在于提供一种计算速度快、计算效率高、计算精度高，能够全程满足所有约束、实现最优的约束全程满足的高超声速飞行器绕障飞行最优控制系统。高超声速飞行器绕障飞行轨迹优化问题飞行过程可以用数学模型描述为：其中，t表示时间，t0表示高超声速飞行器绕障飞行轨迹优化问题飞行过程起始时间，tf表示高超声速飞行器绕障飞行迹优化问题飞行过程结束时间，且tf不固定；被称为状态向量，依次表示飞行器飞行经度、飞行器飞行纬度、飞行器速度、飞行器飞行航向角等物理参数，nx为状态变量的维度，这里nx＝4。x0是状态向量的初始值，是其一阶导数；u(t)表示高超声速飞行器的倾斜角控制量，为本问题的控制变量，ul、uu分别为其下限值和上限值；是根据能量守恒以及力学原理建立的微分方程组；G[u(t),x(t),t]是高超声速飞行器绕障飞行过程中必须满足的不等式路径约束条件。对于高超声速飞行器绕障飞行过程，使飞行时间最短的数学模型可表示为：该问题本质上是一个最优控制问题。本专利技术解决其技术问题所采用的技术方案是：一种约束全程满足的高超声速飞行器绕障飞行最优控制系统，它由飞行器传感器和飞行器绕障飞行控制器通过数据总线相连构成。所述飞行器绕障飞行控制器由信息采集模块、初始化模块、离散化模块、非线性规划问题求解模块和结果显示模块依次相连组成。所述约束全程满足的高超声速飞行器绕障飞行最优控制系统的运行过程如下：步骤1)：在飞行器绕障飞行控制器中输入对应于该飞行器的运动方程、航点和禁飞区等约束条件、目标函数；步骤2)：高超声速飞行器从指定初始位置出发后，开启飞行器传感器，得到高超声速飞行器当前的飞行经度、飞行纬度、速度和飞行航向角状态信息；步骤3)：飞行器绕障飞行控制器自动执行内部的优化算法，得到使高超声速飞行器在满足所有约束条件下飞行时间最短的轨迹优化控制策略。所述步骤3包括以下子步骤：步骤3.1)：信息采集模块获取步骤2得到的高超声速飞行器当前的飞行经度、飞行纬度、速度、飞行航向角状态信息；以及飞行器的运动方程、飞行航点和禁飞区约束条件、目标函数信息。步骤3.2)：初始化模块开始运行，设置轨迹优化过程时间的离散段数、倾斜角控制量的初始猜测值u(0)(t)，设定优化精度要求tol，将迭代次数k置零；步骤3.3)：通过离散化模块将动态运动方程组在时间轴[t0,tf]上全部离散；步骤3.4)：通过非线性规划问题求解模块获得所需的倾斜角最优控制策略和对应状态轨迹，这个过程包括多次内部迭代，每次迭代都要求解寻优方向和寻优步长，并进行寻优修正。对于某一次迭代得到的倾斜角控制量u(k)(t)，如果其对应目标函数值J[u(k)(t)]与前一次迭代的目标函数值J[u(k-1)(t)]之差小于精度要求tol，则判断收敛性是否满足，若满足则将指令输出到结果显示模块；否则进行下一次迭代。步骤3.5)：结果显示模块显示获得的优化轨迹。所述步骤3.3包括以下子步骤：步骤3.3.1)：将倾斜角控制量u(t)、状态轨迹x(t)用M阶插值公式的线性组合表示，即：其中，N是对时间区间[t0,tf]进行离散的段数，φ(t)表示插值公式，线性组合系数ui,j和si,j分别是u(t)和x(t)在离散点ti,j上的值。步骤3.3.2)：由于所有插值公式的导函数表达式已知，对公式(2)进行求导：步骤3.3.3)：将状态轨迹的微分方程组离散化代数等式形式，将其他目标函数、约束等用ui,j和si,j进行离散表达，得到待求的非线性规划问题如下所示：其中，J为目标函数，X表示离散的状态向量的参数，X0表示每段的初始状态值，U表示离散的控制向量的参数，CE和CI分别表示等式和不等式约束。步骤3.3.4)：将公式(3)写成如下形式：F(X,U,X0)＝0(15)其中，F表示所有等式的集合。对公式(5)进行一阶泰勒展开：步骤3.3.5)：通过公式(6)计算一阶灵敏度信息和步骤3.3.6)：对公式进一步求导，得到二阶灵敏度信息和所述步骤3.4包括以下子步骤：步骤3.4.1)：将倾斜角控制量u(k-1)(t)作为向量空间中的某个点，记作P1，P1对应的目标函数值就是J[u(k-1)(t)]；步骤3.4.2)：从点P1出发，根据选用的非线性规划问题算法，构造向量空间中的一个寻优方向向d(k-1)和步长α(k-1)；步骤3.4.3)：通过式u(k)(t)＝u(k-1)(t)+α(k-1)d(k-1)构造向量空间中对应u(k)的另外一个点P2，使得P2对应的目标函数值J[u(k)(t)]比J[u(k-1)(t)]更优；步骤3.4.4)：采用寻优校正u(k)(t)，得到校正后的点记为点P3，同时令使得P3对应的目标函数值J[u(k)(t)]比J[u(k-1)(t)]更优；步骤3.4.5)：如果本次迭代的目标函数值J[u(k)(t)]与上一次迭代的目标函数值J[u(k-1)(t)]的绝对值之差小于精度tol，则判断收敛性满足，将本次迭代得到的控制策略u(k)(t)输出至结果显示模块；如果收敛性不满足，迭代次数k增加1，将u(k)(t)设置为初始值，继续执行步骤3.4.2)。步骤3.4.6)：显示获得的高超声速飞行器最短飞行时间控制策略和最优轨迹。本专利技术的有益效果主要表现在：目前高超声速飞行器在面临航点和禁飞区等复杂约束条件时存在约束条件不能完全满足的问题，这会导致飞行器飞行任务的失败乃至机毁人亡的悲剧，本文档来自技高网...

【技术保护点】
1.一种约束全程满足的高超声速飞行器绕障飞行最优控制系统，其特征在于，它由飞行器传感器和飞行器绕障飞行控制器通过数据总线相连构成。所述飞行器绕障飞行控制器由信息采集模块、初始化模块、离散化模块、非线性规划问题求解模块和结果显示模块依次相连组成。/n所述约束全程满足的高超声速飞行器绕障飞行最优控制系统的运行过程如下：/n步骤1)：在飞行器绕障飞行控制器中输入对应于该飞行器的运动方程、航点和禁飞区等约束条件、目标函数；/n步骤2)：高超声速飞行器从指定初始位置出发后，开启飞行器传感器，得到高超声速飞行器当前的飞行经度、飞行纬度、速度和飞行航向角状态信息；/n步骤3)：飞行器绕障飞行控制器自动执行内部的优化算法，得到使高超声速飞行器在满足所有约束条件下飞行时间最短的轨迹优化控制策略。/n所述步骤3包括以下子步骤：/n步骤3.1)：信息采集模块获取步骤2得到的高超声速飞行器当前的飞行经度、飞行纬度、速度、飞行航向角状态信息；以及飞行器的运动方程、飞行航点和禁飞区约束条件、目标函数信息。/n步骤3.2)：初始化模块开始运行，设置轨迹优化过程时间的离散段数、倾斜角控制量的初始猜测值u

【技术特征摘要】
1.一种约束全程满足的高超声速飞行器绕障飞行最优控制系统，其特征在于，它由飞行器传感器和飞行器绕障飞行控制器通过数据总线相连构成。所述飞行器绕障飞行控制器由信息采集模块、初始化模块、离散化模块、非线性规划问题求解模块和结果显示模块依次相连组成。
所述约束全程满足的高超声速飞行器绕障飞行最优控制系统的运行过程如下：
步骤1)：在飞行器绕障飞行控制器中输入对应于该飞行器的运动方程、航点和禁飞区等约束条件、目标函数；
步骤2)：高超声速飞行器从指定初始位置出发后，开启飞行器传感器，得到高超声速飞行器当前的飞行经度、飞行纬度、速度和飞行航向角状态信息；
步骤3)：飞行器绕障飞行控制器自动执行内部的优化算法，得到使高超声速飞行器在满足所有约束条件下飞行时间最短的轨迹优化控制策略。
所述步骤3包括以下子步骤：
步骤3.1)：信息采集模块获取步骤2得到的高超声速飞行器当前的飞行经度、飞行纬度、速度、飞行航向角状态信息；以及飞行器的运动方程、飞行航点和禁飞区约束条件、目标函数信息。
步骤3.2)：初始化模块开始运行，设置轨迹优化过程时间的离散段数、倾斜角控制量的初始猜测值u(0)(t)，设定优化精度要求tol，将迭代次数k置零；
步骤3.3)：通过离散化模块将动态运动方程组在时间轴[t0,tf]上全部离散；
步骤3.4)：通过非线性规划问题求解模块获得所需的倾斜角最优控制策略和对应状态轨迹，这个过程包括多次内部迭代，每次迭代都要求解寻优方向和寻优步长，并进行寻优修正。对于某一次迭代得到的倾斜角控制量u(k)(t)，如果其对应目标函数值J[u(k)(t)]与前一次迭代的目标函数值J[u(k-1)(t)]之差小于精度要求tol，则判断收敛性是否满足，若满足则将指令输出到结果显示模块；否则进行下一次迭代。
步骤3.5)：结果显示模块显示获得的优化轨迹。
所述步骤3.3包括以下子步骤：
步骤3.3.1)：将倾斜角控制量u(t)、状态轨迹x(t)用M阶插值公式的线性组合表示，即：






其中，N是对时间区间[t0,tf]进行离散的段数，φ(t)表示插值公式，线性组合系数ui,j和si,j分...

【专利技术属性】
技术研发人员：吕露，马卫华，张志猛，叶松，张泽银，郑总准，刘兴高，
申请(专利权)人：浙江大学，
类型：发明
国别省市：浙江;33