CN112859913A - Multi-quad-rotor unmanned aerial vehicle attitude consistency optimal control method considering output constraint - Google Patents

Multi-quad-rotor unmanned aerial vehicle attitude consistency optimal control method considering output constraint Download PDF

Info

Publication number
CN112859913A
CN112859913A CN202110043323.9A CN202110043323A CN112859913A CN 112859913 A CN112859913 A CN 112859913A CN 202110043323 A CN202110043323 A CN 202110043323A CN 112859913 A CN112859913 A CN 112859913A
Authority
CN
China
Prior art keywords
attitude
unmanned aerial
aerial vehicle
control method
quadrotor
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.)
Granted
Application number
CN202110043323.9A
Other languages
Chinese (zh)
Other versions
CN112859913B (en
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.)
Guangdong University of Technology
Original Assignee
Guangdong University of Technology
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 Guangdong University of Technology filed Critical Guangdong University of Technology
Priority to CN202110043323.9A priority Critical patent/CN112859913B/en
Publication of CN112859913A publication Critical patent/CN112859913A/en
Application granted granted Critical
Publication of CN112859913B publication Critical patent/CN112859913B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The utility model provides a multi-quad-rotor unmanned aerial vehicle attitude consistency optimal control method and system considering output constraints. Firstly, carrying out mathematical modeling on the attitude dynamic characteristics of the quad-rotor unmanned aerial vehicle; then, converting the system attitude control problem with output constraint into an optimal control problem under the unconstrained condition by adopting system conversion based on a barrier function; aiming at the transformed stateless constraint system, a single-network self-adaptive dynamic programming method is adopted to solve a distributed Hamilton-Jacobian-Bellman equation so as to obtain a distributed optimal attitude control law; the output of the attitude system of the multi-quad rotor unmanned aerial vehicle can effectively track the attitude signal of the leader and keep in the required safety range.

Description

考虑输出约束的多四旋翼无人机姿态一致最优控制方法Attitude-consistent optimal control method for multi-quadcopter UAV considering output constraints

技术领域technical field

本公开属于四旋翼无人机控制技术领域,尤其涉及一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法。The present disclosure belongs to the technical field of quadrotor unmanned aerial vehicle control, and in particular relates to an optimal control method for a multi-quadrotor unmanned aerial vehicle that considers output constraints with consistent attitude.

背景技术Background technique

本部分的陈述仅仅是提供了与本公开相关的背景技术信息,不必然构成在先技术。The statements in this section merely provide background information related to the present disclosure and do not necessarily constitute prior art.

四旋翼无人机由于重量轻、体积小、机动性强、适应能力强等特点,无论是在民用还是军用领域都越来越受欢迎。相比于单架四旋翼无人机单独执行任务,多架四旋翼无人机的协同具有更大的优势。比如在高层灭火问题凸显的背景下,利用多架四旋翼无人机进行火情侦查,无疑是高层楼宇消防的一种有效解决方案。然而,在高层楼宇火场环境下,由于建筑结构的复杂性,四旋翼无人机的姿态要受到环境的限制,无法进行大幅度的摆动。因此,考虑姿态角度受限的四旋翼无人机姿态一致性控制具有十分重要的现实意义。Due to the characteristics of light weight, small size, strong maneuverability and strong adaptability, quadrotor UAVs are becoming more and more popular in both civilian and military fields. Compared with a single quad-rotor UAV to perform tasks alone, the collaboration of multiple quad-rotor UAVs has greater advantages. For example, in the context of high-rise fire extinguishing problems, using multiple quad-rotor drones for fire detection is undoubtedly an effective solution for high-rise building fire protection. However, in the high-rise building fire environment, due to the complexity of the building structure, the posture of the quadrotor UAV is limited by the environment and cannot swing greatly. Therefore, it is of great practical significance to consider the attitude consistency control of quadrotor UAV with limited attitude angle.

发明人发现,近年来,具有输出约束的四旋翼无人机姿态控制得到了广泛的关注,并取得了许多重要的研究成果;然而大多数成果都没有考虑最优控制问题,同时由于四旋翼无人机姿态系统的输出需要满足在一定的安全范围内,对其设计有效的最优控制器是非常困难的。The inventor found that in recent years, the attitude control of quadrotor UAV with output constraints has received extensive attention, and many important research results have been achieved; however, most of the results have not considered the optimal control problem, and because the quadrotor has no The output of the human-machine attitude system needs to meet a certain safety range, and it is very difficult to design an effective optimal controller for it.

发明内容SUMMARY OF THE INVENTION

本公开为了解决上述问题,提供了一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法。In order to solve the above problems, the present disclosure provides an optimal control method for a multi-quadrotor unmanned aerial vehicle that considers output constraints with consistent attitude.

根据本公开实施例的第一个方面,提供了一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,包括:According to a first aspect of the embodiments of the present disclosure, there is provided a multi-quadrotor UAV attitude-consistent optimal control method considering output constraints, including:

对单个四旋翼无人机的姿态物理特性进行建模;Model the attitude physics of a single quadrotor UAV;

根据单个四旋翼无人机的物理特性,将建模得到的方程模型转化为带有约束的状态方程;According to the physical characteristics of a single quadrotor UAV, the equation model obtained by modeling is transformed into a state equation with constraints;

确定多四旋翼无人机的通信拓扑结构,并基于障碍函数,将带有输出约束的状态方程转化为无约束的状态方程;Determine the communication topology of the multi-quadcopter UAV, and convert the state equation with output constraints into an unconstrained state equation based on the obstacle function;

针对无约束的状态方程,确定协同一致性误差及其性能指标函数;For the unconstrained state equation, determine the synergy consistency error and its performance index function;

确定分布式哈密顿-雅克比-贝尔曼方程,并采用单网络自适应动态规划方法近似求解哈密顿-雅克比-贝尔曼方程,从而得到分布式最优姿态控制律。The distributed Hamilton-Jacobi-Bellman equation is determined, and the single-network adaptive dynamic programming method is used to approximately solve the Hamilton-Jacobi-Bellman equation, thereby obtaining the distributed optimal attitude control law.

进一步地,所述对单个四旋翼无人机的姿态物理特性进行建模,所建模型是基于欧拉角描述的四旋翼无人机姿态动力学模型,所述模型具体表示如下:Further, the physical characteristics of the attitude of a single quad-rotor unmanned aerial vehicle are modeled, and the built model is a quad-rotor unmanned aerial vehicle attitude dynamics model described based on Euler angles, and the model is specifically expressed as follows:

Figure BDA0002896161850000021
Figure BDA0002896161850000021

Figure BDA0002896161850000022
Figure BDA0002896161850000022

其中,Θi=[φiii]T表示机体坐标系中的欧拉角,且φi,θi,ψi分别表示四旋翼无人机姿态中的滚转角、俯仰角和偏航角;Ωi=[ωixiyiz]T表示角速度矢量,ωix,ωiy,ωiz分别表示滚转角速度、俯仰角速度与偏航角速度;Ii=diag(Iix,Iiy,Iiz)表示正定惯性矩阵;Mi=[u,u,u]T表示四旋翼无人机姿态角输入的转动扭矩;Ti表示转换矩阵,所述转换矩阵为:Among them, Θ i = [φ i , θ i , ψ i ] T represents the Euler angle in the body coordinate system, and φ i , θ i , ψ i represent the roll angle and pitch angle of the quadrotor UAV attitude, respectively and yaw angle; Ω i =[ω ixiyiz ] T represents the angular velocity vector, ω ix , ω iy , ω iz represent the roll angular velocity, pitch angular velocity and yaw angular velocity respectively; I i =diag(I ix , I iy , I iz ) represent the positive definite inertia matrix; M i =[u , u , u ] T represents the rotational torque input by the attitude angle of the quadrotor unmanned aerial vehicle; T i represents the transformation matrix, the transformation matrix for:

Figure BDA0002896161850000023
Figure BDA0002896161850000023

进一步地,所述将建模得到的方程模型转化为带有约束的状态方程,其状态方程表示如下:Further, the equation model obtained by modeling is transformed into a state equation with constraints, and its state equation is expressed as follows:

Figure BDA0002896161850000024
Figure BDA0002896161850000024

yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T

其中,in,

Figure BDA0002896161850000025
Figure BDA0002896161850000025

g(xi)=diag[1/Iix,1/Iiy,1/Iiz];g(x i )=diag[1/I ix , 1/I iy , 1/I iz ];

ui=[uuu]T;xi=[xi1,xi2,xi3,xi4,xi5,xi6]T u i =[u u u ] T ; x i =[x i1 ,x i2 ,x i3 ,x i4 ,x i5 ,x i6 ] T

此处,xi1=φi,xi2=ωix,xi3=θi,xi4=ωiy,xi5=ψi,xi6=ωiz,且需满足

Figure BDA0002896161850000031
Figure BDA0002896161850000032
Here, x i1i , x i2ix , x i3i , x i4iy , x i5i , x i6iz , and it is necessary to satisfy
Figure BDA0002896161850000031
Figure BDA0002896161850000032

进一步地,所述确定多四旋翼无人机的通信拓扑结构包括如下步骤:Further, the determining of the communication topology of the multi-quadcopter UAV includes the following steps:

利用有向图G={V,E,A}描述编队中无人机之间的通信连接关系;其中,V={0,1,...,N-1}表示图G中节点的集合,

Figure BDA0002896161850000039
表示图中有向边的集合,A=[aij]∈Rn×n表示有向图G的权重矩阵;Use the directed graph G={V,E,A} to describe the communication connection between the UAVs in the formation; where V={0,1,...,N-1} represents the set of nodes in the graph G ,
Figure BDA0002896161850000039
Represents the set of directed edges in the graph, A=[a ij ]∈R n×n represents the weight matrix of the directed graph G;

若僚机i能够收到来自僚机j的信息,那么aij=1(i≠j),否则,aij=0;定义节点i的邻节点为Ni={j∈V|(i,j)∈E,i≠j},入度矩阵D为D=diag{d1,...dN},其中

Figure BDA0002896161850000033
假设aii=0,有向图为严格连接;僚机i和领机的连接关系表示为对角矩阵B=diag{b1,...,bN},若僚机i能够从领导者接收信息,则bi=1,否则bi=0。If wingman i can receive information from wingman j, then a ij = 1 (i≠j), otherwise, a ij =0; the neighbor node of node i is defined as N i ={j∈V|(i,j) ∈E, i≠j}, the in-degree matrix D is D=diag{d 1 ,...d N }, where
Figure BDA0002896161850000033
Assuming a ii = 0, the directed graph is strictly connected; the connection relationship between wingman i and the leader is expressed as a diagonal matrix B=diag{b 1 ,...,b N }, if wingman i can receive information from the leader , then b i =1, otherwise b i =0.

进一步地,所述将带有输出约束的状态方程转化为无约束的状态方程包括如下步骤:Further, converting the state equation with output constraints into an unconstrained state equation includes the following steps:

预先定义状态转换映射关系;Pre-defined state transition mapping relationship;

利用所述映射关系将所述带有输出约束的状态方程转化为无约束的状态方程。The state equation with output constraints is transformed into an unconstrained state equation by using the mapping relationship.

进一步地,所述状态转换映射关系为:Further, the state transition mapping relationship is:

Figure BDA0002896161850000034
Figure BDA0002896161850000034

Figure BDA0002896161850000035
Figure BDA0002896161850000035

Figure BDA0002896161850000036
Figure BDA0002896161850000036

其中,

Figure BDA0002896161850000037
in,
Figure BDA0002896161850000037

进一步地,所述针对无约束的状态方程,确定协同一致性误差以及性能指标函数如下:Further, for the unconstrained state equation, determine the synergy consistency error and the performance index function as follows:

定义协同一致性误差为The synergy consistency error is defined as

Figure BDA0002896161850000038
Figure BDA0002896161850000038

其中,sd为所需跟踪的领机期望轨迹。Among them, s d is the desired trajectory of the leader to be tracked.

定义性能指标函数为Define the performance indicator function as

Figure BDA0002896161850000041
Figure BDA0002896161850000041

其中,

Figure BDA0002896161850000042
in,
Figure BDA0002896161850000042

进一步地,所述确定分布式哈密顿-雅克比-贝尔曼方程包括:Further, the determining the distributed Hamilton-Jacobi-Bellman equation includes:

分别确定哈密顿函数、最优性能指标函数以及分布式最优协同控制律函数;Determine the Hamiltonian function, the optimal performance index function and the distributed optimal cooperative control law function respectively;

将所述分布式最优协同控制律函数代入所述哈密顿函数,获得哈密顿-雅克比-贝尔曼方程。Substitute the distributed optimal cooperative control law function into the Hamiltonian function to obtain the Hamilton-Jacobi-Bellman equation.

进一步地,所述采用单网络自适应动态规划方法近似求解哈密顿-雅克比-贝尔曼方程,包括:Further, the single-network adaptive dynamic programming method is used to approximately solve the Hamilton-Jacobi-Bellman equation, including:

基于神经网络对非线性函数的逼近能力,构造评价网络在线逼近最优性能指标函数;Based on the approximation ability of the neural network to nonlinear functions, construct the evaluation network online approximation optimal performance index function;

基于所述在线逼近最优性能指标函数获得实际的分布式最优姿态控制律。The actual distributed optimal attitude control law is obtained based on the online approximation of the optimal performance index function.

根据本公开实施例的第二个方面,提供了一种考虑输出约束的多四旋翼无人机姿态一致控制系统,其包括处理器单元,所述处理器执行上述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法的步骤。According to a second aspect of the embodiments of the present disclosure, there is provided an attitude-consistent control system for a multi-quadcopter unmanned aerial vehicle considering output constraints, which includes a processor unit, and the processor executes the above-mentioned multi-rotor UAV attitude control system considering output constraints. The steps of the quadrotor UAV attitude consistent optimal control method.

与现有技术相比,本公开的有益效果是:Compared with the prior art, the beneficial effects of the present disclosure are:

(1)本公开所述方案引入了一种状态转换技术来生成一个等效的无约束非线性系统,将原来四旋翼无人机姿态系统的输出受限最优控制问题转化为传统的无约束最优控制问题;针对转化后的无约束等价系统,采用自适应动态规划方法得到最优控制器,不但保证了无人机姿态角度保持在安全范围内,而且使其控制性能达到最优。(1) The solution described in this disclosure introduces a state transition technology to generate an equivalent unconstrained nonlinear system, which transforms the output-constrained optimal control problem of the original quadrotor UAV attitude system into a traditional unconstrained one Optimal control problem; for the transformed unconstrained equivalent system, the adaptive dynamic programming method is used to obtain the optimal controller, which not only ensures that the attitude angle of the UAV remains within a safe range, but also optimizes its control performance.

(2)本公开所述方案通过使用单网络结构来近似性能指标函数,继而得到最优协同控制律,在多四旋翼姿态系统中使用单评价网络而不是典型的执行-评价双网络结构意义更重大,可以减少内存需求与计算负担。(2) The solution described in this disclosure approximates the performance index function by using a single network structure, and then obtains the optimal cooperative control law. It is more meaningful to use a single evaluation network instead of the typical execution-evaluation dual network structure in the multi-quadrotor attitude system. Significant, can reduce memory requirements and computational burden.

本公开附加方面的优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本公开的实践了解到。Advantages of additional aspects of the disclosure will be set forth in part in the description that follows, and in part will become apparent from the description below, or will be learned by practice of the disclosure.

附图说明Description of drawings

构成本公开的一部分的说明书附图用来提供对本公开的进一步理解,本公开的示意性实施例及其说明用于解释本公开,并不构成对本公开的不当限定。The accompanying drawings that constitute a part of the present disclosure are used to provide further understanding of the present disclosure, and the exemplary embodiments of the present disclosure and their descriptions are used to explain the present disclosure and do not constitute an improper limitation of the present disclosure.

图1为本公开实施例一中所述的四旋翼无人机的结构模型图;1 is a structural model diagram of the quadrotor unmanned aerial vehicle described in the first embodiment of the disclosure;

图2为本公开实施例一中所述的多四旋翼无人机的通信拓扑图;2 is a communication topology diagram of the multi-quadcopter UAV described in Embodiment 1 of the present disclosure;

图3为本公开实施例一中所述的滚转角跟踪效果图;3 is an effect diagram of the roll angle tracking described in Embodiment 1 of the present disclosure;

图4为本公开实施例一中所述的俯仰角跟踪效果图;FIG. 4 is an effect diagram of the pitch angle tracking described in Embodiment 1 of the present disclosure;

图5为本公开实施例一中所述的偏航角角跟踪效果图。FIG. 5 is an effect diagram of the yaw angle tracking described in Embodiment 1 of the present disclosure.

具体实施方式Detailed ways

下面结合附图与实施例对本公开做进一步说明。The present disclosure will be further described below with reference to the accompanying drawings and embodiments.

应该指出,以下详细说明都是例示性的,旨在对本公开提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本公开所属技术领域的普通技术人员通常理解的相同含义。It should be noted that the following detailed description is exemplary and intended to provide further explanation of the present disclosure. Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this disclosure belongs.

需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本公开的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。It should be noted that the terminology used herein is for the purpose of describing specific embodiments only, and is not intended to limit the exemplary embodiments according to the present disclosure. As used herein, unless the context clearly dictates otherwise, the singular is intended to include the plural as well, furthermore, it is to be understood that when the terms "comprising" and/or "including" are used in this specification, it indicates that There are features, steps, operations, devices, components and/or combinations thereof.

在不冲突的情况下,本公开中的实施例及实施例中的特征可以相互组合。实施例一:The embodiments of this disclosure and features of the embodiments may be combined with each other without conflict. Example 1:

本实施例的目的是提供一种考虑输出约束的多四旋翼无人机姿态一致性优化控制方法。The purpose of this embodiment is to provide an attitude consistency optimization control method for a multi-quadcopter UAV considering output constraints.

一种考虑输出约束的多四旋翼无人机姿态一致性优化控制方法,包括以下步骤:A multi-quadcopter UAV attitude consistency optimization control method considering output constraints, including the following steps:

S1:对单个四旋翼无人机的姿态物理特性进行建模;S1: Model the physical characteristics of the attitude of a single quadrotor UAV;

本实施例研究的四旋翼无人机具有4个旋翼的同轴结构。结构如图1所示,4个转子成对安装在连杆的末端,为各种飞行任务提供动力。建立基于欧拉角描述的四旋翼无人机姿态动力学模型为:The quadrotor UAV studied in this example has a coaxial structure with four rotors. The structure is shown in Figure 1. Four rotors are installed in pairs at the end of the connecting rod to provide power for various flight missions. The attitude dynamics model of the quadrotor UAV based on the Euler angle description is established as follows:

Figure BDA0002896161850000061
Figure BDA0002896161850000061

Figure BDA0002896161850000062
Figure BDA0002896161850000062

其中,Θi=[φiii]T表示机体坐标系中的欧拉角,且φi,θi,ψi分别表示四旋翼无人机姿态中的滚转角、俯仰角和偏航角;Ωi=[wix,wiy,wiz]T表示角速度矢量,wix,wiy,wiz分别表示滚转角速度、俯仰角速度与偏航角速度;Ii=diag(Iix,Iiy,Iiz)表示正定惯性矩阵。Mi=[u,u,u]T表示四旋翼无人机姿态角输入的转动扭矩。Among them, Θ i = [φ i , θ i , ψ i ] T represents the Euler angle in the body coordinate system, and φ i , θ i , ψ i represent the roll angle and pitch angle of the quadrotor UAV attitude, respectively and yaw angle; Ω i =[w ix , w iy , w iz ] T represents angular velocity vector, w ix , w iy , w iz represent roll angular velocity, pitch angular velocity and yaw angular velocity respectively; I i =diag(I ix , I iy , I iz ) represent positive definite inertial matrices. M i =[u , u , u ] T represents the rotational torque input by the attitude angle of the quadrotor UAV.

转换矩阵transformation matrix

Figure BDA0002896161850000063
Figure BDA0002896161850000063

那么,四旋翼无人机模型可进一步表示为Then, the quadrotor UAV model can be further expressed as

Figure BDA0002896161850000064
Figure BDA0002896161850000064

Figure BDA0002896161850000065
Figure BDA0002896161850000065

Figure BDA0002896161850000066
Figure BDA0002896161850000066

Figure BDA0002896161850000067
Figure BDA0002896161850000067

Figure BDA0002896161850000068
Figure BDA0002896161850000068

Figure BDA0002896161850000069
Figure BDA0002896161850000069

其中,姿态角φi,θi,ψi需满足

Figure BDA00028961618500000610
Figure BDA00028961618500000611
Among them, the attitude angles φ i , θ i , ψ i need to satisfy
Figure BDA00028961618500000610
Figure BDA00028961618500000611

本实施例的控制目标为,多四旋翼无人机姿态系统的输出能以最优的方式跟踪给定的信号,同时性能指标函数最小,保证系统所有的信号都是一致最终有界的。The control objective of this embodiment is that the output of the multi-quadcopter UAV attitude system can track a given signal in an optimal way, and at the same time, the performance index function is minimized, so as to ensure that all signals in the system are consistent and ultimately bounded.

S2:根据单个四旋翼无人机的物理特性,将建模得到的方程模型转化为状态方程如下:S2: According to the physical characteristics of a single quadrotor UAV, the equation model obtained by modeling is transformed into the state equation as follows:

令xi1=φi,xi2=ωix,xi3=θi,xi4=ωiy,xi5=ψi,xi6=ωiz。因此,四旋翼无人机姿态系统的状态空间表示为Let x i1i , x i2ix , x i3i , x i4iy , x i5i , x i6iz . Therefore, the state space of the quadrotor UAV attitude system is expressed as

Figure BDA0002896161850000071
Figure BDA0002896161850000071

Figure BDA0002896161850000072
Figure BDA0002896161850000072

Figure BDA0002896161850000073
Figure BDA0002896161850000073

Figure BDA0002896161850000074
Figure BDA0002896161850000074

Figure BDA0002896161850000075
Figure BDA0002896161850000075

Figure BDA0002896161850000076
Figure BDA0002896161850000076

yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T

其中,yi为系统输出且需满足

Figure BDA0002896161850000077
Among them, y i is the system output and needs to meet the
Figure BDA0002896161850000077

将四旋翼无人机姿态动力学模型写成如下紧凑结构Write the quadrotor UAV attitude dynamics model as the following compact structure

Figure BDA0002896161850000078
Figure BDA0002896161850000078

yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T

其中,in,

Figure BDA0002896161850000079
Figure BDA0002896161850000079

g(xi)=diag[1/Iix,1/Iiy,1/Iiz];g(x i )=diag[1/I ix , 1/I iy , 1/I iz ];

ui=[uuu]T;xi=[xi1,xi2,xi3,xi4,xi5,xi6]T u i =[u u u ] T ; x i =[x i1 ,x i2 ,x i3 ,x i4 ,x i5 ,x i6 ] T

S3:确定多四旋翼无人机的通信拓扑结构如下:S3: Determine the communication topology of the multi-quadcopter UAV as follows:

利用有向图G={V,E,A}描述编队中无人机之间的通信连接关系;Use the directed graph G={V,E,A} to describe the communication connection between the UAVs in the formation;

其中,V={0,1,...,N-1}表示图G中节点的集合,

Figure BDA00028961618500000710
表示图中有向边的集合,A=[aij]∈Rn×n表示有向图G的权重矩阵;Among them, V={0,1,...,N-1} represents the set of nodes in the graph G,
Figure BDA00028961618500000710
Represents the set of directed edges in the graph, A=[a ij ]∈R n×n represents the weight matrix of the directed graph G;

若僚机i能够收到来自僚机j的信息,那么aij=1(i≠j),否则,aij=0;定义节点i的邻节点为Ni={j∈V|(i,j)∈E,i≠j},入度矩阵D为D=diag{d1,...dN},其中

Figure BDA0002896161850000081
假设aii=0,有向图为严格连接;僚机i和领机的连接关系表示为对角矩阵B=diag{b1,...,bN},若僚机i能够从领导者接收信息,则bi=1,否则bi=0。If wingman i can receive information from wingman j, then a ij = 1 (i≠j), otherwise, a ij =0; the neighbor node of node i is defined as N i ={j∈V|(i,j) ∈E, i≠j}, the in-degree matrix D is D=diag{d 1 ,...d N }, where
Figure BDA0002896161850000081
Assuming a ii = 0, the directed graph is strictly connected; the connection relationship between wingman i and the leader is expressed as a diagonal matrix B=diag{b 1 ,...,b N }, if wingman i can receive information from the leader , then b i =1, otherwise b i =0.

S4:基于障碍函数,将带有输出约束的状态方程转化为无约束的状态方程如下:S4: Based on the barrier function, the state equation with output constraints is transformed into an unconstrained state equation as follows:

为了处理输出受限问题,障碍函数转换技术被引入。定义一个状态转换映射如下:To deal with output-constrained problems, barrier function transformation techniques are introduced. Define a state transition map as follows:

Figure BDA0002896161850000082
Figure BDA0002896161850000082

Figure BDA0002896161850000083
Figure BDA0002896161850000083

Figure BDA0002896161850000084
Figure BDA0002896161850000084

其中,

Figure BDA0002896161850000085
in,
Figure BDA0002896161850000085

那么转换后无输出约束的系统动态为Then the system dynamics without output constraints after transformation is

Figure BDA0002896161850000086
Figure BDA0002896161850000086

其中,si=[si1,si2,si3,si4,si5,si6]TAmong them, s i =[s i1 ,s i2 ,s i3 ,s i4 ,s i5 ,s i6 ] T ,

Figure BDA0002896161850000087
Figure BDA0002896161850000087

Figure BDA0002896161850000088
Figure BDA0002896161850000088

S5:针对无约束的状态方程,定义协同一致性误差以及性能指标函数如下:S5: For the unconstrained state equation, define the synergy consistency error and the performance index function as follows:

定义协同一致性误差为The synergy consistency error is defined as

Figure BDA0002896161850000089
Figure BDA0002896161850000089

其中,sd为所需跟踪的领机期望轨迹。Among them, s d is the desired trajectory of the leader to be tracked.

定义性能指标函数为Define the performance indicator function as

Figure BDA00028961618500000810
Figure BDA00028961618500000810

其中,

Figure BDA00028961618500000811
in,
Figure BDA00028961618500000811

S6:推导出分布式哈密顿-雅克比-贝尔曼方程如下:S6: Derive the distributed Hamilton-Jacobi-Bellman equation as follows:

哈密顿函数可定义为The Hamiltonian function can be defined as

Figure BDA0002896161850000091
Figure BDA0002896161850000091

最优性能指标函数可表示成如下形式The optimal performance index function can be expressed in the following form

Figure BDA0002896161850000092
Figure BDA0002896161850000092

其中,U(Ω)为允许控制的集合。Among them, U(Ω) is the set of allowed control.

根据Bellman的最优性原理,由

Figure BDA0002896161850000093
可以得到分布式最优协同控制律如下:According to Bellman's principle of optimality, by
Figure BDA0002896161850000093
The distributed optimal cooperative control law can be obtained as follows:

Figure BDA0002896161850000094
Figure BDA0002896161850000094

将最优协同控制律代入哈密顿函数,相应的分布式哈密顿-雅克比-贝尔曼方程为Substituting the optimal cooperative control law into the Hamiltonian function, the corresponding distributed Hamiltonian-Jacobi-Bellman equation is

Figure BDA0002896161850000095
Figure BDA0002896161850000095

注意到哈密顿-雅克比-贝尔曼方程难以获得其解析解,为了克服这个问题,采用单网络ADP方法近似求解。It is noted that the Hamilton-Jacobi-Bellman equation is difficult to obtain its analytical solution, in order to overcome this problem, the single-network ADP method is used to approximate the solution.

S7:采用单网络自适应动态规划方法近似求解哈密顿-雅克比-贝尔曼方程,从而得到分布式最优姿态控制律如下:S7: The single-network adaptive dynamic programming method is used to approximately solve the Hamilton-Jacobi-Bellman equation, so as to obtain the distributed optimal attitude control law as follows:

基于神经网络对非线性函数的逼近能力,构造评价网络在线逼近最优性能指标函数为Based on the approximation ability of the neural network to nonlinear functions, the optimal performance index function of the online approximation evaluation network is constructed as follows

Figure BDA0002896161850000096
Figure BDA0002896161850000096

其中,wci∈Rl代表理想权值向量,σii)∈Rl代表激励函数,l是隐藏层神经元的个数。εcii)表示神经网络的近似误差。其近似值为

Figure BDA0002896161850000097
Figure BDA0002896161850000098
表示理想权重向量wci的估计值。Among them, w ci ∈ R l represents the ideal weight vector, σ ii )∈R l represents the excitation function, and l is the number of neurons in the hidden layer. ε cii ) represents the approximation error of the neural network. Its approximation is
Figure BDA0002896161850000097
Figure BDA0002896161850000098
represents an estimate of the ideal weight vector wci .

则实际的分布式最优姿态控制律uiThen the actual distributed optimal attitude control law u i is

Figure BDA0002896161850000101
Figure BDA0002896161850000101

设计评价网络权重更新律如下The weight update law of the design evaluation network is as follows

Figure BDA0002896161850000102
Figure BDA0002896161850000102

其中,λi表示学习率,是一个合适的正常数。

Figure BDA0002896161850000103
where λ i represents the learning rate and is a suitable constant.
Figure BDA0002896161850000103

Figure BDA0002896161850000104
Figure BDA0002896161850000104

为了证实本实施例的有效性,下面进行仿真实验:In order to confirm the validity of this embodiment, the following simulation experiments are carried out:

在本仿真实验中,控制目标是跟踪领机姿态角φ0=0.1sin(t),θ0=0.1sin(t),ψ0=0。根据实际系统,本例采用的模型中的系统物理参数选为Iix=0.0081Nms-2,Iiy=0.0142Nms-2,Iiz=0.0081Nms-2。姿态角受限参数选为

Figure BDA0002896161850000105
Figure BDA0002896161850000106
各四旋翼无人机姿态初始值In this simulation experiment, the control objective is to track the attitude angle of the lead aircraft φ 0 =0.1sin(t), θ 0 =0.1sin(t), ψ 0 =0. According to the actual system, the physical parameters of the system in the model adopted in this example are selected as I ix =0.0081Nms -2 , I iy =0.0142Nms -2 , and I iz =0.0081Nms -2 . The attitude angle limited parameter is selected as
Figure BDA0002896161850000105
Figure BDA0002896161850000106
Initial value of the attitude of each quadrotor UAV

s1=[0.1,-0.5,0.1,-0.5,0.1,-0.5]T,s2=[0.2,0.5,0.2,0.5,0.2,0.5]T,s3=[0.2,0.5,0.2,0.5,0.2,0.5]T,s4=[0.25,1,0.25,1,0.25,1]Ts 1 =[0.1,-0.5,0.1,-0.5,0.1,-0.5] T , s 2 =[0.2,0.5,0.2,0.5,0.2,0.5] T ,s 3 =[0.2,0.5,0.2,0.5 , 0.2, 0.5] T , s 4 = [0.25, 1, 0.25, 1, 0.25, 1] T .

所述方案针对一类领机-僚机协同方式的四旋翼无人机编队,提出了分布式自适应最优姿态控制方案,使得各僚机的姿态角与领机趋于一致,同时各无人机的姿态角满足一定的约束条件。The above scheme proposes a distributed adaptive optimal attitude control scheme for a class of four-rotor UAV formations in the form of leader-wingman collaboration, so that the attitude angles of each wingman and the leader tend to be consistent, and at the same time, each UAV. The attitude angle satisfies certain constraints.

结果分析:Result analysis:

选取李亚普诺夫函数Choose the Lyapunov function

Figure BDA0002896161850000107
对其求时间导数,可得
Figure BDA0002896161850000108
那么根据李雅普诺夫稳定性定理,神经网络权值误差
Figure BDA0002896161850000109
和协同一致性误差δi都是一致最终有界的,即神经网络权重可以收敛到理想值,以及所有僚机的姿态角可以和领机的姿态角达到一致。
Figure BDA0002896161850000107
Taking the time derivative of it, we get
Figure BDA0002896161850000108
Then according to the Lyapunov stability theorem, the weight error of the neural network
Figure BDA0002896161850000109
and the synergy consistency error δi are both consistent and ultimately bounded, that is, the neural network weights can converge to an ideal value, and the attitude angles of all wingmen can be consistent with that of the leader.

从图3、图4和图5可以看出,各僚机的滚转角、俯仰角和偏航角可以与领机保持一致,跟踪效果良好,且输出信号的幅值保持在±0.15安全的范围内。As can be seen from Figure 3, Figure 4 and Figure 5, the roll angle, pitch angle and yaw angle of each wingman can be consistent with the lead aircraft, the tracking effect is good, and the amplitude of the output signal is kept within the safe range of ±0.15 .

本实施例基于单网络自适应动态规划方法在有向通信网络下实现了多四旋翼无人机姿态系统的一致性控制,并且考虑了系统输出受限问题。通过障碍函数系统转换技术,把具有输出受限的四旋翼无人机姿态系统转换成无约束的等价系统。针对无约束的等价系统,采用自适应动态规划方法求解哈密顿-雅克比-贝尔曼方程,从而得到考虑了输出受限的最优控制策略。该方案不但使得僚机的姿态角以最优方式与领机趋于一致,而且使得姿态系统的输出保持在一定的受限范围内。This embodiment realizes the consistent control of the attitude system of the multi-quadrotor UAV under the directed communication network based on the single-network adaptive dynamic programming method, and considers the problem of limited system output. Through the obstacle function system conversion technology, the attitude system of the quadrotor UAV with limited output is converted into an unconstrained equivalent system. For the unconstrained equivalent system, the adaptive dynamic programming method is used to solve the Hamilton-Jacobi-Bellman equation, and the optimal control strategy considering output constraints is obtained. This scheme not only makes the attitude angle of the wingman tend to be consistent with the leader in an optimal way, but also keeps the output of the attitude system within a certain limited range.

