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 PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000006870 function Effects 0.000 claims description 36
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000004891 communication Methods 0.000 claims description 10
- 230000003044 adaptive effect Effects 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 8
- 238000013528 artificial neural network Methods 0.000 claims description 6
- 238000011156 evaluation Methods 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 6
- 230000015572 biosynthetic process Effects 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 abstract description 5
- 238000006243 chemical reaction Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000005755 formation reaction Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000005457 optimization Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 210000002569 neuron Anatomy 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine 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
Description
技术领域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:
其中,Θi=[φi,θi,ψi]T表示机体坐标系中的欧拉角,且φi,θi,ψi分别表示四旋翼无人机姿态中的滚转角、俯仰角和偏航角;Ωi=[ωix,ωiy,ωiz]T表示角速度矢量,ωix,ωiy,ωiz分别表示滚转角速度、俯仰角速度与偏航角速度;Ii=diag(Iix,Iiy,Iiz)表示正定惯性矩阵;Mi=[uiφ,uiθ,uiψ]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 =[ω ix ,ω iy ,ω iz ] 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 iφ , u iθ , u iψ ] 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:
进一步地,所述将建模得到的方程模型转化为带有约束的状态方程,其状态方程表示如下:Further, the equation model obtained by modeling is transformed into a state equation with constraints, and its state equation is expressed as follows:
yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T
其中,in,
g(xi)=diag[1/Iix,1/Iiy,1/Iiz];g(x i )=diag[1/I ix , 1/I iy , 1/I iz ];
ui=[uiφuiθuiψ]T;xi=[xi1,xi2,xi3,xi4,xi5,xi6]T u i =[u iφ u iθ u iψ ] 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,且需满足 Here, x i1 =φ i , x i2 =ω ix , x i3 =θ i , x i4 =ω iy , x i5 =ψ i , x i6 =ω iz , and it is necessary to satisfy
进一步地,所述确定多四旋翼无人机的通信拓扑结构包括如下步骤: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中节点的集合,表示图中有向边的集合,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 , 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},其中假设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 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:
其中, in,
进一步地,所述针对无约束的状态方程,确定协同一致性误差以及性能指标函数如下: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
其中,sd为所需跟踪的领机期望轨迹。Among them, s d is the desired trajectory of the leader to be tracked.
定义性能指标函数为Define the performance indicator function as
其中, in,
进一步地,所述确定分布式哈密顿-雅克比-贝尔曼方程包括: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
图3为本公开实施例一中所述的滚转角跟踪效果图;3 is an effect diagram of the roll angle tracking described in
图4为本公开实施例一中所述的俯仰角跟踪效果图;FIG. 4 is an effect diagram of the pitch angle tracking described in
图5为本公开实施例一中所述的偏航角角跟踪效果图。FIG. 5 is an effect diagram of the yaw angle tracking described in
具体实施方式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:
其中,Θi=[φi,θi,ψi]T表示机体坐标系中的欧拉角,且φi,θi,ψi分别表示四旋翼无人机姿态中的滚转角、俯仰角和偏航角;Ωi=[wix,wiy,wiz]T表示角速度矢量,wix,wiy,wiz分别表示滚转角速度、俯仰角速度与偏航角速度;Ii=diag(Iix,Iiy,Iiz)表示正定惯性矩阵。Mi=[uiφ,uiθ,uiψ]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 iφ , u iθ , u iψ ] T represents the rotational torque input by the attitude angle of the quadrotor UAV.
转换矩阵transformation matrix
那么,四旋翼无人机模型可进一步表示为Then, the quadrotor UAV model can be further expressed as
其中,姿态角φi,θi,ψi需满足 Among them, the attitude angles φ i , θ i , ψ i need to satisfy
本实施例的控制目标为,多四旋翼无人机姿态系统的输出能以最优的方式跟踪给定的信号,同时性能指标函数最小,保证系统所有的信号都是一致最终有界的。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 i1 =φ i , x i2 =ω ix , x i3 =θ i , x i4 =ω iy , x i5 =ψ i , x i6 =ω iz . Therefore, the state space of the quadrotor UAV attitude system is expressed as
yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T
其中,yi为系统输出且需满足 Among them, y i is the system output and needs to meet the
将四旋翼无人机姿态动力学模型写成如下紧凑结构Write the quadrotor UAV attitude dynamics model as the following compact structure
yi=[xi1,xi3,xi5]T y i =[x i1 ,x i3 ,x i5 ] T
其中,in,
g(xi)=diag[1/Iix,1/Iiy,1/Iiz];g(x i )=diag[1/I ix , 1/I iy , 1/I iz ];
ui=[uiφuiθuiψ]T;xi=[xi1,xi2,xi3,xi4,xi5,xi6]T u i =[u iφ u iθ u iψ ] 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中节点的集合,表示图中有向边的集合,A=[aij]∈Rn×n表示有向图G的权重矩阵;Among them, V={0,1,...,N-1} represents the set of nodes in the graph G, 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},其中假设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 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:
其中, in,
那么转换后无输出约束的系统动态为Then the system dynamics without output constraints after transformation is
其中,si=[si1,si2,si3,si4,si5,si6]T,Among them, s i =[s i1 ,s i2 ,s i3 ,s i4 ,s i5 ,s i6 ] T ,
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
其中,sd为所需跟踪的领机期望轨迹。Among them, s d is the desired trajectory of the leader to be tracked.
定义性能指标函数为Define the performance indicator function as
其中, in,
S6:推导出分布式哈密顿-雅克比-贝尔曼方程如下:S6: Derive the distributed Hamilton-Jacobi-Bellman equation as follows:
哈密顿函数可定义为The Hamiltonian function can be defined as
最优性能指标函数可表示成如下形式The optimal performance index function can be expressed in the following form
其中,U(Ω)为允许控制的集合。Among them, U(Ω) is the set of allowed control.
根据Bellman的最优性原理,由可以得到分布式最优协同控制律如下:According to Bellman's principle of optimality, by The distributed optimal cooperative control law can be obtained as follows:
将最优协同控制律代入哈密顿函数,相应的分布式哈密顿-雅克比-贝尔曼方程为Substituting the optimal cooperative control law into the Hamiltonian function, the corresponding distributed Hamiltonian-Jacobi-Bellman equation is
注意到哈密顿-雅克比-贝尔曼方程难以获得其解析解,为了克服这个问题,采用单网络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
其中,wci∈Rl代表理想权值向量,σi(δi)∈Rl代表激励函数,l是隐藏层神经元的个数。εci(δi)表示神经网络的近似误差。其近似值为 表示理想权重向量wci的估计值。Among them, w ci ∈ R l represents the ideal weight vector, σ i (δ i )∈R l represents the excitation function, and l is the number of neurons in the hidden layer. ε ci (δ i ) represents the approximation error of the neural network. Its approximation is represents an estimate of the ideal weight vector wci .
则实际的分布式最优姿态控制律ui为Then the actual distributed optimal attitude control law u i is
设计评价网络权重更新律如下The weight update law of the design evaluation network is as follows
其中,λi表示学习率,是一个合适的正常数。 where λ i represents the learning rate and is a suitable constant.
为了证实本实施例的有效性,下面进行仿真实验: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。姿态角受限参数选为 各四旋翼无人机姿态初始值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 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]T。s 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
对其求时间导数,可得那么根据李雅普诺夫稳定性定理,神经网络权值误差和协同一致性误差δi都是一致最终有界的,即神经网络权重可以收敛到理想值,以及所有僚机的姿态角可以和领机的姿态角达到一致。 Taking the time derivative of it, we get Then according to the Lyapunov stability theorem, the weight error of the neural network 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)
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)
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)
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 |
-
2021
- 2021-01-13 CN CN202110043323.9A patent/CN112859913B/en active Active
Patent Citations (7)
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)
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)
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 |