CN109947134B - Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control - Google Patents

Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control Download PDF

Info

Publication number
CN109947134B
CN109947134B CN201910358576.8A CN201910358576A CN109947134B CN 109947134 B CN109947134 B CN 109947134B CN 201910358576 A CN201910358576 A CN 201910358576A CN 109947134 B CN109947134 B CN 109947134B
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
quad
rotor
formation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910358576.8A
Other languages
Chinese (zh)
Other versions
CN109947134A (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.)
Nanjing University of Posts and Telecommunications
Original Assignee
Nanjing University of Posts and Telecommunications
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 Nanjing University of Posts and Telecommunications filed Critical Nanjing University of Posts and Telecommunications
Priority to CN201910358576.8A priority Critical patent/CN109947134B/en
Publication of CN109947134A publication Critical patent/CN109947134A/en
Application granted granted Critical
Publication of CN109947134B publication Critical patent/CN109947134B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control, which comprises the steps of firstly, constructing a fault power model of a plurality of four-rotor unmanned aerial vehicles; then a first sliding mode distributed formation controller and a second sliding mode formation controller are constructed based on the normal formation process of the quad-rotor unmanned aerial vehicle, the position and the posture of the quad-rotor unmanned aerial vehicle under the normal formation condition are respectively controlled, and formation flying of the quad-rotor unmanned aerial vehicle according to a set track is realized; finally, a state observer is constructed, whether a fault occurs or not is judged according to the residual error between the observed result and the actual result in the formation process through the state observer, and if the fault occurs, a self-adaptive distributed sliding mode formation controller is designed to control each quad-rotor unmanned aerial vehicle to form a formation according to a set track; otherwise, continuing to control through the first sliding mode distributed formation controller and the second sliding mode formation controller; the invention can stably control formation of the four-rotor unmanned aerial vehicle.

Description

Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control
Technical Field
The invention belongs to the technical field of unmanned aerial vehicle control, and particularly relates to formation fault-tolerant control of multi-quad-rotor unmanned aerial vehicles, in particular to a quad-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control.
Background
The requirement of formation flight of unmanned aerial vehicle to unmanned aerial vehicle's reliability and security is higher, and unmanned aerial vehicle's trouble generally divide into executor trouble and sensor trouble. Fault tolerant control can be used to solve these problems, and the methods of fault tolerant control are classified into active fault tolerance and passive fault tolerance. The passive control fault-tolerant method has robustness and is insensitive to faults, active fault tolerance can actively carry out fault tolerance on the faults, and the aim of fault tolerance is achieved by readjusting parameters or structures of a controller.
The self-adaptive fault-tolerant control method is an active fault-tolerant method, estimates faults by designing a self-adaptive law, can automatically adjust control parameters or system parameters according to the change of transformation parameters of an external environment, and ensures the stability of the system.
The existing unmanned aerial vehicle formation considers each unmanned aerial vehicle as a particle to study, considers each unmanned aerial vehicle as a multi-agent, only considers the formation of a two-dimensional plane, does not break away from the framework of the formation of the multi-agent, does not control the self angle of the unmanned aerial vehicle, and has no practical physical significance.
The existing control to the four-rotor formation unmanned aerial vehicle when the fault occurs only can ensure that the speed is not changed, but the position is changed.
Disclosure of Invention
Aiming at the problem that the position and the speed of a quad-rotor unmanned aerial vehicle cannot be controlled simultaneously when the quad-rotor unmanned aerial vehicle fails in the prior art, the method for fault tolerance of the formation of the quad-rotor unmanned aerial vehicle based on multi-unmanned aerial vehicle distributed control is provided, firstly, the position and attitude control law of a quad-rotor unmanned aerial vehicle system under normal conditions is designed, then, a state observer is used for fault detection, whether the quad-rotor unmanned aerial vehicle fails in the formation process is judged, when the quad-rotor unmanned aerial vehicle fails, the self-adaptive sliding mode distributed control method is used in the quad-rotor formation, and the fault is estimated through self-adaptation, so that the fault tolerance control of the formation is realized; the model of the four rotors is under-actuated, the attitude of the unmanned aerial vehicle needs to be considered in the formation control of the four rotors and the formation control of the multi-agent, and the self-adaptive sliding mode distributed formation control law of the multi-unmanned aerial vehicle is designed, so that the self-adaptive sliding mode distributed formation of the four-rotor unmanned aerial vehicle is realized; considering that the four-rotor fault type is actuator partial failure fault, the adaptive sliding mode formation controller is designed to realize fault tolerance.
The invention adopts the following technical scheme for solving the technical problems:
a four-rotor drone formation fault-tolerant method based on multi-drone distributed control, the method comprising:
s1, constructing a fault power model of the multi-quad-rotor unmanned aerial vehicle:
Figure GDA0003575126730000021
wherein the content of the first and second substances,
Figure GDA0003575126730000022
θiithe roll angle, the pitch angle and the yaw angle of the ith four-rotor unmanned aerial vehicle are respectively; x is the number ofi,yi,ziPosition coordinates of the ith quad-rotor unmanned aerial vehicle centroid; l is the distance from the rotor tip to the rotor nose; m is the mass of a quad-rotor drone, I is the moment of inertia of each axis, KiIs the coefficient of resistance, σiAs a failure factor (0 < sigma)i≤1);
S2, designing a first sliding mode distributed controller of the four-rotor unmanned aerial vehicle formation process normal alignment position subsystem:
Figure GDA0003575126730000023
wherein, k is more than 0,
Figure GDA0003575126730000024
Pi=[xi yi zi]Ts is the slip form face, aijIs the connectivity between quad-rotor drone i and quad-rotor drone j, i ═ 0,1,2,3,4, j (j ═ 0,1,2,3,4), and to the second sliding mode controller of the attitude subsystem:
Figure GDA0003575126730000025
wherein k is greater than 0, c1>0,c2>0,c3>0;
S3, designing a state observer and a threshold, observing position faults of the quad-rotor unmanned aerial vehicle by the state observer, calculating residual errors between actual fault outputs of the quad-rotor unmanned aerial vehicle and observed fault outputs of the state observer, comparing the residual errors with the threshold, if the residual errors are larger than the threshold, judging that the corresponding quad-rotor unmanned aerial vehicle has faults, and turning to the step S4; otherwise, the first sliding mode distributed controller and the second sliding mode controller are adopted to control formation of the quad-rotor unmanned aerial vehicle;
s4, when the quad-rotor unmanned aerial vehicle breaks down, constructing a self-adaptive distributed sliding mode controller for the position subsystem:
Figure GDA0003575126730000031
wherein, k is more than 0,
Figure GDA0003575126730000032
γ>0,Pi=[xi yi zi]T,aijis the connectivity between quad-rotor drone i and quad-rotor drone j.
Further, the residual error is obtained by subtracting the actual fault output from the output of the state observer for the position fault observation of the quad-rotor unmanned aerial vehicle.
Further, the model of the location subsystem is:
Figure GDA0003575126730000033
wherein:
Figure GDA0003575126730000034
the attitude subsystem model is as follows:
Figure GDA0003575126730000035
Figure GDA0003575126730000036
Figure GDA0003575126730000037
the invention relates to a four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control, which comprises the steps of firstly constructing a fault model of a plurality of four-rotor unmanned aerial vehicles, dividing the fault model into a position subsystem and a posture subsystem, respectively constructing sliding mode distributed controllers for the position subsystem and the posture subsystem, and carrying out formation control operation of a preset track on the four-rotor unmanned aerial vehicles under the condition of no fault; meanwhile, a state observer is arranged to observe the state of the quad-rotor unmanned aerial vehicle in real time, the output of the state observer and the fault output of the corresponding quad-rotor unmanned aerial vehicle obtained through actual measurement are subtracted to obtain a residual error, the residual error is compared with a set threshold value, and if the residual error is larger than the set threshold value, the fact that the corresponding quad-rotor unmanned aerial vehicle forms a fault is judged, so that an adaptive sliding mode distributed controller is designed to control the formation of the quad-rotor unmanned aerial vehicle, and the formation is guaranteed according to a preset track; compared with the prior art, the method has the advantages that the position of the quad-rotor unmanned aerial vehicle is controlled, the speed and the distance between other individuals in the formation are controlled, fault detection is carried out through the observer, whether a fault occurs or not is judged, and the expected track formation and speed can still be recovered after the fault occurs through switching of the control rate.
Drawings
Fig. 1 is a block diagram illustrating a flow chart of an implementation of the four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control according to the embodiment of the present invention;
fig. 2 is a schematic diagram of a communication diagram when four drones are included in the embodiment of the present invention;
fig. 3 is a schematic diagram of relative positions of the drones when four drones are included in the embodiment of the present invention;
FIG. 4 is a schematic diagram of a control schematic of the adaptive sliding mode distribution controller according to an embodiment of the present invention;
fig. 5(a) and 5(b) are schematic diagrams illustrating speed tracking of the quad-rotor drone in an embodiment of the invention;
fig. 6(a) and 6(b) are schematic diagrams of attitude tracking of the quad-rotor drone in an embodiment of the present invention;
fig. 7 is a schematic xoy plan projection view of formation of quad-rotor drones under adaptive sliding mode distributed control according to an embodiment of the present invention;
fig. 8 is a schematic representation of a xoz plan view of formation of quad-rotor drones under adaptive sliding mode distributed control in accordance with an embodiment of the present invention;
fig. 9 is a schematic projection view of a yoz plane of a formation of quad-rotor unmanned aerial vehicles under adaptive sliding mode distributed control according to an embodiment of the invention;
fig. 10 is a schematic diagram of a self-adaptive sliding mode distributed three-dimensional formation of the quad-rotor unmanned aerial vehicle without failure according to the embodiment of the invention;
fig. 11 is a schematic diagram of a self-adaptive sliding mode distributed three-dimensional formation of a quad-rotor unmanned aerial vehicle with no fault and fault tolerance in the embodiment of the invention;
FIG. 12 is a schematic representation of a residual signal diagram of the state observer in an embodiment of the present invention;
fig. 13 is a schematic diagram of a three-dimensional fault-tolerant formation under adaptive sliding mode distributed control of a quad-rotor unmanned aerial vehicle according to an embodiment of the invention;
fig. 14 is a schematic diagram illustrating formation of quad-rotor unmanned aerial vehicles according to an embodiment of the invention.
Detailed Description
In order to make the technical solutions of the present invention better understood, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention.
In an embodiment of the present invention, a four-rotor drone formation fault tolerance method based on multi-drone distributed control is provided, and referring to fig. 1, the method specifically includes the following steps:
s1, constructing a fault power model of the multi-quad-rotor unmanned aerial vehicle:
Figure GDA0003575126730000051
wherein the content of the first and second substances,
Figure GDA0003575126730000052
θiithe roll angle, the pitch angle and the yaw angle of the ith four-rotor unmanned aerial vehicle are respectively; x is the number ofi,yi,ziPosition coordinates of the ith quad-rotor unmanned aerial vehicle centroid; l is the distance from the rotor tip to the rotor nose; m is the mass of a quad-rotor drone, I is the moment of inertia of each axis, KiIs a coefficient of resistance, σiAs a failure factor (0 < sigma)i≤1);
In the embodiment, a formation control law is designed for a position subsystem of a fault dynamic model to ensure an expected formation, specifically, a quadrotor unmanned aerial vehicle is arranged in a plurality of quadrotor unmanned aerial vehicles to serve as a virtual leader, the speed of each quadrotor unmanned aerial vehicle and the distance between each quadrotor unmanned aerial vehicle and the virtual leader are set in the formation process, and the virtual leader is assumed to realize the tracking of an expected position; thereby realizing the position tracking of the whole formation.
Referring to fig. 2, which is an illustration, in particular, for the case that the multi-quad-rotor drone includes two communication topologies, where 0 represents a virtual leader, and 1,2,3, and 4 represent four quad-rotor drone followers, respectively.
With reference to fig. 4, in the embodiment of the present invention, the fault power model is divided into a position subsystem and an attitude subsystem; wherein, the model of the fault subsystem is as follows:
Figure GDA0003575126730000053
wherein:
Figure GDA0003575126730000054
therefore, the constructed fault power model can be expressed by the following formula:
Figure GDA0003575126730000055
wherein 0 < sigmaiLess than or equal to 1, when sigma isiWhen 1, the ith four-rotor unmanned aerial vehicle actuator is normal, and when 0 is less than sigmai< 1 indicates that the actuator portion of the ith quad-rotor drone failed.
Then, by the formula
Figure GDA0003575126730000061
Solving to obtain the attitude angle of the quad-rotor unmanned aerial vehicle:
Figure GDA0003575126730000062
and the attitude subsystem model with a quad-rotor unmanned aerial vehicle is as follows:
Figure GDA0003575126730000063
Figure GDA0003575126730000064
Figure GDA0003575126730000065
the attitude model of the quad-rotor drone can be modified to the following form:
Figure GDA0003575126730000066
wherein
Figure GDA0003575126730000067
Uir=[u2,u3,u4]T
S2, designing a first sliding mode distributed controller of a position subsystem in a normal formation process of the quad-rotor unmanned aerial vehicle:
Figure GDA0003575126730000068
wherein, k is more than 0,
Figure GDA0003575126730000069
Pi=[xi yi zi]Ts is the slip form face, aijIs the connectivity between quad-rotor drone i and quad-rotor drone j, i ═ 0,1,2,3,4, j (j ═ 0,1,2,3,4) and to the second sliding mode controller of the attitude subsystem:
Figure GDA00035751267300000610
wherein k is greater than 0, c1>0,c2>0,c3>0。
In particular, in the present invention, P is usediThe actual position of the ith unmanned aerial vehicle is shown, and the expected position relation between any two quadrotor unmanned aerial vehicles i and j is Pdi-PdjThe speed of the ith quad-rotor unmanned aerial vehicle is Vi=[Vix,Viy,Viz]TThen the velocity tracking error is
Figure GDA00035751267300000611
The control target is
Figure GDA00035751267300000612
Pi-Pj→Pdi-Pdj=PdijThe position control aims to keep the position and the attitude of the quad-rotor unmanned aerial vehicle consistent; preferably, the invention enables four-rotor unmanned aircraftThe slip form surface for aircraft flight is defined as:
Figure GDA0003575126730000071
further, there can be obtained:
Figure GDA0003575126730000072
the first sliding mode distributed controller is thus obtained as:
Figure GDA0003575126730000073
the second sliding mode controller is as follows:
Figure GDA0003575126730000074
s3, designing a state observer and a threshold, observing position faults of the quad-rotor unmanned aerial vehicle by the state observer, calculating a residual error between actual fault output of the quad-rotor unmanned aerial vehicle and observed fault output of the state observer, comparing the residual error with the threshold, if the residual error is greater than the threshold, judging that the corresponding quad-rotor unmanned aerial vehicle has faults, and turning to the step S4; otherwise, controlling formation of the quad-rotor unmanned aerial vehicle by adopting a first sliding mode distributed controller and a second sliding mode controller; specifically, further simplify four rotor unmanned aerial vehicle's trouble dynamic model into the form of state space:
Figure GDA0003575126730000075
wherein
Figure GDA0003575126730000076
Figure GDA0003575126730000077
In combination with the above-mentioned available state observer:
Figure GDA0003575126730000078
particularly, when the system fails, the state of the system changes, and whether the four rotors fail or not can be judged by taking the difference obtained by subtracting the output of the state observer from the actual output as a residual signal; at this time, the state observer can detect the time when the four-rotor drone fails, and the subsequent step S4 is performed to further obtain the actual failure occurrence position of the four-rotor drone.
S4, when the quad-rotor unmanned aerial vehicle breaks down, constructing an adaptive distributed sliding mode controller:
Figure GDA0003575126730000081
Figure GDA0003575126730000082
wherein, k is more than 0,
Figure GDA0003575126730000083
γ>0,Pi=[xi yi zi]T,aijis the connectivity between quad-rotor drone i and quad-rotor drone j.
In view of the definition of the sliding mode surface of the quadrotor unmanned aerial vehicle, a fault factor sigma can be obtainediIs estimated as
Figure GDA0003575126730000084
The error between the estimated value and the actual value can also be found as:
Figure GDA0003575126730000085
in order to obtain the self-adaptive distributed sliding mode controller, the invention firstly designs a Lyapunov function:
Figure GDA0003575126730000086
then, derivation of the Lyapunov function can be obtained:
Figure GDA0003575126730000087
finally, the obtained self-adaptive distributed sliding mode editing controller is as follows:
Figure GDA0003575126730000088
Figure GDA0003575126730000089
here, in order to better illustrate the effective control of the method of the present invention on the formation fault tolerance of the quad-rotor unmanned aerial vehicle, simulation is performed here to illustrate that:
set the position of the quad-rotor unmanned aerial vehicle as xd=3t,yd=2t,zd=2,vxd=3,vyd=2,v zd0; with reference to fig. 2, if it is assumed that the actuator of the quad-rotor unmanned aerial vehicle 1 does not have a fault in the first 15s and a partial failure fault of the actuator of 0.5 occurs in 15s, an expected speed position and a formation are initially given by the method of the present invention, then a fault power model is established for a plurality of quad-rotor unmanned aerial vehicles, and an adaptive sliding mode control law is designed for a position subsystem, so that the quad-rotor unmanned aerial vehicle realizes formation fault-tolerant flight. Referring to fig. 4, a structural diagram of a four-rotor adaptive sliding mode distributed formation control system according to the present invention includes four parts, namely a virtual pilot design position controller and an attitude controller, a position design formation controller for a multi-four-rotor unmanned aerial vehicle, and an attitude design attitude controller for an attitude.
Fig. 5 is a graph of the respective velocity tracking of two quad-rotor drones of the invention 1,2, and fig. 6 is a graph of the respective attitude tracking of the quad-rotors of the invention, wherein the dashed lines represent expected values and the solid lines actual values; FIG. 7 is a planar projection of a quad-rotor adaptive sliding mode distributed formation XOY; FIG. 8 is a projection view of an XOZ plane of a four-rotor adaptive sliding mode distributed formation; FIG. 9 is a projection view of a four-rotor adaptive sliding mode distributed formation YOZ plane; fig. 10 shows a failure-free four-rotor self-adaptive sliding mode distributed three-dimensional formation, and it can be seen that four-rotor unmanned aerial vehicles can rapidly form the formation from different starting points, and the relative positions of the formation are (20, 0), (0, 20), (-20, 0), (0, -20).
Fig. 11 is a no-controller switching diagram after a fault, without control of the quad-rotor formation position, which maintains the desired speed and formation but does not return to the desired position after the fault. Fig. 12 shows a residual signal estimated by the state observer, and it is determined that a failure has occurred when the residual exceeds a threshold. Fig. 13 is a diagram of a quad-rotor adaptive sliding mode distributed three-dimensional fault-tolerant formation, in which at 15s, a 0.5-actuator partial failure of the quad-rotor drone 1 fails, and other quad-rotors are normal, so that it can be seen that the formation of the failed drone can still return to the desired position and maintain the desired formation. Fig. 14 is a diagram of a quad-rotor adaptive sliding mode distributed formation, from which four quad-rotor drones are obtained, which are changed from relative positions (10, 10), (-10, 10), (-10 ), (10, -10) to (20, 0), (0, 20), (-20, 0), (0, -20). According to the invention, effective control can be realized through the self-adaptive sliding mode distributed controller when the quad-rotor unmanned aerial vehicle breaks down, the quad-rotor unmanned aerial vehicle is ensured to fly according to a set track, and formation fault-tolerant control operation is realized.
The invention relates to a four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control, which comprises the steps of firstly constructing a fault model of a plurality of four-rotor unmanned aerial vehicles, dividing the fault model into a position subsystem and an attitude subsystem, respectively constructing sliding mode distributed controllers for the position subsystem and the attitude subsystem, and performing formation control operation of a preset track on the four-rotor unmanned aerial vehicles without faults; meanwhile, a state observer is arranged to observe the state of the quad-rotor unmanned aerial vehicle in real time, the output of the state observer and the fault output of the corresponding quad-rotor unmanned aerial vehicle obtained through actual measurement are subtracted to obtain a residual error, the residual error is compared with a set threshold value, and if the residual error is larger than the set threshold value, the fact that the corresponding quad-rotor unmanned aerial vehicle forms a fault is judged, so that an adaptive sliding mode distributed controller is designed to control the formation of the quad-rotor unmanned aerial vehicle, and the formation is guaranteed according to a preset track; compared with the prior art, the method has the advantages that the position of the quad-rotor unmanned aerial vehicle is controlled, the speed and the distance between other individuals in the formation are controlled, fault detection is carried out through the observer, whether a fault occurs or not is judged, and the expected track formation and speed can still be recovered after the fault occurs through switching of the control rate.
Although the present invention has been described in detail with reference to the foregoing embodiments, it will be apparent to those skilled in the art that modifications may be made to the embodiments described in the foregoing detailed description, or equivalent changes may be made in some of the features of the embodiments described above. All equivalent structures made by using the contents of the specification and the attached drawings of the invention can be directly or indirectly applied to other related technical fields, and are also within the protection scope of the patent of the invention.

Claims (3)

1. Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control is characterized by comprising the following steps:
s1, constructing a fault power model of the multi-rotor unmanned aerial vehicle:
Figure FDA0003575126720000011
wherein the content of the first and second substances,
Figure FDA0003575126720000012
θiithe roll angle, the pitch angle and the yaw angle of the ith four-rotor unmanned aerial vehicle are respectively; x is the number ofi,yi,ziPosition coordinates of the ith quad-rotor unmanned aerial vehicle centroid; l is the distance from the rotor tip to the rotor nose; m is the mass of a quad-rotor drone, I is the moment of inertia of each axis, KiIs a coefficient of resistance, σiIs a failure factor, and 0 < sigmai≤1;
S2, designing a first sliding mode distributed controller of a position subsystem in the normal formation process of the quad-rotor unmanned aerial vehicle:
Figure FDA0003575126720000013
wherein, k is more than 0,
Figure FDA0003575126720000014
Pi=[xi yi zi]Ts is the slip form face, aijIs the connectivity between quad-rotor drone i and quad-rotor drone j, i ═ 0,1,2,3,4, j ═ 0,1,2,3,4, and to the second sliding mode controller of the attitude subsystem:
Figure FDA0003575126720000015
wherein k is greater than 0, c1>0,c2>0,c3>0;
S3, designing a state observer and a threshold value, observing position faults of the quad-rotor unmanned aerial vehicle by the state observer, calculating residual errors between actual fault outputs of the quad-rotor unmanned aerial vehicle and observed fault outputs of the state observer, comparing the residual errors with the threshold value, judging that the corresponding quad-rotor unmanned aerial vehicle has faults if the residual errors are larger than the threshold value, and turning to the step S4; otherwise, the first sliding mode distributed controller and the second sliding mode controller are adopted to control formation of the quad-rotor unmanned aerial vehicle;
s4, when the quad-rotor unmanned aerial vehicle breaks down, constructing a self-adaptive distributed sliding mode controller for the position subsystem:
Figure FDA0003575126720000021
wherein, k is more than 0,
Figure FDA0003575126720000022
γ>0,Pi=[xi yi zi]T,aijis the connectivity between quad-rotor drone i and quad-rotor drone j.
2. The method of claim 1, wherein the residual error is derived by subtracting the actual fault output from the state observer's output of a quad-rotor drone position fault observation.
3. The multi-drone distributed control based quad-rotor drone formation fault-tolerant method of claim 1, wherein the model of the location subsystem is:
Figure FDA0003575126720000023
wherein:
Figure FDA0003575126720000024
the attitude subsystem model is as follows:
Figure FDA0003575126720000025
CN201910358576.8A 2019-04-30 2019-04-30 Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control Active CN109947134B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910358576.8A CN109947134B (en) 2019-04-30 2019-04-30 Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910358576.8A CN109947134B (en) 2019-04-30 2019-04-30 Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control

Publications (2)

Publication Number Publication Date
CN109947134A CN109947134A (en) 2019-06-28
CN109947134B true CN109947134B (en) 2022-05-17

Family

ID=67016778

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910358576.8A Active CN109947134B (en) 2019-04-30 2019-04-30 Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control

Country Status (1)

Country Link
CN (1) CN109947134B (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110262557B (en) * 2019-07-16 2020-04-21 南京航空航天大学 Four-rotor formation finite time fault-tolerant control method based on sliding mode control technology
CN110262524B (en) * 2019-08-02 2022-04-01 大连海事大学 Design method of unmanned ship cluster optimal aggregation controller
CN110502027B (en) * 2019-09-16 2022-08-12 南京邮电大学 Four-rotor unmanned aerial vehicle attitude fault-tolerant control method based on self-adaptive terminal sliding mode
CN111240365A (en) * 2020-03-12 2020-06-05 北京航空航天大学 Unmanned aerial vehicle formation self-adaptive actuator fault compensation method with designated performance
CN111897358B (en) * 2020-07-30 2022-04-15 南京航空航天大学 Unmanned aerial vehicle formation fault-tolerant control method based on self-adaptive sliding mode
CN112034737A (en) * 2020-09-07 2020-12-04 中国航空工业集团公司成都飞机设计研究所 Simulation control system and control method for unmanned aerial vehicle multi-machine simulation training
CN112578804B (en) * 2020-12-16 2022-09-27 南京理工大学 Four-rotor aircraft formation sliding mode control method based on event trigger mechanism
CN112947086B (en) * 2021-03-09 2022-10-04 南京航空航天大学 Self-adaptive compensation method for actuator faults in formation control of heterogeneous multi-agent system consisting of unmanned aerial vehicle and unmanned vehicle
CN113204193B (en) * 2021-05-06 2022-10-25 北京航空航天大学 Fault-tolerant control method and device for aircraft and electronic equipment
CN113625744B (en) * 2021-06-29 2023-02-24 南京理工大学 Design method of anti-saturation fixed time cooperative guidance law for attacking high maneuvering target
CN114489142B (en) * 2022-03-28 2022-07-12 中山大学 Unmanned aerial vehicle formation control method based on self-adaptive sliding mode and related device
CN115629613B (en) * 2022-12-19 2023-04-04 北京卓翼智能科技有限公司 Formation fault-tolerant control method for multiple intelligent agents

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104965414A (en) * 2015-06-30 2015-10-07 天津大学 Tolerant control method for partial failure of four-rotor unmanned aerial vehicle actuator
CN105242544A (en) * 2015-10-30 2016-01-13 山东科技大学 Non-linear multi-unmanned-aerial-vehicle-system fault-tolerance formation control method with consideration of random disturbance
CN109343369A (en) * 2018-11-19 2019-02-15 南京邮电大学 A kind of quadrotor fault controller method based on nonlinear observer

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104965414A (en) * 2015-06-30 2015-10-07 天津大学 Tolerant control method for partial failure of four-rotor unmanned aerial vehicle actuator
CN105242544A (en) * 2015-10-30 2016-01-13 山东科技大学 Non-linear multi-unmanned-aerial-vehicle-system fault-tolerance formation control method with consideration of random disturbance
CN109343369A (en) * 2018-11-19 2019-02-15 南京邮电大学 A kind of quadrotor fault controller method based on nonlinear observer

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
Labbadi, Moussa et al..Modeling and Robust Integral Sliding Mode Control for a Quadrotor Unmanned Aerial Vehicle.《International Renewable and Sustainable Energy Conference IRSEC》.2018, *
Qian, Moshu et al..Fault tolerant control scheme design for the formation control system of unmanned aerial vehicles.《PROCEEDINGS OF THE INSTITUTION OF MECHANICAL ENGINEERS PART I-JOURNAL OF SYSTEMS AND CONTROL ENGINEERING》.2013,第227卷(第8期), *
Yu,Hang et al..Robust Integral Sliding Mode Controller for Quadrotor Flight.《CHINESE AUTOMATION CONGRESS》.2017, *
四旋翼飞行器容错控制研究;范佳明;《中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑)》;20170815(第8期);第43-59页 *