本公开所述方案提供了一种新的基于障碍函数的系统转换方法,与现有技术中的障碍李雅普诺夫方法不同的是,该方法可以将输出受限系统转化为无输出受限的等价系统,通过系统等价转换,为处理其它控制问题提供了便利,不仅在理论上具有可行性,在实际上更容易实现。The solution described in the present disclosure provides a new method for system transformation based on barrier functions, which is different from the barrier Lyapunov method in the prior art in that this method can transform an output-constrained system into a non-output-constrained system, etc. The valence system, through the system equivalence conversion, provides convenience for dealing with other control problems, which is not only feasible in theory, but also easier to realize in practice.

实施例二:Embodiment 2:

本实施例的目的是提供一种考虑输出约束的多四旋翼无人机姿态一致最优控制系统。The purpose of this embodiment is to provide a multi-quadrotor UAV attitude consistent optimal control system considering output constraints.

一种考虑输出约束的多四旋翼无人机姿态一致优化控制系统,其包括处理器单元,所述处理器执行上述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法的步骤。A multi-quadrotor unmanned aerial vehicle attitude consistent optimization control system considering output constraints, which includes a processor unit, the processor executes the above-mentioned output constraints of a multi-quadrotor unmanned aerial vehicle attitude consistency optimal control method. step.

上述实施例提供的一种考虑输出约束的多四旋翼无人机姿态一致优化控制方法及系统可以实现,具有广阔的应用前景。The above-mentioned embodiment provides a method and system for optimizing the attitude consistency of a multi-quadcopter UAV considering output constraints, which can be implemented and has broad application prospects.

以上所述仅为本公开的优选实施例而已,并不用于限制本公开,对于本领域的技术人员来说,本公开可以有各种更改和变化。凡在本公开的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。The above descriptions are only preferred embodiments of the present disclosure, and are not intended to limit the present disclosure. For those skilled in the art, the present disclosure may have various modifications and changes. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present disclosure shall be included within the protection scope of the present disclosure.

上述虽然结合附图对本公开的具体实施方式进行了描述,但并非对本公开保护范围的限制,所属领域技术人员应该明白,在本公开的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本公开的保护范围以内。Although the specific embodiments of the present disclosure have been described above in conjunction with the accompanying drawings, they do not limit the protection scope of the present disclosure. Those skilled in the art should understand that on the basis of the technical solutions of the present disclosure, those skilled in the art do not need to pay creative efforts. Various modifications or variations that can be made are still within the protection scope of the present disclosure.

Claims (10)

