CN111522258B - 多无人机协同控制仿真系统及其构建方法、仿真方法 - Google Patents

多无人机协同控制仿真系统及其构建方法、仿真方法 Download PDF

Info

Publication number
CN111522258B
CN111522258B CN202010447074.5A CN202010447074A CN111522258B CN 111522258 B CN111522258 B CN 111522258B CN 202010447074 A CN202010447074 A CN 202010447074A CN 111522258 B CN111522258 B CN 111522258B
Authority
CN
China
Prior art keywords
module
unmanned aerial
control
flight
aerial vehicle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010447074.5A
Other languages
English (en)
Other versions
CN111522258A (zh
Inventor
国海峰
张庆杰
石晓航
徐亮
蔡亚伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
PLA AIR FORCE AVIATION UNIVERSITY
Original Assignee
PLA AIR FORCE AVIATION UNIVERSITY
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by PLA AIR FORCE AVIATION UNIVERSITY filed Critical PLA AIR FORCE AVIATION UNIVERSITY
Priority to CN202010447074.5A priority Critical patent/CN111522258B/zh
Publication of CN111522258A publication Critical patent/CN111522258A/zh
Application granted granted Critical
Publication of CN111522258B publication Critical patent/CN111522258B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B17/00—Systems involving the use of models or simulators of said systems
    • G05B17/02—Systems involving the use of models or simulators of said systems electric

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种多无人机协同控制仿真系统及其构建方法、仿真方法，所述仿真系统包括综合态势显示及控制系统，综合态势显示及控制系统通过UDP网络通信分别与多个无人机模拟训练系统连接，综合态势显示及控制系统包括二维控制模块、三维态势显示模块和多机服务器模块，无人机模拟训练系统包括飞行控制席位和任务载荷席位，飞行控制席位与任务载荷席位之间数据交互，飞行控制席位与综合态势显示及控制系统数据交互；本发明能够实现多无人机的协同控制，为多无人机协同控制算法提供了实验平台，本发明将飞行状态与载荷信息分开显示，有助于对任务载荷进行单独训练。

Description

多无人机协同控制仿真系统及其构建方法、仿真方法
技术领域
本发明属于可视化仿真技术领域，特别是涉及一种多无人机协同控制仿真系统及其构建方法、仿真方法。
背景技术
日趋复杂的战场环境中战术任务具有多重性与复杂性，单架无人作战飞机几乎无法完成指定的作战任务；首先由于载荷限制，单架无人作战飞机一般难以同时具有较强的目标探测、跟踪或目标攻击能力，且独立的战斗单元存在地域、范围、手段和精度的局限；其次无人作战飞机通常用于执行高危险任务，由于其智能化程度远低于人的思维和判断，使其损毁概率较高，难以应对复杂多变的战场环境下的作战需求；目前无人机作战模式从“以平台为中心”的传统作战模式逐步向“以网络为中心”的多机协同作战模式转变，多平台相互协同执行任务逐渐成为无人机参与作战的主要形式，未来的无人机作战将不再是单一机型的作战，而是有人机-无人机、多无人机的联合作战模式。
搭建多无人机协同作战仿真平台，对于缩短开发周期、降低无人机编队实验成本，具有十分重要的意义，当前国内外已有一些针对无人机编队或多无人机仿真系统的研究，越来越多的研究机构利用开源仿真软件开发低成本的模拟器，以实现无人机飞行场景可视化及全过程显示无人机飞行状态，而现有的模拟器存在以下缺陷：需要独立开发无人机模型和控制器模型或是引入自动驾驶仪才能对无人机进行自主控制，不能实现多个无人机协同控制仿真，且无法单独显示任务席位界面，并将任务席位界面与跟随飞行席位界面联动。
发明内容
本发明的目的在于提供一种多无人机协同控制仿真系统，能够单独显示任务载荷席位，并将任务席位界面与跟随飞行界面联用，以实现对任务载荷操控能力的单独训练，且能实现多个无人机的编队形成、编队跟踪控制。
本发明的目的还在于提供一种多无人机协同控制仿真系统的构建方法，基于一致性理论确定多无人机编队形成和编队跟踪控制协议，利用网络数据分发技术实现对多个无人机的综合显示和控制，能够对多个无人机进行协同控制仿真，并将任务载荷席位和飞行控制席位分开显示，实现其数据交互，以便对无人机的任务载荷进行单独训练。
本发明的目的还在于提供一种多无人机协同控制仿真方法，以实现对无人机任务载荷的单独训练和对多个无人机编队形成、跟踪控制的仿真。
本发明所采用的技术方案是，多无人机协同控制仿真系统，包括综合态势显示及控制系统，用于控制多个无人机模拟训练系统实现协同仿真，包括二维控制模块、三维态势显示模块和多机服务器模块，所述二维控制模块与三维态势显示模块数据交互，所述综合态势显示及控制系统通过UDP网络通信分别与多个无人机模拟训练系统连接；
所述无人机模拟训练系统，用于无人机视景仿真和状态显示，包括飞行控制席位和任务载荷席位，所述飞行控制席位和任务载荷席位之间数据交互，所述飞行控制席位还分别与二维控制模块、三维态势显示模块、多机服务器模块数据交互。
进一步的，所述二维控制模块包括初始配置模块、目标设置模块、任务分配模块、航路规划模块、编队协同控制模块、二维任务监控模块和二维状态监控模块；
所述初始配置模块用于配置各无人机的初始状态数据，并将多个无人机的初始状态数据输送至任务分配模块；
所述目标设置模块用于设置被侦察、打击目标的类型和数量，并将被侦察、打击目标数量输送至任务分配模块；
所述任务分配模块用于根据被侦察、打击目标的数量和各无人机的初始状态给各无人机分配任务，并将任务分配结果分别输送至航路规划模块、三维态势显示模块；
所述航路规划模块用于根据任务分配结果规划多个无人机的航路，并将航路规划结果输入三维态势显示模块；
所述编队协同控制模块与所述飞行控制席位数据交互，用于控制多个无人机形成编队跟踪被侦察、打击的目标；
所述二维任务监控模块用于实现对无人机任务载荷状态的二维监控；
所述二维状态监控模块用于实现对无人机飞行状态的二维监控；
所述三维态势显示模块包括三维任务监控模块、三维状态监控模块、推演评估模块和信息存储/回放模块；
所述三维任务监控模块用于监控所有无人机的载荷信息，显示三维侦察探测范围；
所述三维状态监控模块用于监控所有无人机的飞行状态，显示无人机的三维飞行状态；
所述推演评估模块用于根据任务分配结果和航路规划结果预演、评估各个无人机的飞行状态和任务完成情况，并将评估合格的任务分配结果和航路规划结果输入无人机飞行控制席位执行，将评估不合格的结果返回任务分配模块和航路规划模块，重新进行任务分配和航路规划；
所述信息存储/回放模块用于存储二维任务监控模块、二维状态监控模块、三维任务监控模块和三维状态监控模块监测的所有无人机的飞行数据和任务执行信息，并具有完整的回放功能；
所述多机服务器模块用于接收各无人机飞行控制席位发送的飞行状态信息，并过滤各无人机的载荷信息，将所有无人机的飞行信息分发至各个无人机飞行控制席位。
进一步的，所述飞行控制席位包括飞行摇杆、飞行控制模块、地面控制站和飞行视景仿真模块；
所述地面控制站用于把飞行摇杆输入的控制量转发至飞行控制模块；
所述飞行控制模块用于把飞行摇杆输入的控制量及编队协同控制模块、推演评估模块、多机服务器模块输入的控制量解算为舵偏量，经地面控制站转发至飞行视景仿真模块；
所述飞行视景仿真模块用于根据舵偏量改变无人机的飞行姿态，并将部分飞行姿态数据输入地面控制站进行显示；
所述任务载荷席位包括任务摇杆和任务视景仿真模块；
所述任务视景仿真模块用于显示无人机飞行姿态数据坐标变换得到的任务载荷视景数据，并将更新后的载荷状态数据同步至飞行视景仿真模块；
所述任务摇杆用于对任务视景进行缩放和锁定被侦察、打击目标。
多无人机协同控制仿真系统的构建方法，具体包括以下步骤：
步骤1，基于simulink建立无人机气动学和动力学模型，包括力和力矩计算模块、气动力计算模块和气动系数输入模块；
步骤2，使用AC3D软件对无人机气动学和动力学模型进行三维建模；
步骤3，接入Pixhawk自动驾驶仪作为无人机模拟训练系统的飞行控制模块，设置地面控制站软件，使用两个FlightGear软件分别作为飞行视景仿真模块和任务视景仿真模块，并将无人机的三维模型放入FlightGear软件中进行调用，自动驾驶仪、飞行视景仿真模块、任务视景仿真模块均与地面控制站软件数据交互，其通信遵循XML协议；
步骤4，设置编队形成控制协议和编队跟踪控制协议，构建综合态势显示及控制系统的编队协同控制模块；
基于一致性理论，采用如下编队形成控制、编队跟踪控制协议：
ui(t)＝ui1(t)+ui2(t)+ui3(t)，i＝1,2,…,N
其中ui(t)为t时刻第i个无人机的编队形式控制输入，ui1(t)为第i个无人机的自身反馈控制输入，ui2(t)为辅助函数输入，ui3(t)为第i个无人机邻居无人机的反馈控制输入；
当要对各个无人机进行编队形成控制时，
Figure BDA0002501619050000041
当要对各个无人机进行编队跟踪控制时，
Figure BDA0002501619050000042
其中K1和K2为编队形成控制协议增益矩阵，xi(t)为t时刻第i个无人机的飞行状态，hi(t)为t时刻第i个无人机的参考编队位置变量，r(t)为t时刻无人机编队运动轨迹，vi(t)为t时刻第i个无人机的编队形成控制函数，si(t)为t时刻第i个无人机的轨迹跟踪控制函数，Ni为第i个无人机的邻居无人机集合，wi j表示形成编队的第i个无人机与其第j个邻居无人机的连接权重，dt是时变通信时延，xj(t-dt)为t-dt时刻第i个无人机的第j个邻居无人机的状态变量，hj(t-dt)为t-dt时刻第i个无人机的第j个邻居无人机的参考编队位置变量，xi(t-dt)为t-dt时刻第i个无人机的状态变量，hi(t-dt)为t-dt时刻第i个无人机的参考编队位置变量，r(t-dt)为t-dt时刻无人机编队的运动轨迹；
步骤5，搭建综合态势显示及控制系统的其他模块，并使用UDP网络通信实现综合态势显示及控制系统与各个无人机的飞行控制席位、任务载荷席位的通信连接。
进一步的，多个编队形成控制的充要条件如下：
充要条件1，对于任意给定的有界初始条件，群系统在时变时延和切换拓扑条件下，通过ui(t)的控制形成时变编队h(t)的充要条件是：
(I)对于矩阵
Figure BDA0002501619050000051
有
Figure BDA0002501619050000052
(II)对于矩阵
Figure BDA0002501619050000053
和编队形成控制函数v(t)有：
Figure BDA0002501619050000054
(III)对于所有的切换信号σ(t)，如下N-1个子系统是渐近稳定的：
Figure BDA0002501619050000055
控制输入矩阵B为列满秩矩阵，存在一个非奇异矩阵
Figure BDA0002501619050000056
满足
Figure BDA0002501619050000057
Figure BDA0002501619050000058
T为转置，I为单位矩阵，A为系统状态矩阵，
Figure BDA0002501619050000059
为时变编队的导数，Im为m维单位阵，λσ(t),i为多个无人机形成编队时通信拓扑有向图对应的拉普拉斯矩阵Lσ(t)的非零特征值，
Figure BDA00025016190500000510
为t时刻第i个无人机的状态向量，
Figure BDA00025016190500000511
为
Figure BDA00025016190500000512
的微分，
Figure BDA00025016190500000513
为t-dt时刻第i个无人机的状态向量，N为无人机总数；
充要条件2，对于所有的通信拓扑切换信号σ(t)，存在实矩阵
Figure BDA00025016190500000514
实矩阵
Figure BDA00025016190500000515
实矩阵
Figure BDA00025016190500000516
实矩阵
Figure BDA00025016190500000517
以及常数a和b(b≠0)，使下式成立：
Figure BDA00025016190500000518
其中，
Figure BDA00025016190500000519
Figure DA00025016190547649875
为dt的最大值，A0K＝A+BK1，ΛB、ΛA0K、
Figure BDA00025016190500000520
分别表示控制输入矩阵B、实矩阵A0K、
Figure BDA00025016190500000521
的对角矩阵，
Figure BDA00025016190500000522
分别为
Figure BDA00025016190500000523
ΛB的转置，
Figure BDA0002501619050000061
Re(λσ(t),i)为λσ(t),i的实部，Im(λσ(t),i)为λσ(t),i的虚部，
Figure BDA0002501619050000062
为
Figure BDA0002501619050000063
的转置，μ是常数，0＜μ＜1。
进一步的，所述编队跟踪控制协议的充要条件如下：
对于任意给定的有界初始条件，群系统在时变时延和切换拓扑条件下，通过ui(t)的控制可以形成时变编队h(t)、跟踪轨迹r(t)的充要条件是：
(i)对于矩阵
Figure BDA0002501619050000064
有
Figure BDA0002501619050000065
(ii)对于矩阵
Figure BDA0002501619050000066
以及编队形成控制函数矩阵v(t)和轨迹跟踪控制函数s(t)，有：
Figure BDA0002501619050000067
(iii)如下系统是渐近稳定的：
Figure BDA0002501619050000068
(iv)对于所有的σ(t)，如下N-1个时延子系统是渐近稳定的：
Figure BDA0002501619050000069
其中
Figure BDA00025016190500000610
为
Figure BDA00025016190500000611
的导数，In表示n维单位矩阵。
多无人机协同控制仿真系统的仿真方法，具体包括以下步骤：
S1，在初始配置模块配置多个无人机的初始状态数据，在目标设置模块配置被侦察、打击目标的类型和数量，初始配置模块和目标设置模块将无人机初始状态数据和被侦察、打击目标数量输入任务分配模块；
S2，任务分配模块根据被侦察、打击目标的数量和各无人机的初始状态给各无人机分配任务，并将任务分配结果输送至航路规划模块和推演评估模块；
S3，航路规划模块根据任务分配结果规划各个无人机的航路，并将航路规划结果输入推演评估模块进行预演、评估，若是预演结果合格则将任务分配结果和航路规划结果分发至各个无人机的飞行控制模块执行，若是预演结果不合格则将预演结果反馈至任务分配模块、航路规划模块，重新进行任务分配和航路规划；
S4，当需要将多个无人机形成编队协同控制时，将编辑好的队形输入编队协同控制模块，编队协同控制模块运行编队形成控制和编队跟踪控制协议，并将控制指令输送至各个无人机的飞行控制模块；
S5，无人机的飞行控制模块接收到任务分配结果、航路规划结果和编队控制指令后，将各接收数据解算成舵偏量经地面控制站输送至飞行视景仿真模块，进行飞行姿态的改变，飞行视景仿真模块还将无人机的飞行姿态数据输入地面控制站进行展示，将无人机的飞行姿态数据转换成任务载荷视景数据输入任务视景仿真模块进行显示；
S6，各个无人机任务执行完成后，编队协同控制模块控制各个无人机解散编队、返回着陆。
进一步的，在多个无人机协同控制过程中，二维任务监控模块、二维状态监控模块、三维任务监控模块和三维状态监控模块共同对各个无人机的飞行状态、任务载荷状态进行监控，并将监控结果输送至信息存储/回放模块进行存储、回放。
进一步的，在多个无人机协同控制过程中，飞行控制模块将各个无人机的飞行状态数据输入多机服务器模块，多机服务器模块过滤任务载荷数据后将所有无人机的飞行状态数据分发至各无人机的飞行控制模块，飞行控制模块将任务中其他无人机的飞行状态数据输入地面控制站进行显示。
本发明的有益效果是：1、本发明能够实现多无人机协同控制，并能控制多个无人机形成编队、跟踪被侦察或打击目标，将飞行操作和任务载荷操作分为两个席位，对飞行状态信息和任务载荷操控信息分开显示，并实现任务载荷席位与飞行控制席位数据交互，有助于对无人机的任务载荷操控进行单独训练；2、本发明通过变量代换等方法，将高阶线性群系统的编队形成和编队跟踪问题转化成时延相关系统的镇定问题，通过构造公共Lyapunov-Krasovskii泛函，利用自由权矩阵方法对时延相关系统的镇定问题进行分析，得到了保守性较小的LMI判据条件，并求解出最大时延边界，确定了多个无人机群系统的编队控制协议，利用网络数据分发技术实现了对多无人机的综合显示和控制，建立了多无人机协同控制仿真系统，能够转发无人机的状态信息、过滤任务载荷信息，为多无人机协同控制算法提供了实验验证平台。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是多机协同控制仿真系统框架示意图。
图2是综合态势显示及控制系统结构示意图。
图3是无人机模拟训练系统结构示意图。
图4是无人机气动学和动力学模型图。
图5是多无人机侦察任务示意图。
图6是四架无人机的位置曲线图。
图7是四架无人机的速度曲线图。
图8是四架无人机的俯仰角曲线图。
图9是四架无人机的横滚角曲线图。
图10是四架无人机的偏航角曲线图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
多无人机协同控制仿真系统结构如图1所示，包括综合态势显示及控制系统，综合态势显示及控制系统作为多个无人机协同控制的指挥控制中心，采用智能控制和人工干预对多个无人机实现协同控制仿真，如图2所示，综合态势显示及控制系统包括二维控制模块、三维态势显示模块和多机服务器模块，二维控制模块和三维态势显示模块之间对无人机所有数据进行交互，综合态势显示及控制系统通过UDP网络通信分别与多个无人机模拟训练系统连接，无人机模拟训练系统用于无人机视景仿真和状态显示，能够对无人机进行模拟训练，无人机模拟训练系统包括飞行控制席位和任务载荷席位，飞行控制席位和任务载荷席位之间进行飞行姿态数据和载荷状态数据交互，飞行控制席位还分别与二维控制模块、三维态势显示模块、多机服务器模块数据交互。
如图2所示，二维控制模块包括初始配置模块、目标设置模块、任务分配模块、航路规划模块、编队协同控制模块、二维任务监控模块和二维状态监控模块，所述初始配置模块用于配置各个无人机的起飞机场、方向、挂载导弹数量、加油量等初始状态数据，并将各个无人机的初始状态数据输入任务分配模块，目标设置模块用于设置被侦察、打击目标的类型和数量，并将被侦察、打击目标的数量输入任务分配模块，任务分配模块用于根据各个无人机的初始状态和被侦察、打击目标的数量给各无人机分配任务，并将任务分配结果输入航路规划模块和三维态势显示模块，航路规划模块用于根据任务分配结果规划各无人机的航路，并将航路规划结果输入三维态势显示模块，编队协同控制模块与飞行控制席位数据交互，用于控制多个无人机形成编队，二维任务监控模块用于实现对无人机任务载荷状态的二维监控，二维状态监控模块用于实现对无人机飞行状态的二维监控；三维态势显示模块包括三维任务监控模块、三维状态监控模块、推演评估模块和信息存储/回放模块，三维任务监控模块用于监控所有无人机的载荷信息，显示三维侦察探测范围；三维状态监控模块用于监控所有无人机的飞行状态，显示无人机的三维飞行状态；推演评估模块用于根据任务分配结果和航路规划结果预演、评估无人机的飞行状态和任务完成情况，并将预演结果合格的任务分配结果和航路规划结果分发至各个无人机的飞行控制席位，将预演结果不合格的预演结果反馈至任务分配模块、航路规划模块，重新进行任务分配和航路规划；信息存储/回放模块用于存储二维任务监控模块、二维状态监控模块、三维任务监控模块和三维状态监控模块监测的所有无人机的飞行数据和任务执行信息，并具有完整的回放功能；多机服务器模块用于接收各个无人机的飞行控制席位发送的飞行状态信息，并过滤载荷信息，将所有无人机的飞行状态信息分发至各个无人机的飞行控制席位，使同一场景中的各无人机的飞行界面能够显示其他无人机的位置和飞行状态。
如图3所示，飞行控制席位包括飞行摇杆，在人工或增稳模式下，地面控制站将人为或自控设备输入的控制量转发至飞行控制模块，飞行控制模块对控制量进行解算，将解算获得的舵偏量经地面控制站转发至飞行视景仿真模块，以改变无人机的飞行姿态，飞行视景仿真模块将部分飞行姿态数据输入地面控制站进行显示，如无人机的经度、纬度、高度、航向数据；任务载荷席位包括任务视景仿真模块和任务摇杆，飞行姿态数据经过坐标变换得到任务载荷视景数据，任务视景仿真模块用于显示任务载荷视景数据，并将无人机任务载荷信息变化后更新的载荷状态数据同步至飞行视景仿真模块，以保持视景一致，任务摇杆用于对任务视景进行缩放和锁定被侦察、打击目标；该系统将任务载荷席位与飞行控制席位分开设置，使任务载荷操控与无人机飞行控制相结合，能够单独对任务载荷操控设备进行训练。
多无人机协同控制仿真系统的构建方法具体包括以下步骤：
步骤1，基于simulink建立无人机气动学和动力学模型如图4所示，包括力和力矩计算模块、气动力计算模块和气动系数输入模块，整个无人机气动力计算模块的输入量分别为：副翼偏角、升降舵偏角、油门量和方向舵偏角，输出量分别为：位置向量、速度向量、横滚角、俯仰角、偏航角、横滚角速率、俯仰角速率和偏航角速率；
步骤2，使用AC3D软件对无人机气动学和动力学模型进行三维建模，并为建模的每个对象指定独一无二的名称，以方便FlightGear仿真模块使用对象名称(Object name)控制对象完成相应的动作；
AC3D软件作为跨平台、非开源、商业的三维模型制作软件，支持大部分主流操作系统，如Linux、Mac和Windows等，AC3D软件容量小、使用简单、速度快、功能强大，支持DXF、POV-Ray、RenderMan、3D Studio、Lightwave、Alias triangle、Wavefront OBJ等多种格式，AC3D软件的模型文件具有可读性，容易实现修改和解析，AC3D软件使用可视化操作界面，只需使用鼠标拖拽即可绘制复杂的三维可视模型；
步骤3，构建无人机模拟训练系统，
在无人机模拟训练系统的仿真回路中接入开源飞控Pixhawk自动驾驶仪作为飞行控制模块，设置地面控制站软件，使用两个FlightGear软件分别作为飞行视景仿真模块和任务视景仿真模块，并将无人机的三维模型放入FlightGear软件中进行调用，FlightGear软件支持“Mavlink”数据格式的传输协议，其与地面控制站软件的通信遵循一定的XML协议；
地面控制站软件向Pixhawk自动驾驶仪提供飞行摇杆输入的无人机姿态数据、传感器数据、GPS数据和装载的航路信息，自动驾驶仪通过位置解算和姿态解算，解算出舵偏量回送给地面控制站软件，由地面控制站软件转发给FlightGear软件完成对无人机三维模型的控制，FlightGear软件提供无人机的三维外观模型、气动数据模型、GPS位置信息以及无人机的飞行操作界面和任务载荷操作界面；
步骤4，设计编队形成控制协议和编队跟踪控制协议，具体包括以下步骤：
步骤41，构建多个无人机系统的高阶线性群系统模型，
由N个无人机组成的线性群系统如下：
Figure BDA0002501619050000101
其中
Figure BDA0002501619050000102
为t时刻第i个无人机飞行状态的导数，i为表示无人机数目的变量，i＝1,2,…,N，A为系统状态矩阵，B为控制输入矩阵，
Figure BDA0002501619050000103
为t时刻第i个无人机的飞行状态，
Figure BDA0002501619050000104
为群系统中所有无人机的飞行状态集合，
Figure BDA0002501619050000105
为t时刻第i个无人机的编队形式控制输入，
Figure BDA0002501619050000106
为群系统中所有无人机编队形式控制输入的集合，各无人机之间的通信拓扑用有向图G表示，有向图G具有一个生成树，
Figure BDA0002501619050000111
表示指定的时变编队，
Figure BDA0002501619050000112
是分段连续可微的；
步骤42，确定群系统的约束条件，
约束条件1：时变通信时延，假设群系统中每个无人机与其邻居无人机的通信存在时变时延dt，dt满足
Figure BDA0002501619050000113
且
Figure BDA0002501619050000114
其中
Figure BDA0002501619050000115
为t时刻时变时延的变化率，
Figure BDA0002501619050000116
和μ是常数，0＜μ＜1；
约束条件2：切换通信拓扑，假设群系统中各无人机间通信拓扑的有向图随时间变化，即存在通信拓扑切换，令
Figure BDA0002501619050000117
S≥1表示所有可能的通信拓扑组成的集合，S表示群系统中有向图G的总数，σ(t):[0,+∞)→S＝{1,2,…,s}表示通信拓扑的切换信号，s为表示有向图G个数的变量，切换信号在t时刻的取值表示有向图G对应
Figure BDA00025016190500001121
中元素的下标，与有向图G对应的拉普拉斯矩阵为Lσ(t)；
步骤43，确定群系统实现编队形成控制的充要条件，并设计编队形成控制协议，
若控制输入矩阵B为列满秩矩阵，存在一个非奇异矩阵
Figure BDA0002501619050000118
满足
Figure BDA0002501619050000119
Figure BDA00025016190500001110
I为单位矩阵，T为转置；
充要条件1：对于任意给定的有界初始条件，群系统在时变时延和切换拓扑条件下，能够形成时变编队h(t)的充要条件是：
(I)对于矩阵
Figure BDA00025016190500001111
有
Figure BDA00025016190500001112
(II)对于矩阵
Figure BDA00025016190500001113
和编队形成控制函数矩阵v(t)，有
Figure BDA00025016190500001114
(III)对于所有的切换信号σ(t)，如下N-1个子系统是渐近稳定的：
Figure BDA00025016190500001115
其中
Figure BDA00025016190500001116
为控制输入矩阵，Im为m维单位矩阵，λσ(t),i为多个无人机形成编队时通信拓扑有向图对应的拉普拉斯矩阵Lσ(t)的非零特征值，xi(t)为t时刻第i个无人机的飞行状态向量，
Figure BDA00025016190500001117
为
Figure BDA00025016190500001118
的微分，
Figure BDA00025016190500001119
为t-dt时刻第i个无人机的状态向量，
Figure BDA00025016190500001120
为时变编队的导数；
充要条件2：对于所有的切换信号σ(t)，存在实矩阵
Figure BDA0002501619050000121
实矩阵
Figure BDA0002501619050000122
实矩阵
Figure BDA0002501619050000123
实矩阵
Figure BDA0002501619050000124
以及常数a和b(b≠0)，使下式成立：
Figure BDA0002501619050000125
其中，
Figure BDA0002501619050000126
A0K＝A+BK1，ΛB、
Figure BDA0002501619050000127
分别为控制输入矩阵B、实矩阵A0K、实矩阵
Figure BDA0002501619050000128
实矩阵
Figure BDA0002501619050000129
的对角矩阵，
Figure BDA00025016190500001210
分别为
Figure BDA00025016190500001211
ΛB的转置，
Figure BDA00025016190500001212
Re(λσ(t),i)为λσ(t),i的实部，Im(λσ(t),i)为λσ(t),i的虚部，
Figure BDA00025016190500001213
为Φλσ(t),i的转置；
对于群系统若存在编队控制输入ui(t)和编队中心位置参考函数c(t)使得：
Figure BDA00025016190500001214
则群系统能够形成时变编队h(t)，c(t)用来表示编队中心的运动模态；
基于一致性理论，采用如下编队形成控制协议：
ui(t)＝ui1(t)+ui2(t)+ui3(t)，i＝1,2,…,N
其中ui1(t)为第i个无人机的自身反馈控制输入，ui2(t)为辅助函数输入，ui3(t)为第i个无人机邻居无人机的反馈控制输入，其具体表达式如下：
Figure BDA00025016190500001215
其中K1和K2为编队形成控制协议增益矩阵，xi(t)为t时刻第i个无人机的飞行状态，hi(t)为t时刻第i个无人机的参考编队位置变量，vi(t)为t时刻第i个无人机的编队形成控制函数，Ni为第i个无人机的邻居无人机集合，dt是时变通信时延，xj(t-dt)为t-dt时刻第i个无人机的第j个邻居无人机的状态变量，hj(t-dt)为t-dt时刻第i个无人机的第j个邻居无人机的参考编队位置变量，xi(t-dt)为t-dt时刻第i个无人机的状态变量，hi(t-dt)为t-dt时刻第i个无人机的参考编队位置变量，定义
Figure BDA0002501619050000131
和
Figure BDA0002501619050000132
为区间t∈[-dt,0]上的连续函数，当t∈[-dt,0]时，
Figure BDA0002501619050000133
为第i个无人机的初始状态，
Figure BDA0002501619050000134
为第i个无人机的初始编队位置，wij表示形成编队的第i个无人机与其第j个邻居无人机的连接权重；
条件(I)中不包含编队形成控制协议的控制量，群系统形成时变编队h(t)时无人机自身动态特性和h(t)需要满足条件(I)，根据条件(II)求解出编队形成控制函数vi(t)，编队形成控制协议增益矩阵K1包含在无人机自身反馈控制输入ui1(t)中，而ui1(t)不包含dt，因此通过选取合适的编队形成控制协议增益矩阵K1，将A0K的特征值配置在复平面的指定位置，完成对编队中心位置参考函数c(t)的运动模态配置，利用充要条件2求解参数a、参数b和时变时延dt的最大边界dt，进而得到编队形成控制协议增益矩阵K2；
步骤44，需要实现编队跟踪控制时，编队跟踪控制协议设计过程如下：
编队跟踪控制的充要条件：对于任意给定的有界初始条件，群系统在时变时延和切换拓扑条件下，通过ui(t)的控制可以形成时变编队h(t)、跟踪轨迹r(t)的充要条件是：
(i)对于矩阵
Figure BDA0002501619050000135
有
Figure BDA0002501619050000136
(ii)对于矩阵
Figure BDA0002501619050000137
以及编队形成控制函数v(t)和轨迹跟踪控制函数s(t)，有：
Figure BDA0002501619050000138
(iii)系统
Figure BDA0002501619050000139
是渐近稳定的；
(iv)对于所有的σ(t)，如下N-1个时延子系统是渐近稳定的：
Figure BDA00025016190500001310
其中
Figure BDA0002501619050000141
λσ(t),i(i＝2,3,…,N)为拉普拉斯矩阵Lσ(t)的非零特征值，In表示n维单位矩阵，
Figure BDA0002501619050000142
为
Figure BDA0002501619050000143
的导数；
对于群系统若存在编队控制输入ui(t)和无人机编队运动轨迹r(t)，使得
Figure BDA0002501619050000144
则群系统能够形成时变编队h(t)，同时可以跟踪轨迹r(t)，此时ui1(t)、ui2(t)、ui3(t)计算如下：
Figure BDA0002501619050000145
r(t-dt)为t-dt时刻无人机编队的运动轨迹，si(t)为r(t)决定的t时刻第i个无人机的轨迹跟踪控制函数，当t∈[-dt,0]时，
Figure BDA0002501619050000146
条件(i)中不包含编队跟踪控制协议的控制量，因此群系统若要形成时变编队h(t)、跟踪轨迹r(t)，各无人机主体的自身动态特性、h(t)和r(t)需要满足式条件(i)，令A+BK1是Hurwitz的使条件(ii)所示系统渐近稳定，进而确定编队形成控制函数v(t)和轨迹跟踪控制函数s(t)，条件(iv)与条件(III)类似，其稳定性可以利用实现编队形成控制的充要条件2得到；
利用编队形成控制的充要条件2判断条件(iv)所示系统的稳定性时，只需要考虑
Figure BDA0002501619050000147
四个矩阵即可，其中
Figure BDA0002501619050000148
定义如下：
Figure BDA0002501619050000149
Figure BDA00025016190500001410
Figure BDA00025016190500001411
Figure BDA00025016190500001412
Figure BDA00025016190500001413
为待计算的边界矩阵，
Figure BDA00025016190500001414
为对应的特征值；
步骤5，搭建综合态势显示及控制系统的其他模块，并使用UDP网络通信实现综合态势显示及控制系统与各个无人机的飞行控制席位、任务载荷席位的通信连接；
采用基于“Client/Server”架构的UDP网络数据分发技术，将综合态势显示及控制系统作为服务器端(Server)，将每个无人机的仿真模拟训练系统作为客户端(Client)，服务器端负责监听所有客户端的数据，并向客户端发送控制指令，为了实现数据指令能够驱动视景模型运动，各系统之间的网络通讯协议以XML格式重新定义数据流，并采用多线程编程技术防止线程阻塞和程序假死。
若编队形成控制的充要条件2和编队跟踪控制的充要条件中的切换信号σ(t)均为固定值，则群系统中各无人机之间的拓扑图变为非切换的固定拓扑，因此编队形成控制的充要条件2和编队跟踪控制的充要条件也适用于固定通信拓扑下的群系统编队跟踪控制。
使用多无人机协同控制仿真系统进行仿真，包括以下步骤：
S1，在初始配置模块输入多个无人机的初始状态数据，在目标设置模块输入被侦察、打击目标的类型和数量，初始配置模块和目标设置模块将无人机初始状态数据和被侦察、打击目标数量输入任务分配模块；
S2，任务分配模块根据被侦察、打击目标的数量和各无人机的初始状态给各无人机分配任务，并将任务分配结果输送至航路规划模块和推演评估模块；
S3，航路规划模块根据任务分配结果规划各个无人机的航路，并将航路规划结果输入推演评估模块进行预演、评估，若是预演结果合格则将任务分配结果和航路规划结果分发至各个无人机的飞行控制模块执行，若是预演结果不合格则将预演结果反馈至任务分配模块、航路规划模块，重新进行任务分配和航路规划；
S4，当需要将多个无人机形成编队协同控制时，编队协同控制模块根据输入的队形产生时变编队h(t)和编队中心位置参考函数c(t)，基于一致性理论生成编队控制协议ui(t)，并将控制指令输送至各个无人机的飞行控制模块；
S5，无人机的飞行控制模块接收到任务分配结果、航路规划结果和编队控制指令后，将各接收数据解算成舵偏量经地面控制站输送至飞行视景仿真模块，进行飞行姿态的改变，飞行视景仿真模块还将无人机的飞行姿态数据输入地面控制站进行展示，将无人机的飞行姿态数据转换成任务载荷视景数据输入任务视景仿真模块进行显示；
S8，各个无人机任务执行完成后，编队协同控制模块控制各个无人机解散编队、返回着陆。
在多个无人机协同控制过程中，二维任务监控模块、二维状态监控模块、三维任务监控模块和三维状态监控模块共同对各个无人机的飞行状态、任务载荷状态进行监控，并将监控结果输送至信息存储/回放模块进行存储，方便回放观察无人机任务执行过程和执行结果；飞行控制模块将各个无人机的飞行状态数据输入多机服务器模块，多机服务器模块过滤任务载荷数据后将所有无人机的飞行状态数据分发至各无人机的飞行控制模块，飞行控制模块将任务中其他无人机的飞行状态数据输入地面控制站进行显示，使各个无人机的飞行视景仿真模块都能够显示任务中所有无人机的飞行状态。
实施例
本发明实施例要求四架无人机协同完成如图5所示的多无人机编队协同侦察任务，无人机到达任务区域后需形成菱形编队，并保持编队构型跟踪指定的飞行轨迹，完成对指定目标的侦察任务，所述指定的飞行轨迹为以被侦察目标上空为圆心，半径为150m的圆形轨迹。
考虑到四架无人机在执行任务时会受到外界环境或敌方的干扰，出现通信时延和拓扑切换等问题，设定时变通信实验为时延为0.01+0.01sin(t)s，两种可能的通信拓扑对应的拉普拉斯矩阵分别为
Figure BDA0002501619050000161
对于每架无人机，其位置运动的时间常数要远大于姿态运动的时间常数，因此一般采用双环结构实现对无人机的控制，外环控制无人机的位置和速度，内环控制无人机的姿态；编队控制器的设计主要针对的是无人机的位置和速度，而位置和速度之间存在积分关系，因此在设计编队控制器时，每架无人机的模型可以用二阶积分器来描述，考虑到无人机的三维状态，定义
Figure BDA0002501619050000162
无人机在三维空间简化模型为
Figure BDA0002501619050000163
其中，
Figure BDA0002501619050000164
I3为三维单位矩阵。
根据任务需要，设定时变编队h(t)和跟踪轨迹r(t)分别为：
Figure BDA0002501619050000171
和
Figure BDA0002501619050000172
其中，ω＝0.14rad/s。
编队形成控制函数v(t)和轨迹跟踪控制函数s(t)分别为：
Figure BDA0002501619050000173
和
Figure BDA0002501619050000174
编队跟踪控制协议增益矩阵K1和K2分别为：
Figure BDA0002501619050000175
和
Figure BDA0002501619050000176
在半物理仿真实验中，将采样频率设置为50Hz，此时若无人机之间出现通信时延，则无人机接收到的是上一时刻的邻居节点信息，假设四架无人机已经到达了各自的指定高度，并同时接近任务区域；图6给出了四架无人机在80s内的位置曲线，图6中被侦查目标用五角星表示，从图6可以看出，四架无人机从不同高度抵达任务区域，在编队控制协议的作用下，四架无人机逐渐形成了指定的菱形编队，并可以跟踪圆形轨迹，从而完成对目标的侦察任务。
图7给出了四架无人机在80s内的速度曲线，图7中用不同的符号表示四架无人机的初始速度，从图7可以看出在初始调整阶段无人机的编队构型没有形成，因此每架无人机的速度曲线有一定的波动；当编队形成后每架无人机的速度则逐渐趋于稳定，这说明了四架无人机保持稳定的队形并实现了对指定圆形轨迹的跟踪飞行。
图8、图9和图10分别给出了四架无人机的俯仰角(Pitch)、横滚角(Roll)和偏航角(Yaw)随时间的变化曲线，从图8中可以看出在初始阶段为了形成指定编队，四架无人机的俯仰角调整幅度较大，当编队逐渐形成后为了保持飞行姿态，四架无人机的俯仰角始终在零点附近的较小范围内调整；从图9中可以看出，在编队形成过程中四架无人机的横滚角变化幅度较大，当编队形成后横滚角逐渐趋于一致，由于四架无人机围绕着被侦查目标作圆周运动且半径不同，因此外圈1号无人机的横滚角变化幅度最大，幅值在-0.25rad～-0.45rad之间，内圈的3号无人机的横滚角幅度最小，幅值在-0.2rad～-0.3rad之间；从图10中可以看出，在形成编队后由于四架无人机均是作圆周运动，因此四架无人机的偏航角度始终以一定的变化速率稳定的变化，由于无人机偏航角的180°和-180°是相同的，因此图10中的偏航角曲线在30s和75s左右存在-π到π之间的跳变；从这几幅图中，我们可以看出四架无人机在编队控制协议的作用下，形成了指定的菱形编队，并可以稳定地跟踪指定轨迹。
本说明书中的各个实施例均采用相关的方式描述，各个实施例之间相同相似的部分互相参见即可，每个实施例重点说明的都是与其他实施例的不同之处。尤其，对于系统实施例而言，由于其基本相似于方法实施例，所以描述的比较简单，相关之处参见方法实施例的部分说明即可。
以上所述仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等，均包含在本发明的保护范围内。

Claims (8)

1.多无人机协同控制仿真系统，其特征在于，包括
综合态势显示及控制系统，用于控制多个无人机模拟训练系统实现协同仿真，包括二维控制模块、三维态势显示模块和多机服务器模块，所述二维控制模块与三维态势显示模块数据交互，所述综合态势显示及控制系统通过UDP网络通信分别与多个无人机模拟训练系统连接；
所述无人机模拟训练系统，用于无人机视景仿真和状态显示，包括飞行控制席位和任务载荷席位，所述飞行控制席位和任务载荷席位之间数据交互，所述飞行控制席位还分别与二维控制模块、三维态势显示模块、多机服务器模块数据交互；
所述飞行控制席位包括飞行摇杆、飞行控制模块、地面控制站和飞行视景仿真模块；
所述地面控制站用于把飞行摇杆输入的控制量转发至飞行控制模块；
所述飞行控制模块用于把飞行摇杆输入的控制量及编队协同控制模块、推演评估模块、多机服务器模块输入的控制量解算为舵偏量，经地面控制站转发至飞行视景仿真模块；
所述飞行视景仿真模块用于根据舵偏量改变无人机的飞行姿态，并将部分飞行姿态数据输入地面控制站进行显示；
所述任务载荷席位包括任务摇杆和任务视景仿真模块；
所述任务视景仿真模块用于显示无人机飞行姿态数据坐标变换得到的任务载荷视景数据，并将更新后的载荷状态数据同步至飞行视景仿真模块；
所述任务摇杆用于对任务视景进行缩放和锁定被侦察、打击目标。
2.根据权利要求1所述的多无人机协同控制仿真系统，其特征在于，所述二维控制模块包括初始配置模块、目标设置模块、任务分配模块、航路规划模块、编队协同控制模块、二维任务监控模块和二维状态监控模块；
所述初始配置模块用于配置各无人机的初始状态数据，并将多个无人机的初始状态数据输送至任务分配模块；
所述目标设置模块用于设置被侦察、打击目标的类型和数量，并将被侦察、打击目标数量输送至任务分配模块；
所述任务分配模块用于根据被侦察、打击目标的数量和各无人机的初始状态给各无人机分配任务，并将任务分配结果分别输送至航路规划模块、三维态势显示模块；
所述航路规划模块用于根据任务分配结果规划多个无人机的航路，并将航路规划结果输入三维态势显示模块；
所述编队协同控制模块与所述飞行控制席位数据交互，用于控制多个无人机形成编队跟踪被侦察、打击的目标；
所述二维任务监控模块用于实现对无人机任务载荷状态的二维监控；
所述二维状态监控模块用于实现对无人机飞行状态的二维监控；
所述三维态势显示模块包括三维任务监控模块、三维状态监控模块、推演评估模块和信息存储/回放模块；
所述三维任务监控模块用于监控所有无人机的载荷信息，显示三维侦察探测范围；
所述三维状态监控模块用于监控所有无人机的飞行状态，显示无人机的三维飞行状态；
所述推演评估模块用于根据任务分配结果和航路规划结果预演、评估各个无人机的飞行状态和任务完成情况，并将评估合格的任务分配结果和航路规划结果输入无人机飞行控制席位执行，将评估不合格的结果返回任务分配模块和航路规划模块，重新进行任务分配和航路规划；
所述信息存储/回放模块用于存储二维任务监控模块、二维状态监控模块、三维任务监控模块和三维状态监控模块监测的所有无人机的飞行数据和任务执行信息，并具有完整的回放功能；
所述多机服务器模块用于接收各无人机飞行控制席位发送的飞行状态信息，并过滤各无人机的载荷信息，将所有无人机的飞行信息分发至各个飞行控制席位。
3.如权利要求1-2任一项所述的多无人机协同控制仿真系统的构建方法，其特征在于，具体包括以下步骤：
步骤1，基于simulink建立无人机气动学和动力学模型，包括力和力矩计算模块、气动力计算模块和气动系数输入模块；
步骤2，使用AC3D软件对无人机气动学和动力学模型进行三维建模；
步骤3，接入Pixhawk自动驾驶仪作为无人机模拟训练系统的飞行控制模块，设置地面控制站软件，使用两个FlightGear软件分别作为飞行视景仿真模块和任务视景仿真模块，并将无人机的三维模型放入FlightGear软件中进行调用，自动驾驶仪、飞行视景仿真模块、任务视景仿真模块均与地面控制站软件数据交互，其通信遵循XML协议；
步骤4，设置编队形成控制协议和编队跟踪控制协议，构建综合态势显示及控制系统的编队协同控制模块；
基于一致性理论，采用如下编队形成控制、编队跟踪控制协议：
ui(t)＝ui1(t)+ui2(t)+ui3(t)，i＝1,2,…,N
其中ui(t)为t时刻第i个无人机的编队形式控制输入，ui1(t)为第i个无人机的自身反馈控制输入，ui2(t)为辅助函数输入，ui3(t)为第i个无人机邻居无人机的反馈控制输入；
当要对各个无人机进行编队形成控制时，
Figure FDA0003838345740000031
当要对各个无人机进行编队跟踪控制时，
Figure FDA0003838345740000032
其中K1和K2为编队形成控制协议增益矩阵，xi(t)为t时刻第i个无人机的飞行状态，hi(t)为t时刻第i个无人机的参考编队位置变量，r(t)为t时刻无人机编队运动轨迹，vi(t)为t时刻第i个无人机的编队形成控制函数，si(t)为t时刻第i个无人机的轨迹跟踪控制函数，Ni为第i个无人机的邻居无人机集合，wij表示形成编队的第i个无人机与其第j个邻居无人机的连接权重，dt是时变通信时延，xj(t-dt)为t-dt时刻第i个无人机的第j个邻居无人机的状态变量，hj(t-dt)为t-dt时刻第i个无人机的第j个邻居无人机的参考编队位置变量，xi(t-dt)为t-dt时刻第i个无人机的状态变量，hi(t-dt)为t-dt时刻第i个无人机的参考编队位置变量，r(t-dt)为t-dt时刻无人机编队的运动轨迹；
步骤5，搭建综合态势显示及控制系统的其他模块，并使用UDP网络通信实现综合态势显示及控制系统与各个无人机飞行控制席位、任务载荷席位的通信连接。
4.根据权利要求3所述的多无人机协同控制仿真系统的构建方法，其特征在于，多个编队形成控制的充要条件如下：
充要条件1，对于任意给定的有界初始条件，群系统在时变时延和切换拓扑条件下，通过ui(t)的控制形成时变编队h(t)的充要条件是：
(I)对于矩阵
Figure FDA0003838345740000041
有
Figure FDA0003838345740000042
(II)对于矩阵
Figure FDA0003838345740000043
和编队形成控制函数v(t)有：
Figure FDA0003838345740000044
(III)对于所有的切换信号σ(t)，如下N-1个子系统是渐近稳定的，
Figure FDA0003838345740000045
控制输入矩阵B为列满秩矩阵，存在一个非奇异矩阵
Figure FDA0003838345740000046
满足
Figure FDA0003838345740000047
Figure FDA0003838345740000048
T为转置，I为单位矩阵，A为系统状态矩阵，
Figure FDA0003838345740000049
为时变编队的导数，Im为m维单位阵，λσ(t),i为多个无人机形成编队时通信拓扑有向图对应的拉普拉斯矩阵Lσ(t)的非零特征值，
Figure FDA00038383457400000410
为t时刻第i个无人机的状态向量，
Figure FDA00038383457400000411
为
Figure FDA00038383457400000412
的微分，
Figure FDA00038383457400000413
为t-dt时刻第i个无人机的状态向量，N为无人机总数；
充要条件2，对于所有的通信拓扑切换信号σ(t)，存在实矩阵
Figure FDA00038383457400000414
实矩阵
Figure FDA00038383457400000415
实矩阵
Figure FDA00038383457400000416
实矩阵
Figure FDA00038383457400000417
以及常数a和b(b≠0)，使下式成立：
Figure FDA00038383457400000418
其中，
Figure FDA00038383457400000419
Figure FDA00038383457400000420
为dt的最大值，A0K＝A+BK1，ΛB、
Figure FDA00038383457400000421
分别表示控制输入矩阵B、实矩阵A0K、实矩阵
Figure FDA00038383457400000422
实矩阵
Figure FDA00038383457400000423
的对角矩阵，
Figure FDA00038383457400000424
分别为
Figure FDA00038383457400000425
ΛB的转置，
Figure FDA0003838345740000051
Re(λσ(t),i)为λσ(t),i的实部，Im(λσ(t),i)为λσ(t),i的虚部，
Figure FDA0003838345740000052
为
Figure FDA0003838345740000053
的转置，μ是常数，0＜μ＜1。
5.根据权利要求4所述的多无人机协同控制仿真系统的构建方法，其特征在于，所述编队跟踪控制协议的充要条件如下：
对于任意给定的有界初始条件，群系统在时变时延和切换拓扑条件下，通过ui(t)的控制可以形成时变编队h(t)、跟踪轨迹r(t)的充要条件是：
(i)对于矩阵
Figure FDA0003838345740000054
有
Figure FDA0003838345740000055
(ii)对于矩阵
Figure FDA0003838345740000056
以及编队形成控制函数矩阵v(t)和轨迹跟踪控制函数s(t)，有：
Figure FDA0003838345740000057
(iii)如下系统是渐近稳定的：
Figure FDA0003838345740000058
(iv)对于所有的σ(t)，如下N-1个时延子系统是渐近稳定的
Figure FDA0003838345740000059
其中
Figure FDA00038383457400000510
Figure FDA00038383457400000511
为
Figure FDA00038383457400000512
的导数，In表示n维单位矩阵。
6.使用权利要求1-2任一项所述的多无人机协同控制仿真系统的仿真方法，其特征在于，具体包括以下步骤：
S1，在初始配置模块配置多个无人机的初始状态数据，在目标设置模块配置被侦察、打击目标的类型和数量，初始配置模块和目标设置模块将无人机初始状态数据和被侦察、打击目标数量输入任务分配模块；
S2，任务分配模块根据被侦察、打击目标的数量和各无人机的初始状态给各无人机分配任务，并将任务分配结果输送至航路规划模块和推演评估模块；
S3，航路规划模块根据任务分配结果规划各个无人机的航路，并将航路规划结果输入推演评估模块进行预演、评估，若是预演结果合格则将任务分配结果和航路规划结果分发至各个无人机的飞行控制模块执行，若是预演结果不合格则将预演结果反馈至任务分配模块、航路规划模块，重新进行任务分配和航路规划；
S4，当需要将多个无人机形成编队协同控制时，将编辑好的队形输入编队协同控制模块，编队协同控制模块运行编队形成控制和编队跟踪控制协议，并将控制指令输送至各个无人机的飞行控制模块；
S5，无人机的飞行控制模块接收到任务分配结果、航路规划结果和编队控制指令后，将各接收数据解算成舵偏量经地面控制站输送至飞行视景仿真模块，进行飞行姿态的改变，飞行视景仿真模块还将无人机的飞行姿态数据输入地面控制站进行展示，将无人机的飞行姿态数据转换成任务载荷视景数据输入任务视景仿真模块进行显示；
S6，各个无人机任务执行完成后，编队协同控制模块控制各个无人机解散编队、返回着陆。
7.根据权利要求6所述的仿真方法，其特征在于，在多个无人机协同控制过程中，二维任务监控模块、二维状态监控模块、三维任务监控模块和三维状态监控模块共同对各个无人机的飞行状态、任务载荷状态进行监控，并将监控结果输送至信息存储/回放模块进行存储、回放。
8.根据权利要求6所述的仿真方法，其特征在于，在多个无人机协同控制过程中，飞行控制模块将各个无人机的飞行状态数据输入多机服务器模块，多机服务器模块过滤任务载荷数据后将所有无人机的飞行状态数据分发至各无人机的飞行控制模块，飞行控制模块将任务中其他无人机的飞行状态数据输入地面控制站进行显示。
CN202010447074.5A 2020-05-21 2020-05-21 多无人机协同控制仿真系统及其构建方法、仿真方法 Active CN111522258B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010447074.5A CN111522258B (zh) 2020-05-21 2020-05-21 多无人机协同控制仿真系统及其构建方法、仿真方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010447074.5A CN111522258B (zh) 2020-05-21 2020-05-21 多无人机协同控制仿真系统及其构建方法、仿真方法

Publications (2)

Publication Number Publication Date
CN111522258A CN111522258A (zh) 2020-08-11
CN111522258B true CN111522258B (zh) 2022-10-21

Family

ID=71905494

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010447074.5A Active CN111522258B (zh) 2020-05-21 2020-05-21 多无人机协同控制仿真系统及其构建方法、仿真方法

Country Status (1)

Country Link
CN (1) CN111522258B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112034737A (zh) * 2020-09-07 2020-12-04 中国航空工业集团公司成都飞机设计研究所 一种无人机多机模拟训练的仿真控制系统及控制方法
CN112214030B (zh) * 2020-09-11 2023-03-14 中国航空工业集团公司成都飞机设计研究所 一种无人机一站控双机显控方法
CN112394649B (zh) * 2020-11-17 2022-08-30 中国人民解放军63892部队 一种基于分时复用的群无人机内通信行为控制平台
CN112965396A (zh) * 2021-02-08 2021-06-15 大连大学 一种四旋翼无人机硬件在环可视化仿真方法
CN113741511A (zh) * 2021-08-02 2021-12-03 中国人民解放军军事科学院国防科技创新研究院 一种无人机集群推演及故障诊断方法、系统
CN113721478A (zh) * 2021-08-02 2021-11-30 中国人民解放军军事科学院国防科技创新研究院 一种集群无人系统推演及故障诊断方法、系统
CN113721479A (zh) * 2021-08-10 2021-11-30 海创飞龙(福建)科技有限公司 一种无人机模拟训练系统
CN113946128A (zh) * 2021-11-29 2022-01-18 中国人民解放军国防科技大学 一种无人机集群半实物仿真控制系统
CN115237000B (zh) * 2022-06-23 2023-08-04 中国航空工业集团公司沈阳飞机设计研究所 一种有无人机编队协同对抗仿真试验平台及试验方法
CN116627053B (zh) * 2023-05-29 2024-05-03 武汉船舶通信研究所(中国船舶集团有限公司第七二二研究所) 一种无人平台集群通信网络的半实物仿真系统
CN116522429B (zh) * 2023-07-05 2023-09-12 西安羚控电子科技有限公司 飞行器任务载荷显示特效生成方法及系统
CN117077364A (zh) * 2023-07-06 2023-11-17 成都飞机工业（集团）有限责任公司 无人机地面指挥控制系统、控制方法及无人机控制系统
CN118534922B (zh) * 2024-07-24 2024-09-27 电子科技大学(深圳)高等研究院 一种面向无人机编队飞行的任务管控方法及系统

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102141779A (zh) * 2010-12-30 2011-08-03 中国科学院长春光学精密机械与物理研究所 航天光学遥感器运动件控制电路变载仿真测试方法
CN103543641A (zh) * 2013-09-30 2014-01-29 中国人民解放军国防科学技术大学 一种舵机铰链力矩实时动态加载装置
CN104260908A (zh) * 2014-08-28 2015-01-07 上海微小卫星工程中心 一种跨平台对地观测卫星联合演示验证系统
CN104615010A (zh) * 2014-12-26 2015-05-13 成都飞机工业（集团）有限责任公司 基于网络通信的FlightGear和VC混合系统开发方法
CN105137804A (zh) * 2015-08-21 2015-12-09 中国科学院上海技术物理研究所 一种针对飞行姿态扰动的实验室模拟方法
CN106156403A (zh) * 2016-06-21 2016-11-23 南京航空航天大学 基于应力‑强度干涉理论的高超声速飞行器翼梁结构可靠性分析方法
CN106406327A (zh) * 2016-11-01 2017-02-15 中国航空无线电电子研究所 一种无人机任务架构快速验证平台
CN107798947A (zh) * 2017-11-07 2018-03-13 中国航天空气动力技术研究院 一种作战型无人机模拟训练系统及操作方法
CN108646589A (zh) * 2018-07-11 2018-10-12 北京晶品镜像科技有限公司 一种攻击无人机编队的作战模拟训练系统及方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8644512B2 (en) * 2011-03-17 2014-02-04 Massachusetts Institute Of Technology Mission planning interface for accessing vehicle resources
CA2827701A1 (en) * 2013-09-23 2015-03-23 Sureshchandra B. Patel Methods of patel decoupled loadlow computation for electrical power system
US10439484B2 (en) * 2017-07-11 2019-10-08 Alexei V. Nikitin Controllers for regulated power inverters, AC/DC, and DC/DC converters

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102141779A (zh) * 2010-12-30 2011-08-03 中国科学院长春光学精密机械与物理研究所 航天光学遥感器运动件控制电路变载仿真测试方法
CN103543641A (zh) * 2013-09-30 2014-01-29 中国人民解放军国防科学技术大学 一种舵机铰链力矩实时动态加载装置
CN104260908A (zh) * 2014-08-28 2015-01-07 上海微小卫星工程中心 一种跨平台对地观测卫星联合演示验证系统
CN104615010A (zh) * 2014-12-26 2015-05-13 成都飞机工业（集团）有限责任公司 基于网络通信的FlightGear和VC混合系统开发方法
CN105137804A (zh) * 2015-08-21 2015-12-09 中国科学院上海技术物理研究所 一种针对飞行姿态扰动的实验室模拟方法
CN106156403A (zh) * 2016-06-21 2016-11-23 南京航空航天大学 基于应力‑强度干涉理论的高超声速飞行器翼梁结构可靠性分析方法
CN106406327A (zh) * 2016-11-01 2017-02-15 中国航空无线电电子研究所 一种无人机任务架构快速验证平台
CN107798947A (zh) * 2017-11-07 2018-03-13 中国航天空气动力技术研究院 一种作战型无人机模拟训练系统及操作方法
CN108646589A (zh) * 2018-07-11 2018-10-12 北京晶品镜像科技有限公司 一种攻击无人机编队的作战模拟训练系统及方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
Formation Control of High-Order Swarm Systems With Time-Varying Delays and Switching Interconnections;QINGJIE ZHANG等;《IEEE Access》;20200205;第8卷;28188-28196 *
Low Cost, Standard-based EO/IR Payload Simulation for Visual Aided Navigation Applications;Thompson, B等;《IEEE/ION Position, Location and Navigation Symposium》;20181231;全文 *
分布式多无人机协同编队队形控制仿真;成成等;《计算机仿真》;20190531;第36卷(第5期);全文 *
多无人机远距突防协同目标搜索决策;国海峰等;《兵工学报》;20140228;第35卷(第2期);全文 *
无人机载荷图像仿真平台的设计与实现;李登亮;《计算机工程》;20060331;第32卷(第6期);全文 *

Also Published As

Publication number Publication date
CN111522258A (zh) 2020-08-11

Similar Documents

Publication Publication Date Title
CN111522258B (zh) 多无人机协同控制仿真系统及其构建方法、仿真方法
CN109613931B (zh) 基于生物社会力的异构无人机集群目标跟踪系统及方法
CN108549407B (zh) 一种多无人机协同编队避障的控制算法
CN109508035B (zh) 基于分布式控制的多区域分级式无人机编队路径规划方法
CN108388270B (zh) 面向安全域的集群无人机轨迹姿态协同控制方法
Chen et al. Path planning for multi-UAV formation
CN104407619B (zh) 不确定环境下的多无人机同时到达多个目标方法
Duan et al. ? Hybrid particle swarm optimization and genetic algorithm for multi-UAV formation reconfiguration
Qiu et al. Multiple UAV distributed close formation control based on in-flight leadership hierarchies of pigeon flocks
Lin Distributed UAV formation control using differential game approach
CN112180967B (zh) 基于评判-执行架构的多无人机协同对抗决策方法
CN110703795B (zh) 一种基于切换拓扑的无人机群协同安全控制方法
CN113050677A (zh) 多无人机队形保持和变换的控制方法、系统、存储介质
CN111880567A (zh) 基于深度强化学习的固定翼无人机编队协调控制方法及装置
Sun et al. Path planning for dense drone formation based on modified artificial potential fields
CN112198892A (zh) 一种多无人机智能协同突防对抗方法
Rao et al. Path planning for dual UAVs cooperative suspension transport based on artificial potential field-A* algorithm
CN112650290B (zh) 带有扰动补偿的高层消防无人机编队优化控制方法及系统
CN117150757A (zh) 一种基于数字孪生的仿真推演系统
Liu et al. Robust time-varying formation control for tail-sitters in flight mode transitions
Agrawal et al. A novel controller of multi-agent system navigation and obstacle avoidance
CN115657724A (zh) 一种有人、无人飞机协同编队队形变换系统及方法
Mazakova et al. Controllability of an unmanned aerial vehicle
Yang et al. A decentralised control strategy for formation flight of unmanned aerial vehicles
Bai et al. Research on UAV Formation Simulation and Evaluation Technology

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant