一种微气象扰动下异构航空器冲突鲁棒解算方法、装置、设备及介质与流程
本发明涉及无人机领域,具体涉及一种微气象扰动下异构航空器冲突鲁棒解算方法、装置、设备及介质。
背景技术:
1、由于建筑物对气流的阻挡与加速,极易在楼宇间形成狭管效应、穿堂风等强扰动的“微气象”环境。在这种高度受限且存在瞬态气流扰动的空域中,当两架航空器发生航线交汇或突发冲突时,如何实现高安全、高实时的近场避让与局部轨迹重规划,成为了当前低空交通管理系统的核心技术瓶颈。
2、现有针对两架航空器突发冲突的实时解算与局部轨迹重规划方法,存在避让算法过度依赖确定性的环境先验数据,难以应对无法精确获取的微气象扰动:现有的局部轨迹重规划算法若要实现抗风偏,必须要求系统输入高精度的实时三维风场数据。然而在实际城市低空运行中,获取毫秒级延迟的微气象数据工程落地极其困难。若直接忽略这些无法精确测量的风场扰动,航空器在执行避让机动时极易产生不可控的航迹漂移,导致规划的安全间距被突破,引发二次碰撞风险。
技术实现思路
1、本发明目的在于提供一种微气象扰动下异构航空器冲突鲁棒解算方法、装置、设备及介质,解决了现有技术中的问题。
2、本发明通过下述技术方案实现:
3、第一方面,本发明实施例提供了一种微气象扰动下异构航空器冲突鲁棒解算方法,包括:
4、根据进入潜在冲突区域的两架航空器的实时运动状态、实时剩余电量及物理运动极限,分别构建各航空器的控制量约束集合;
5、根据所述实时运动状态、所述控制量约束集合及根据预设的风场扰动边界建立的有界扰动集合,建立各航空器的离散运动学模型;
6、针对每个航空器,根据所述航空器的离散运动学模型和引入的满足无扰动标称模型的标称状态和标称控制量进行求解,得到所述航空器的航迹管;
7、根据各航空器的航迹管构建的约束条件和代价函数进行求解,得到各航空器的最优标称控制序列,所述代价函数根据各航空器的标称状态与预设参考轨迹之间的偏差、所述标称控制量与预设参考控制量之间的偏差、以及与所述实时剩余电量负相关的能耗惩罚项构建得到;
8、根据各航空器的最优标称控制序列中的首项叠加反馈控制律后得到实际控制指令输出。
9、优选地,所述根据所述实时运动状态、所述控制量约束集合及根据预设的风场扰动边界建立的有界扰动集合,建立各航空器的离散运动学模型,包括:
10、定义有界扰动集合为:
11、,
12、其中,为根据历史气象数据或高楼峡谷风切变经验值设定的最大风偏扰动边界;
13、根据各航空器的实时运动状态中的实时位置和实时速度定义状态向量:
14、;
15、其中,为第架航空器的三维位置坐标,为第架航空器的三维速度分量,为连续时间;
16、根据所述状态向量、所述控制量及预设的风场扰动,建立连续非线性运动学方程,其中,为第架航空器的非线性运动学函数,用于根据所述状态向量和所述控制量计算所述航空器的状态变化率,为扰动输入矩阵,所述控制量受所述控制量约束集合限制,所述风场扰动属于所述有界扰动集合;
17、根据所述连续非线性运动学方程进行离散化,得到离散运动学模型:
18、,
19、其中,为离散时间步,为离散化后的状态转移矩阵,为离散化后的控制输入矩阵,为离散化后的扰动输入矩阵。
20、优选地,所述针对每个航空器,根据所述航空器的离散运动学模型和引入的满足无扰动标称模型的标称状态和标称控制量进行求解,得到所述航空器的航迹管,具体包括:
21、根据所述离散运动学模型,引入满足无扰动标称模型的标称状态和标称控制量,所述标称状态和所述标称控制量满足标称模型;
22、根据实际状态与所述标称状态之差定义跟踪误差;
23、根据所述跟踪误差设计反馈控制律,其中,为反馈增益矩阵;
24、根据所述反馈控制律和所述有界扰动集合,求解针对属于所述有界扰动集合的任意扰动均使所述跟踪误差保持在内的鲁棒正不变集;
25、根据所述标称状态的位置分量与所述鲁棒正不变集做闵可夫斯基和,生成所述航空器的航迹管,其中,为闵可夫斯基和运算符号,表示航空器在离散时刻的航迹管。
26、优选地,所述根据各航空器的航迹管构建的约束条件,包括:
27、根据预测时域内每一离散时刻各航空器的航迹管均无交集,构建管状避障硬约束;
28、根据各航空器的标称控制量属于对应的控制量约束集合与反馈增益矩阵对所述鲁棒正不变集进行线性变换后所得集合的闵可夫斯基差,构建标称控制量收缩约束,为所述控制量约束集合,为闵可夫斯基差;
29、根据各航空器的标称状态属于自由空域与所述鲁棒正不变集的闵可夫斯基差,构建标称状态收缩约束,为剔除静态障碍物后的自由空域。
30、优选地,所述代价函数为:
31、;
32、其中,和为冲突发生前第架航空器原计划航线的参考状态和参考控制量,、、为权重正定矩阵,为气动能耗惩罚项,为与所述实时剩余电量成反比的权重系数。
33、优选地,所述根据各航空器的最优标称控制序列中的首项叠加反馈控制律后作为实际控制指令输出,包括:
34、根据各航空器的最优标称控制序列,其中表示航空器的最优标称控制序列,为最优标称控制序列中的第个元素;
35、取所述最优标称控制序列的第一个元素;
36、根据所述第一个元素和初始时刻的跟踪误差,按照反馈控制律计算实际控制指令,其中为所述反馈控制律中的反馈修正项在初始时刻的值,为初始时刻的跟踪误差;
37、将所述实际控制指令下发给飞行控制计算机执行。
38、优选地,所述方法还包括:
39、在下一控制周期,根据更新后的实时运动状态及实时剩余电量重复得到更新后的实际控制指令,实现滚动时域优化。
40、第二方面,本发明实施例提供了一种微气象扰动下异构航空器冲突鲁棒解算装置,包括:
41、约束构建模块,用于根据进入潜在冲突区域的两架航空器的实时运动状态、实时剩余电量及物理运动极限,分别构建各航空器的控制量约束集合;
42、离散运动学模型模块,用于根据所述实时运动状态、所述控制量约束集合及根据预设的风场扰动边界建立的有界扰动集合,建立各航空器的离散运动学模型;
43、航迹管模块,用于针对每个航空器,根据所述航空器的离散运动学模型和引入的满足无扰动标称模型的标称状态和标称控制量进行求解,得到所述航空器的航迹管;
44、约束求解模块,用于根据各航空器的航迹管构建的约束条件和代价函数进行求解,得到各航空器的最优标称控制序列,所述代价函数根据各航空器的标称状态与预设参考轨迹之间的偏差、所述标称控制量与预设参考控制量之间的偏差、以及与所述实时剩余电量负相关的能耗惩罚项构建得到;
45、输出模块,用于根据各航空器的最优标称控制序列中的首项叠加反馈控制律后得到实际控制指令输出。
46、第三方面,本发明实施例提供了一种电子设备,包括:至少一个处理器、至少一个存储器以及存储在存储器中的计算机程序指令,当计算机程序指令被处理器执行时实现如上述实施方式中第一方面的方法。
47、第四方面,本发明实施例提供了一种存储介质,其上存储有计算机程序指令,当计算机程序指令被处理器执行时实现如上述实施方式中第一方面的方法。
48、本发明与现有技术相比,具有如下的优点和有益效果:
49、通过将微气象风场扰动建模为有界集合并将其纳入离散运动学模型,能够在不依赖实时精确风场数据的前提下,在优化过程中显式考虑扰动对轨迹的影响,降低了系统对高精度气象传感器的工程依赖;
50、基于标称状态与反馈控制律求解鲁棒正不变集,并与标称状态做闵可夫斯基和生成航迹管,使得航迹管能够包络任意有界扰动下实际轨迹的所有可能偏移,从而在缺乏实时风场数据的情况下仍能实现两机安全隔离;
51、以实时剩余电量与物理运动极限动态生成控制量约束集合,结合闵可夫斯基差构建标称控制量收缩约束,使标称控制量与反馈修正项叠加后的实际控制指令始终处于航空器当前物理极限内,能够适应低电量或强风阻等工况下航空器机动包络收窄的实际变化;
52、通过预测时域内航迹管无交集、控制量收缩、状态收缩三类硬约束与含能耗惩罚项的代价函数共同构建凸优化问题,结合序列二次规划求解与滚动更新机制,能够在满足多重约束的前提下实现毫秒级响应,同时使优化器在低电量时自动减少大机动消耗,延长飞行器在密集空域中的有效续航能力。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com