1.一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,包括:1. a multi-four-rotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints, is characterized in that, comprises: 对单个四旋翼无人机的姿态物理特性进行建模;Model the attitude physics of a single quadrotor UAV; 根据单个四旋翼无人机的物理特性,将建模得到的方程模型转化为带有约束的状态方程;According to the physical characteristics of a single quadrotor UAV, the equation model obtained by modeling is transformed into a state equation with constraints; 确定多四旋翼无人机的通信拓扑结构,并基于障碍函数,将带有输出约束的状态方程转化为无约束的状态方程;Determine the communication topology of the multi-quadcopter UAV, and convert the state equation with output constraints into an unconstrained state equation based on the obstacle function; 针对无约束的状态方程,确定协同一致性误差及其性能指标函数;For the unconstrained state equation, determine the synergy consistency error and its performance index function; 确定分布式哈密顿-雅克比-贝尔曼方程,并采用单网络自适应动态规划方法近似求解哈密顿-雅克比-贝尔曼方程,从而得到分布式最优姿态控制律。The distributed Hamilton-Jacobi-Bellman equation is determined, and the single-network adaptive dynamic programming method is used to approximately solve the Hamilton-Jacobi-Bellman equation, thereby obtaining the distributed optimal attitude control law. 2.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述对单个四旋翼无人机的姿态物理特性进行建模,所建模型是基于欧拉角描述的四旋翼无人机姿态动力学模型,所述模型具体表示如下:2. a kind of multi-four-rotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, is characterized in that, described to the attitude physical characteristic of single four-rotor unmanned aerial vehicle is modeled, so The model is based on the quadrotor UAV attitude dynamics model described by Euler angles, and the model is specifically expressed as follows:
Figure FDA0002896161840000011
Figure FDA0002896161840000011
Figure FDA0002896161840000012
Figure FDA0002896161840000012
其中,Θi=[φiii]T表示机体坐标系中的欧拉角,且φi,θi,ψi分别表示四旋翼无人机姿态中的滚转角、俯仰角和偏航角;Ωi=[ωixiyiz]T表示角速度矢量,ωix,ωiy,ωiz分别表示滚转角速度、俯仰角速度与偏航角速度;Ii=diag(Iix,Iiy,Iiz)表示正定惯性矩阵;Mi=[u,u,u]T表示四旋翼无人机姿态角输入的转动扭矩;Ti表示转换矩阵,所述转换矩阵为:Among them, Θ i = [φ i , θ i , ψ i ] T represents the Euler angle in the body coordinate system, and φ i , θ i , ψ i represent the roll angle and pitch angle of the quadrotor UAV attitude, respectively and yaw angle; Ω i =[ω ixiyiz ] T represents the angular velocity vector, ω ix , ω iy , ω iz represent the roll angular velocity, pitch angular velocity and yaw angular velocity respectively; I i =diag(I ix , I iy , I iz ) represent the positive definite inertia matrix; M i =[u , u , u ] T represents the rotational torque input by the attitude angle of the quadrotor UAV; T i represents the transformation matrix, the transformation matrix for:
Figure FDA0002896161840000013
Figure FDA0002896161840000013
3.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述将建模得到的方程模型转化为带有约束的状态方程,其状态方程表示如下:3. a kind of multi-four-rotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, is characterized in that, described equation model obtained by modeling is converted into the state equation with constraint, Its state equation is expressed as follows:
Figure FDA0002896161840000021
Figure FDA0002896161840000021
yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T 其中,in,
Figure FDA0002896161840000022
Figure FDA0002896161840000022
g(xi)=diag[1/Iix,1/Iiy,1/Iiz];g(x i )=diag[1/I ix , 1/I iy , 1/I iz ]; ui=[uuu]T;xi=[xi1,xi2,xi3,xi4,xi5,xi6]T u i =[u u u ] T ; x i =[x i1 ,x i2 ,x i3 ,x i4 ,x i5 ,x i6 ] T 此处,xi1=φi,xi2=ωix,xi3=θi,xi4=ωiy,xi5=ψi,xi6=ωiz,且需满足
Figure FDA0002896161840000023
Figure FDA0002896161840000024
Here, x i1i , x i2ix , x i3i , x i4iy , x i5i , x i6iz , and it is necessary to satisfy
Figure FDA0002896161840000023
Figure FDA0002896161840000024
4.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述确定多四旋翼无人机的通信拓扑结构包括如下步骤:4. a kind of multi-quadrotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, it is characterized in that, the communication topology structure of described determining many quadrotor unmanned aerial vehicles comprises the steps: 利用有向图G={V,E,A}描述编队中无人机之间的通信连接关系;其中,V={0,1,...,N-1}表示图G中节点的集合,
Figure FDA0002896161840000025
表示图中有向边的集合,A=[aij]∈Rn×n表示有向图G的权重矩阵;
A directed graph G={V,E,A} is used to describe the communication connection between UAVs in the formation; where V={0,1,...,N-1} represents the set of nodes in the graph G ,
Figure FDA0002896161840000025
Represents the set of directed edges in the graph, A=[a ij ]∈R n×n represents the weight matrix of the directed graph G;
若僚机i能够收到来自僚机j的信息,那么aij=1(i≠j),否则,aij=0;定义节点i的邻节点为Ni={j∈V|(i,j)∈E,i≠j},入度矩阵D为D=diag{d1,...dN},其中
Figure FDA0002896161840000026
假设aii=0,有向图为严格连接;僚机i和领机的连接关系表示为对角矩阵B=diag{b1,...,bN},若僚机i能够从领导者接收信息,则bi=1,否则bi=0。
If wingman i can receive information from wingman j, then a ij = 1 (i≠j), otherwise, a ij =0; the neighbor node of node i is defined as N i ={j∈V|(i,j) ∈E, i≠j}, the in-degree matrix D is D=diag{d 1 ,...d N }, where
Figure FDA0002896161840000026
Assuming a ii = 0, the directed graph is strictly connected; the connection relationship between wingman i and the leader is expressed as a diagonal matrix B=diag{b 1 ,...,b N }, if wingman i can receive information from the leader , then b i =1, otherwise b i =0.
5.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述将带有输出约束的状态方程转化为无约束的状态方程包括如下步骤:5. a kind of multi-quadrotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, it is characterized in that, described state equation with output constraint is converted into unconstrained state equation comprising: Follow the steps below: 预先定义状态转换映射关系;Pre-defined state transition mapping relationship; 利用所述映射关系将所述带有输出约束的状态方程转化为无约束的状态方程。The state equation with output constraints is transformed into an unconstrained state equation by using the mapping relationship. 6.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述状态转换映射关系为:6. a kind of multi-quadcopter unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, is characterized in that, described state transition mapping relation is:
Figure FDA0002896161840000031
Figure FDA0002896161840000031
Figure FDA0002896161840000032
Figure FDA0002896161840000032
Figure FDA0002896161840000033
Figure FDA0002896161840000033
其中,
Figure FDA0002896161840000034
in,
Figure FDA0002896161840000034
7.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述针对无约束的状态方程,确定协同一致性误差以及性能指标函数如下:7. a kind of multi-quadrotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, it is characterized in that, described for unconstrained state equation, determine synergy consistency error and performance index function as follows: 定义协同一致性误差为The synergy consistency error is defined as
Figure FDA0002896161840000035
Figure FDA0002896161840000035
其中,sd为所需跟踪的领机期望轨迹;Among them, s d is the desired trajectory of the leader to be tracked; 定义性能指标函数为Define the performance indicator function as
Figure FDA0002896161840000036
Figure FDA0002896161840000036
其中,
Figure FDA0002896161840000037
in,
Figure FDA0002896161840000037
8.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述确定分布式哈密顿-雅克比-贝尔曼方程包括:8. a kind of multi-quadrotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1 is characterized in that, described determining distributed Hamiltonian-Jacoby-Bellman equation comprises: 分别确定哈密顿函数、最优性能指标函数以及分布式最优协同控制律函数;Determine the Hamiltonian function, the optimal performance index function and the distributed optimal cooperative control law function respectively; 将所述分布式最优协同控制律函数代入所述哈密顿函数,获得哈密顿-雅克比-贝尔曼方程。Substitute the distributed optimal cooperative control law function into the Hamiltonian function to obtain the Hamilton-Jacobi-Bellman equation. 9.如权利要求1所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法,其特征在于,所述采用单网络自适应动态规划方法近似求解哈密顿-雅克比-贝尔曼方程,包括:9. a kind of multi-quadrotor unmanned aerial vehicle attitude consistent optimal control method considering output constraints as claimed in claim 1, is characterized in that, described adopting single-network adaptive dynamic programming method to approximately solve Hamiltonian-Jacobian- Bellman equation, including: 基于神经网络对非线性函数的逼近能力,构造评价网络在线逼近最优性能指标函数;Based on the approximation ability of the neural network to nonlinear functions, construct the evaluation network online approximation optimal performance index function; 基于所述在线逼近最优性能指标函数获得实际的分布式最优姿态控制律。The actual distributed optimal attitude control law is obtained based on the online approximation of the optimal performance index function. 10.一种考虑输出约束的多四旋翼无人机姿态一致最优控制系统,其包括处理器单元,其特征在于,所述处理器执行如权利要求1-7任一项所述的一种考虑输出约束的多四旋翼无人机姿态一致最优控制方法的步骤。10. A multi-quadcopter unmanned aerial vehicle attitude consistent optimal control system considering output constraints, it comprises a processor unit, it is characterized in that, described processor executes a kind of described in any one of claim 1-7 Steps of an attitude-consistent optimal control method for a multi-quadcopter UAV considering output constraints.
CN202110043323.9A 2021-01-13 2021-01-13 Multi-quad-rotor unmanned helicopter attitude consistency optimal control method considering output constraint Active CN112859913B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110043323.9A CN112859913B (en) 2021-01-13 2021-01-13 Multi-quad-rotor unmanned helicopter attitude consistency optimal control method considering output constraint

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110043323.9A CN112859913B (en) 2021-01-13 2021-01-13 Multi-quad-rotor unmanned helicopter attitude consistency optimal control method considering output constraint

Publications (2)

Publication Number Publication Date
CN112859913A true CN112859913A (en) 2021-05-28
CN112859913B CN112859913B (en) 2023-06-06

Family

ID=76003418

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110043323.9A Active CN112859913B (en) 2021-01-13 2021-01-13 Multi-quad-rotor unmanned helicopter attitude consistency optimal control method considering output constraint

Country Status (1)