Also Published As

Publication number Publication date
CN109947134A (en) 2019-06-28

Similar Documents

Publication Publication Date Title
CN109947134B (en) Four-rotor unmanned aerial vehicle formation fault-tolerant method based on multi-unmanned aerial vehicle distributed control
CN111948944B (en) Four-rotor formation fault-tolerant control method based on adaptive neural network
CN108445760A (en) The quadrotor drone fault tolerant control method of observer is estimated based on adaptive failure
CN109343369B (en) Design method of four-rotor fault-tolerant controller based on non-linear observer
CN110262557B (en) Four-rotor formation finite time fault-tolerant control method based on sliding mode control technology
Bateman et al. Fault diagnosis and fault-tolerant control strategy for the aerosonde UAV
CN110502027B (en) Four-rotor unmanned aerial vehicle attitude fault-tolerant control method based on self-adaptive terminal sliding mode
Jourdan et al. Enhancing UAV survivability through damage tolerant control
CN104102225A (en) Unmanned aircraft posture decentralized fault-tolerant control method based on actuator dynamic state
CN110888451A (en) Fault-tolerant control method and system for multi-rotor unmanned aerial vehicle
CN113342037A (en) Multi-rotor unmanned aerial vehicle time-varying formation control method and system with input saturation function
CN112068598A (en) Unmanned aerial vehicle formation flying method and control system
CN113342033B (en) Fixed time technology-based attitude synchronization fault-tolerant control method for fixed-wing unmanned aerial vehicle
Wang et al. Guidance, navigation and control of an unmanned helicopter for automatic cargo transportation
CN114326781B (en) Fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller
Asadi Partial engine fault detection and control of a Quadrotor considering model uncertainty
CN115657730A (en) Robust clustering formation control method for large-scale multi-rotor unmanned aerial vehicle
CN111806728B (en) Spacecraft multi-agent attitude synchronization fault-tolerant control method with actuator saturation
CN116185057B (en) Attitude fault-tolerant control method for wing body fusion flying unmanned aerial vehicle
Nemati et al. Stability and control of tilting-rotor quadcopter in case of a propeller failure
Stepaniak et al. MMAE-based control redistribution applied to the VISTA F-16
CN110162084B (en) Formation control method of flying missile cluster system based on consistency theory
CN115857544A (en) Unmanned aerial vehicle cluster formation flight control method, device and equipment
Perhinschi et al. Modeling and simulation of failures for primary control surfaces
Sørensen et al. UAV fault-tolerant control by combined L 1 adaptive backstepping and fault-dependent control allocation

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