Country Link
CN (1) CN112859913B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113885548A (en) * 2021-10-28 2022-01-04 南京邮电大学 Many four rotor unmanned aerial vehicle output restraint state unanimous game controller
CN114415734A (en) * 2022-03-31 2022-04-29 天津大学 Four-rotor unmanned aerial vehicle formation reconfiguration control system based on ADP and obstacle avoidance mechanism
CN117111629A (en) * 2023-07-26 2023-11-24 中国人民解放军陆军工程大学 Fixed-time optimal control method for multiple UAVs based on adaptive dynamic programming

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107688295A (en) * 2017-08-29 2018-02-13 浙江工业大学 A kind of quadrotor finite time self-adaptation control method based on fast terminal sliding formwork
CN108388270A (en) * 2018-03-21 2018-08-10 天津大学 Cluster unmanned plane track posture cooperative control method towards security domain
CN109116736A (en) * 2018-09-19 2019-01-01 南京航空航天大学 The fault tolerant control method of linear multi-agent system actuator failures based on sliding formwork
US20190311634A1 (en) * 2018-04-05 2019-10-10 Ge Aviation Systems Llc Efficient Flight Profiles with Multiple RTA Constraints
CN110488606A (en) * 2019-07-25 2019-11-22 中北大学 A kind of more quadrotor master-slave mode guaranteed cost nerve self-adapting synergizing formation control methods
US20200198657A1 (en) * 2018-12-21 2020-06-25 Robert Bosch Gmbh Method for controlling an automated or autonomous locomotive device, and evaluation unit
CN111766899A (en) * 2020-08-11 2020-10-13 北京航空航天大学 An anti-jamming formation control method for quadrotor UAV swarm based on jamming observer

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107688295A (en) * 2017-08-29 2018-02-13 浙江工业大学 A kind of quadrotor finite time self-adaptation control method based on fast terminal sliding formwork
CN108388270A (en) * 2018-03-21 2018-08-10 天津大学 Cluster unmanned plane track posture cooperative control method towards security domain
US20190311634A1 (en) * 2018-04-05 2019-10-10 Ge Aviation Systems Llc Efficient Flight Profiles with Multiple RTA Constraints
CN109116736A (en) * 2018-09-19 2019-01-01 南京航空航天大学 The fault tolerant control method of linear multi-agent system actuator failures based on sliding formwork
US20200198657A1 (en) * 2018-12-21 2020-06-25 Robert Bosch Gmbh Method for controlling an automated or autonomous locomotive device, and evaluation unit
CN110488606A (en) * 2019-07-25 2019-11-22 中北大学 A kind of more quadrotor master-slave mode guaranteed cost nerve self-adapting synergizing formation control methods
CN111766899A (en) * 2020-08-11 2020-10-13 北京航空航天大学 An anti-jamming formation control method for quadrotor UAV swarm based on jamming observer

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
ILLE M, ET AL.: "\"Collision avoidance between multi-UAV systems considering formation control using MPC\"", 《IEEE INTERNATIONAL CONFERENCE ON ADVANCED INTELLIGENT MECHATRONICS》 *
刘富春 等: ""小型无人直升机的模型预测控制算法研究"", 《控制理论与应用》 *
戴姣: ""无人机编队的自适应最优协同容错控制律研究"", 《中国优秀硕士学位论文全文数据库(电子期刊)》 *
窦立谦 等: ""基于状态观测器的多无人机编队跟踪控制"", 《天津大学学报(自然科学与工程技术版)》 *
雷明 等: ""具有输入约束和通信时滞的多智能体编队鲁棒镇定"", 《战术导弹技术》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113885548A (en) * 2021-10-28 2022-01-04 南京邮电大学 Many four rotor unmanned aerial vehicle output restraint state unanimous game controller
CN113885548B (en) * 2021-10-28 2023-10-31 南京邮电大学 A multi-quadrotor UAV output constrained state consistent game controller
CN114415734A (en) * 2022-03-31 2022-04-29 天津大学 Four-rotor unmanned aerial vehicle formation reconfiguration control system based on ADP and obstacle avoidance mechanism
CN117111629A (en) * 2023-07-26 2023-11-24 中国人民解放军陆军工程大学 Fixed-time optimal control method for multiple UAVs based on adaptive dynamic programming
CN117111629B (en) * 2023-07-26 2024-05-28 中国人民解放军陆军工程大学 Multi-unmanned aerial vehicle fixed time optimal control method based on self-adaptive dynamic programming

Also Published As

Publication number Publication date
CN112859913B (en) 2023-06-06

Similar Documents

Publication Publication Date Title
CN108388270B (en) Coordinated control method of swarm UAV trajectory and attitude for safety domain
CN109240331B (en) Unmanned aerial vehicle-unmanned vehicle cluster model time-varying formation control method and system
Yan et al. Consensus formation tracking for multiple AUV systems using distributed bioinspired sliding mode control
CN113342037B (en) Multi-rotor unmanned aerial vehicle time-varying formation control method and system with input saturation
CN112925346A (en) High-rise fire-fighting multi-unmanned aerial vehicle fault-tolerant control method and system based on man-in-the-loop
CN112859913A (en) Multi-quad-rotor unmanned aerial vehicle attitude consistency optimal control method considering output constraint
CN111638726A (en) Event trigger communication-based multi-unmanned aerial vehicle formation consistency control method
CN107422741B (en) Learning-based cluster flight distributed attitude tracking control method for preserving preset performance
CN112631335B (en) Event triggering-based multi-quad-rotor unmanned aerial vehicle fixed time formation method
CN113885549B (en) Quadrotor attitude trajectory control method based on dimensionally clipped PPO algorithm
CN118244799B (en) A UAV formation coordination control method
CN114138010B (en) A multi-agent high-order sliding mode formation control method based on weighted bias
Yang et al. Leader-follower formation consensus of quadrotor UAVs based on prescribed performance adaptive constrained backstepping control
CN112947086B (en) Self-adaptive compensation method for actuator faults in formation control of heterogeneous multi-agent system consisting of unmanned aerial vehicle and unmanned vehicle
CN107703953B (en) A UAV attitude control method, device, UAV and storage medium
CN114610072A (en) Distributed time-varying formation tracking control method and system for unmanned aerial vehicle cluster system
CN112379596B (en) RBF neural network-based cooperative fault-tolerant control method for heterogeneous multi-agent system
CN115639830A (en) Air-ground intelligent agent cooperative formation control system and formation control method thereof
CN116483124A (en) Anti-interference four-rotor unmanned aerial vehicle formation control method for wireless speed measurement
CN114415734B (en) Four-rotor unmanned aerial vehicle formation reconfiguration control system based on ADP and obstacle avoidance mechanism
CN112650290A (en) High-rise fire-fighting unmanned aerial vehicle formation optimization control method and system with disturbance compensation
CN113110593B (en) Flight formation cooperative self-adaptive control method based on virtual structure and estimation information transmission
CN112764426A (en) Internal model anti-interference control method of quad-rotor unmanned aerial vehicle system
CN117250980A (en) Multi-unmanned aerial vehicle formation control method based on switching event triggering technology
CN118259594A (en) Unmanned helicopter fixed time track tracking switching control method

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