CN114326781A - Fully-distributed missile formation cooperative self-adaptive fault-tolerant compensation controller - Google Patents

Fully-distributed missile formation cooperative self-adaptive fault-tolerant compensation controller Download PDF

Info

Publication number
CN114326781A
CN114326781A CN202111240320.0A CN202111240320A CN114326781A CN 114326781 A CN114326781 A CN 114326781A CN 202111240320 A CN202111240320 A CN 202111240320A CN 114326781 A CN114326781 A CN 114326781A
Authority
CN
China
Prior art keywords
missile
formation
representing
flight
fault
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
CN202111240320.0A
Other languages
Chinese (zh)
Other versions
CN114326781B (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.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Publication of CN114326781A publication Critical patent/CN114326781A/en
Application granted granted Critical
Publication of CN114326781B publication Critical patent/CN114326781B/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 fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller, which comprises the following construction steps: firstly, establishing a motion model of missile formation in an actuator fault mode; then, constructing a directed communication topological structure diagram of the missile formation system, obtaining an adjacent matrix and a communication matrix according to the directed diagram, and determining a formation communication mode; and finally, constructing a fully distributed self-adaptive fault-tolerant control law according to a motion model of missile formation under the fault condition, thereby realizing expected formation flight. The fault-tolerant compensator realizes expected formation flight of guided missile formation under the conditions that a plurality of guided missiles simultaneously have faults and various uncertainties and external environment disturbance, and can remarkably improve the reliability and the anti-interference capability of guided missile formation flight.

Description

Fully-distributed missile formation cooperative self-adaptive fault-tolerant compensation controller
Technical Field
The invention relates to the technical field of missile formation control, in particular to an auxiliary module added in a fault-tolerant control module for missile formation cooperative control, namely a fully-distributed missile formation cooperative self-adaptive fault-tolerant compensation controller.
Background
Formation control of multi-agent systems is receiving increasing attention from multiple scientific fields, and a group of multi-agents performing formation cooperative tasks can complete complex tasks which cannot be completed by a single agent. Compared with a single missile, the cooperative formation of a plurality of missiles is more easily affected by actuator faults under complex flight conditions, so that the performance is reduced, and even disasters are caused. Therefore, it is necessary to research a fault-tolerant formation control scheme of a multi-agent formation system to ensure reliable and safe operation of the system.
The cooperative operation of a plurality of missiles is a main operation mode of a future missile weapon system, and is an important way for reducing operation cost, improving task implementation reliability and enhancing comprehensive operation efficiency of weapons. The multiple missiles can effectively improve the stealth effect of part of missiles by utilizing the cooperative technology, so that the integral defense capability is improved. Moreover, by the advantages of coordination and performance complementation, the uncertainty and the limitation of a single sensor can be overcome, and the target tracking precision of the guided missile guiding section is improved. However, missile weapons systems are extremely complex systems that, even if a tiny component fails, may render the entire system incapable of performing combat missions and even result in the death of a missile. Therefore, how to realize the effective control flight of the missile in an unpredictable and variable environment, the safety of the missile is enhanced, the running cost is reduced, the reliability and the fault tolerance of the system are improved, and the missile becomes a research hotspot in the field of unmanned aerial vehicles.
The system structure of the missile autonomous formation cooperative guidance control system is introduced on page 50 of a missile autonomous formation cooperative guidance control technology published in 9 th edition in 2015, Wusentang, and 1 st edition. Referring to fig. 1, the system comprises an information acquisition system, a formation decision and management system, a formation flight control system, a member flight control system and a formation support network system. Page 55 introduces the formation control function of missile formation, which means that the formation is controlled and kept to stably fly as required in the specified flight process according to the air route planning/cooperative guidance instruction under the scheduling of the departure and entry management module, and the functional structure is shown in fig. 2.
In the prior art, many methods are not completely distributed, a designed controller needs a communication matrix of the whole system, and the designed controller cannot be completely distributed, and because the space distribution of the groups of bullets and the distance between signal receiving/transmitters are limited, the communication between information is not smooth, even the groups of bullets can be crashed, and thus the task fails.
The existing unmanned aerial vehicle formation fault-tolerant control method adopts a disturbance observer-based technology to estimate the fault of a executor, but because of the amplification of factors such as modeling errors, external disturbance and parameter uncertainty, the control gain becomes very large, so that the system is unstable, and the method is difficult to be applied to actual missile formation.
The existing missile formation fault-tolerant control method is based on a linear model linear type, environmental disturbance and uncertainty factors are not considered, and only a single missile is considered to have a fault in a fault mode. The methods cannot simultaneously solve the formation control problem of the missile formation system under the conditions of various uncertainties, external environment interference and simultaneous actuator faults of a plurality of missiles, so that the method has no practical physical significance.
Therefore, a new fully distributed fault-tolerant formation control method is needed to be provided to realize fault-tolerant formation control of missile formation under the conditions that multiple missile actuator faults and multiple uncertainties and external environment interferences occur simultaneously.
Disclosure of Invention
The invention discloses a fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller, and aims to provide a self-adaptive fault-tolerant control method for fully distributed missile formation so as to ensure that the missile formation can realize expected safe and stable flight under the conditions that a plurality of missiles simultaneously have actuator faults and various uncertainties and external environment disturbance exist.
The fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller is stored in a fault-tolerant control module and is an auxiliary compensation for a traditional missile autonomous formation cooperative guidance control algorithm.
The invention relates to a fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller, which is implemented by utilizing missile motion parameters in an autonomous missile formation cooperative guidance control algorithm; the method is characterized by comprising six construction steps:
step 1, extracting a missile formation motion model from a formation flight control module;
according to the missile formation information in the formation flight control module, the obtained missile formation motion model is
Figure BDA0003319241710000031
Step 2, correcting a missile formation motion model by using an interference source in the formation cooperative flight process;
the missile formation motion model is static; when the missile formation carries out cooperative flight in the actual flight task execution process, the missile formation is interfered by external airflow, and t is used as the current moment; the moment before the current moment t is marked as the last moment t-1; the moment after the current moment t is recorded as the next moment t + 1;
d is caused because the formation of missiles is disturbed by external air flow when performing flight missionsix,diy,dizD is applied to the missile subjected to external disturbanceix,diy,dizLoaded in the formula (1) for correction to obtain a corrected missile formation motion model of
Figure BDA0003319241710000032
Step 3, recording the motion vector of each missile;
the motion of each missile is recorded in a long vector mode, and the motion vector is provided by a formation flight control module;
the missile motion vector received by the fault-tolerant compensator is UUi=[ui,x ui,y ui,z]T
Considering the actuator fault model, in practical application, the motion quantity of a single missile in the aspect of driving is
Figure BDA0003319241710000041
ρiThe efficiency of the missile actuator loss after the missile actuator fails is shown, and rho is more than or equal to 0iLess than or equal to 1; if ρi1 means that the missile actuator has failed completely if p i0 means that the actuator is not in fault and still works normally;
step 4, constructing a missile formation motion correction model under a fault mode;
combining the missile formation movement and the interference source loading to obtain a movement model of the missile formation under a fault mode as
Figure BDA0003319241710000042
Step 5, constructing a directed connection topological structure diagram of the missile formation flight mission;
constructing a directed communication topological structure diagram of the missile formation system, and obtaining an adjacent matrix and a connected matrix according to the directed communication topology structure diagram;
step 6, setting a fully distributed self-adaptive fault-tolerant control law;
according to the missile formation motion models under various uncertainty, external environment disturbance and actuator fault modes, a completely distributed self-adaptive fault-tolerant control law UU is designedi(s) effecting a desired formation flight;
UU (fully distributed adaptive fault-tolerant control law)i(s) is
Figure BDA0003319241710000043
Compared with the mode in the prior art, the fully distributed missile formation cooperative adaptive fault-tolerant compensation controller has the following advantages:
(1) the missile formation self-adaptive fault-tolerant control algorithm provided by the invention can effectively solve the problem that a plurality of missiles simultaneously fail when the plurality of missiles form a formation flight. However, the existing technology mainly studies the fault tolerance method of a single missile. And a fault-tolerant method for formation of a plurality of missiles is not researched.
(2) Compared with the prior art, the fault-tolerant control method can simultaneously inhibit the faults of a plurality of missile actuators in the formation of the missiles, various uncertainties and the influence of disturbance of the external environment. The invention completely considers various disturbances and actuator faults of missile formation, so that the designed controller is more perfect and concrete, the reliability and the safety of aircraft formation are greatly improved, and the invention is more suitable for practical application.
(3) Compared with the prior art, the formation controller designed by the invention does not need to estimate the fault of the actuator, does not need any fault information of the actuator, and only needs the position and speed information of the adjacent aircraft and the self information, so that the complexity of the self-adaptive fault-tolerant compensation controller is almost equal to that of a PID (proportion integration differentiation) controller, and compared with the existing self-adaptive fault-tolerant method, the self-adaptive fault-tolerant compensation controller is easier to realize in practice.
(4) In the prior art, many methods are not completely distributed, a designed controller needs a communication matrix of the whole system and cannot reach the complete distribution, and due to the fact that the space distribution of the bullet groups and the distance between a signal receiver and a signal transmitter are limited, communication among information is possibly not smooth, and the bullet groups are crashed. The control method of the invention is completely distributed, all controller parameters are irrelevant to the global information of the communication topology, the structure information of the communication structure chart is not needed, and the control method only depends on the relative position and speed of the controller and the neighbors thereof, thereby greatly improving the reliability and the safety of the formation of the aircrafts.
Drawings
Fig. 1 is an architecture diagram of a conventional missile autonomous formation cooperative guidance control system.
Fig. 2 is a structure diagram of a traditional missile autonomous formation control function.
FIG. 3 is a block diagram of the missile formation adaptive fault-tolerant control system structure of the invention.
FIG. 4 is a 3-dimensional spatial position response curve of a simulated missile formation under the conditions of actuator failure and various uncertainties and external environment disturbances.
FIG. 5 is a position response curve of a simulated missile formation under the condition of actuator failure and various uncertainties and external environment disturbances.
FIG. 6 is a flight path angle response curve of a simulated missile formation under the conditions of actuator failure and various uncertainties and external environment disturbances.
FIG. 7 is a course angle response curve of a simulated missile formation under the condition of actuator failure and various uncertainties and external environment disturbances.
FIG. 8 is a position error response curve for a simulated missile formation under actuator failure and a variety of uncertainty and external environmental disturbance conditions in accordance with the present invention.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings and examples.
As shown in fig. 3, the invention provides a fully distributed missile formation cooperative adaptive fault-tolerant compensation controller (referred to as a fault-tolerant compensator for short) for a missile formation system under the conditions of an actuator fault mode, various uncertainties and external environment disturbances, so that the missile formation can still realize safe and stable flight under the conditions of various uncertainties, external environment disturbances and various actuator faults. The fault-tolerant compensator designed by the invention can effectively inhibit the influence of the interference and improve the stability of formation flight. As shown in FIG. 2, the fully distributed missile formation cooperative adaptive fault-tolerant compensation controller designed by the invention is stored in a fault-tolerant control module and is used as a compensation of the fault-tolerant control module. Therefore, the self-adaptive fault-tolerant formation control algorithm is an auxiliary compensation for the traditional missile autonomous formation cooperative guidance control algorithm.
The invention relates to a fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller, which comprises the following specific construction steps:
step 1, extracting a missile formation motion model from a formation flight control module;
according to the missile formation information in the formation flight control module, the obtained missile formation motion model is as follows:
Figure BDA0003319241710000061
the lower corner mark i indicates the identification number of the missile.
Figure BDA0003319241710000062
Representing the flight speed of the missile in the longitudinal direction of the inertial frame.
Figure BDA0003319241710000063
Representing the velocity of the missile in the lateral direction of the inertial frame.
Figure BDA0003319241710000064
Representing the flight speed of the missile in the height direction of the inertial coordinate system.
Figure BDA0003319241710000065
Representing the acceleration of the missile's flight.
ViIndicating the flight speed of the missile.
Figure BDA0003319241710000071
The angular velocity representing the trajectory angle of the missile.
θiRepresenting the trajectory angle of the missile.
Figure BDA0003319241710000072
Presentation guideAngular velocity of the heading angle of the projectile.
ψiIndicating the heading angle of the missile.
g denotes an attractive constant.
ui,xRepresenting the components of the missile overload vector in the longitudinal direction of the missile coordinate system.
ui,yRepresenting the component of the missile overload vector in the lateral direction of the missile coordinate system.
ui,zRepresenting the component of the missile overload vector in the height direction of the missile coordinate system.
Step 2, correcting a missile formation motion model by using an interference source in the formation cooperative flight process;
in the present invention, the missile formation motion model is static. When the missile formation carries out cooperative flight in the actual flight task execution process, the missile formation is interfered by external airflow, and t is used as the current moment; the moment before the current moment t is marked as the last moment t-1; the time after the current time t is recorded as the next time t + 1.
In the invention, d is caused because the missile formation is disturbed by external air flow when the missile formation carries out the flight missionix,diy,dizD is applied to the missile subjected to external disturbanceix,diy,dizThe missile formation motion model (missile formation motion correction model for short) obtained by loading the missile formation motion model in the formula (1) for correction is as follows:
Figure BDA0003319241710000073
di,xrepresenting the external interference on the missile in the longitudinal direction at the current moment of the missile coordinate system.
di,yRepresenting the external interference to which the missile is subjected laterally at the current moment of the missile coordinate system.
di,zAnd the external interference on the missile in the height direction of the missile coordinate system at the current moment is represented.
Figure BDA0003319241710000081
Representing the flight speed of the missile in the longitudinal direction of the inertial coordinate system at the current moment.
Figure BDA0003319241710000082
Representing the velocity of the missile in the lateral direction of the inertial frame at the present moment.
Figure BDA0003319241710000083
And the flight speed of the missile in the height direction of the inertial coordinate system at the current moment is represented.
Figure BDA0003319241710000084
Representing the acceleration of the missile at the current moment.
Figure BDA0003319241710000085
The angular velocity representing the track angle of the missile at the current time.
Figure BDA0003319241710000086
The angular velocity representing the heading angle of the missile at the current time.
Step 3, recording the motion vector of each missile;
in the invention, the motion of each missile is recorded in a long vector mode, the motion vector is provided by a formation flight control module, namely, the fault-tolerant compensator of the invention judges whether the self fault of the missile (the fault can be an actuator fault, a steering engine and the like) occurs by utilizing the motion quantity of the missile at different moments,
the missile motion vector received by the fault-tolerant compensator is as follows:
UUi=[ui,x ui,y ui,z]T (3)
UUiindicating missile guidance in formation flightThe amount of motion of the elastic coordinate system.
The superscript T is the coordinate transpose.
In the present invention, as modern missile systems become increasingly complex, many combat missions require missiles capable of flying in a variety of harsh environments. Meanwhile, various disturbances have greater and greater effects on the missile, so that various faults of the flying missile can occur in the flying process.
Considering the actuator failure model, in practical applications, the steering engine may be partially or completely failed. In this case, the amount of movement of the individual missile in terms of actuation is therefore:
Figure BDA0003319241710000087
Figure BDA0003319241710000088
the method is characterized in that the method represents the motion control input of the missile after the fault occurs, and the upper corner mark f represents a fault event.
ρiThe efficiency of the missile actuator loss after the missile actuator fails is shown, and rho is more than or equal to 0iLess than or equal to 1. If ρi1 means that the missile actuator has failed completely if piAnd 0 means that the actuator is not in fault and still works normally.
Step 4, constructing a missile formation motion correction model under a fault mode;
by combining the formula (1), the formula (2) and the formula (4), the motion model of the missile formation under the fault mode is obtained as follows:
Figure BDA0003319241710000091
Figure BDA0003319241710000092
representing acceleration vectors of the missile in three directions under an inertial coordinate system; and p isiIndicating that the projectile is in the inertial framePosition, and pi=[xi yi zi]T;xiRepresenting the position of the missile in the longitudinal direction of the inertial frame, yiIndicating the position of the missile in the lateral direction of the inertial frame, ziIndicating the position of the missile in the height direction of the inertial frame.
BiRepresents a flight parameter matrix of the missile, an
Figure BDA0003319241710000093
DiRepresenting the acceleration of the missile due to the gravitational attraction, and Di=[0 -g 0]TAnd g represents an attractive constant.
ddiRepresents the differential vector of the external interference on the missile in three directions under the inertial coordinate system, and
Figure BDA0003319241710000094
during formation flight, BiWill be subject to uncertainty due to interference from the external atmospheric wind field, said BiDivided into a nominal parameter part and an uncertainty part, then
Figure BDA0003319241710000095
Figure BDA0003319241710000096
Representing the known flight parameters of the missile,
Figure BDA0003319241710000097
representing unknown missile flight parameters caused by uncertain disturbance factors.
Similarly, during formation flight, said DiWill be subject to uncertainty due to interference from the external atmospheric wind field, and thus said DiDivided into a nominal parameter part and an uncertainty part, then
Figure BDA0003319241710000098
Figure BDA0003319241710000099
Representing a known acceleration vector generated by the earth's gravity,
Figure BDA00033192417100000910
representing an unknown acceleration vector caused by uncertain disturbance factors.
The missile motion correction model after the interference source is carried in the formula (5) can be written as the following formula:
Figure BDA00033192417100000911
DLithe equivalent disturbance of the missile is represented, and the uncertainty such as parameter uncertainty, nonlinearity, external atmospheric wind field interference and the like is included. The above-mentioned
Figure BDA00033192417100000912
Step 5, constructing a directed connection topological structure diagram of the missile formation flight mission;
in the invention, a directed communication topological structure diagram of a missile formation system is constructed, and an adjacent matrix and a communication matrix are obtained according to the directed communication topological structure diagram. Which has a directed communication topology diagram such as the formation support network system on the left in fig. 1.
Step 6, setting a fully distributed self-adaptive fault-tolerant control law;
in the invention, a fully distributed self-adaptive fault-tolerant control law UU is designed according to a motion model of missile formation under various uncertainty, external environment disturbance and actuator fault modesi(s) to effect a desired formation flight.
UU (fully distributed adaptive fault-tolerant control law)i(s) is:
Figure BDA0003319241710000101
s represents the laplacian operator.
αi(s) represents the weight coupling gain of the missile motion modification model.
KiA feedback gain matrix representing a model of the missile motion correction.
γi(s) communication relationship between missile and neighbor missile
Gi(s) represents the filter structure of the missile motion correction model.
piRepresenting the position of the missile in an inertial frame.
Figure BDA0003319241710000102
Representing known missile flight parameters.
I3Representing a 3 x 3 matrix of missile motion vectors.
Figure BDA0003319241710000103
Representing a known acceleration vector generated by the earth's gravity.
In the invention, as can be seen from equation (7), each missile controller consists of a nominal control law when no fault exists and an adaptive control law. The designed adaptive mechanism restrains the influence of multiple faults and uncertainties on the closed-loop control system. And the controller parameters are time invariant. The complexity of the designed controller is almost equal to that of the PID controller. Therefore, the method is relatively easy to realize in practical application.
Example 1
In the invention, a fault-tolerant compensation controller simulation system in accordance with the invention is established by Matlab software under the condition of time-varying formation of missile formation in a three-dimensional space and under various uncertainty and interference conditions. Example simulations are performed on missile formation to verify the effectiveness of the fault-tolerant compensation controller designed by the invention.
An example is a simulation test for a set of five missiles flying in formation. The control objective is to ensure that a predetermined pentagonal shape formation pattern is maintained in the event of multiple actuator failures and uncertainties. In simulation, a plurality of missiles can simultaneously break down.
Missile 1 and missile 3 work normally, and missile 2, missile 4 and missile 5 have actuator faults in 9 seconds.
The failure mode is selected as rho2=0.55,ρ4=0.6,ρ5=0.8。
The virtual leader track is chosen as MA ═ 240t 60sin (t/10) 60sin (t/2)]TAnd time units are seconds.
The actual parameters of each missile were assumed to be 20% greater than the nominal parameters. If the external disturbance acting on the missile is non-vanishing and time-varying, the output is di,x=10sin(t),di,y=9sin(t),di,z=8sin(t)。
The initial state of the missile is selected as p1(0)=[40 -40 -60]T, p2(0)=[-45 45 -50]T,p3(0)=[-60 60 70]T,p4(0)=[65 -45 60]T, p5(0)=[9 5 118]T
The 3-dimensional spatial positions of five missiles flying in formation under the fully distributed adaptive fault-tolerant controller are shown in fig. 4. It can be seen from fig. 5 that the positions, the track angles, the course angles and the position tracking errors in the 3 directions can well complete the expected distributed formation flight by using the proposed fully distributed adaptive fault-tolerant formation controller for five missiles under the condition that a plurality of actuators have faults and uncertainties. As seen in fig. 6 and 7, the formation attitude dynamics remained stable after 9s of the fault. As can be seen from fig. 8, the tracking errors in three directions of the proposed adaptive controller stabilize in a small neighborhood after a failure occurs. The simulation result shows that the controller has higher robustness and fault tolerance. The completely distributed formation control method provided by the invention can realize good tracking performance and robustness of missile formation under the conditions of actuator failure, parameter uncertainty and external interference.

Claims (2)

1. A fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller is carried out by utilizing missile motion parameters in a missile autonomous formation cooperative guidance control algorithm; the method is characterized by comprising six construction steps:
step 1, extracting a missile formation motion model from a formation flight control module;
according to the missile formation information in the formation flight control module, the obtained missile formation motion model is as follows:
Figure FDA0003319241700000011
the lower corner mark i represents the identification number of the missile;
Figure FDA0003319241700000012
representing the flight speed of the missile in the longitudinal direction of the inertial coordinate system;
Figure FDA0003319241700000013
representing the flight speed of the missile in the lateral direction of the inertial coordinate system;
Figure FDA0003319241700000014
representing the flight speed of the missile in the height direction of the inertial coordinate system;
Figure FDA0003319241700000015
representing the flight acceleration of the missile;
Virepresenting the flight speed of the missile;
Figure FDA0003319241700000016
an angular velocity representing a trajectory angle of the missile;
θirepresenting the trajectory angle of the missile;
Figure FDA0003319241700000017
an angular velocity representing a heading angle of the missile;
ψirepresenting the course angle of the missile;
g represents a gravitational constant;
ui,xrepresenting the component of the missile overload vector in the longitudinal direction of the missile coordinate system;
ui,yrepresenting the component of the missile overload vector in the lateral direction of the missile coordinate system;
ui,zrepresenting the component of the missile overload vector in the height direction of the missile coordinate system;
step 2, correcting a missile formation motion model by using an interference source in the formation cooperative flight process;
the missile formation motion model is static; when the missile formation carries out cooperative flight in the actual flight task execution process, the missile formation is interfered by external airflow, and t is used as the current moment; the moment before the current moment t is marked as the last moment t-1; the moment after the current moment t is recorded as the next moment t + 1;
d is caused because the formation of missiles is disturbed by external air flow when performing flight missionsix,diy,dizD is applied to the missile subjected to external disturbanceix,diy,dizThe missile formation motion model is obtained by loading the missile formation motion model in the formula (1) for correction:
Figure FDA0003319241700000021
di,xrepresenting external interference on the missile in the longitudinal direction at the current moment of the missile coordinate system;
di,yrepresenting the external interference on the missile in the lateral direction at the current moment of the missile coordinate system;
di,zrepresenting the external interference of the missile on the height direction of the missile coordinate system at the current moment;
Figure FDA0003319241700000022
representing the flight speed of the missile at the current moment in the longitudinal direction of the inertial coordinate system;
Figure FDA0003319241700000023
representing the flight speed of the missile in the lateral direction of the inertial coordinate system at the current moment;
Figure FDA0003319241700000024
representing the flight speed of the missile in the height direction of the inertial coordinate system at the current moment;
Figure FDA0003319241700000025
representing the flight acceleration of the missile at the current moment;
Figure FDA0003319241700000026
angular velocity representing the trajectory angle of the missile at the current moment;
Figure FDA0003319241700000027
angular velocity representing the course angle of the missile at the current moment;
step 3, recording the motion vector of each missile;
the motion of each missile is recorded in a long vector mode, and the motion vector is provided by a formation flight control module;
the missile motion vector received by the fault-tolerant compensator is as follows:
UUi=[ui,x ui,y ui,z]T (3)
UUirepresenting the motion quantity of the missiles in formation flight in a missile coordinate system;
the upper corner mark T is a coordinate transpose;
considering an actuator fault model, in practical application, the motion quantity of a single missile in the driving aspect is as follows:
Figure FDA0003319241700000028
Figure FDA0003319241700000029
representing the motion control input of the missile after the fault occurs, and representing a fault event by an upper corner mark f;
ρithe efficiency of the missile actuator loss after the missile actuator fails is shown, and rho is more than or equal to 0iLess than or equal to 1; if ρi1 means that the missile actuator has failed completely if pi0 means that the actuator is not in fault and still works normally;
step 4, constructing a missile formation motion correction model under a fault mode;
combining the formula (1), the formula (2) and the formula (4), the motion model of the missile formation under the fault mode is obtained as follows:
Figure FDA0003319241700000031
Figure FDA0003319241700000032
representing acceleration vectors of the missile in three directions under an inertial coordinate system; and p isiRepresenting the position of the missile in an inertial frame, and pi=[xi yi zi]T;xiRepresenting the position of the missile in the longitudinal direction of the inertial frame, yiIndicating the position of the missile in the lateral direction of the inertial frame, ziIndicating a missile atA position in a height direction of the inertial coordinate system;
Birepresents a flight parameter matrix of the missile, an
Figure FDA0003319241700000033
DiRepresenting the acceleration of the missile due to the gravitational attraction, and Di=[0 -g 0]TG represents a gravitational constant;
ddirepresents the differential vector of the external interference on the missile in three directions under the inertial coordinate system, and
Figure FDA0003319241700000034
during formation flight, BiWill be subject to uncertainty due to interference from the external atmospheric wind field, and therefore said BiDivided into a nominal parameter part and an uncertainty part, then
Figure FDA0003319241700000035
Figure FDA0003319241700000036
Representing the known flight parameters of the missile,
Figure FDA0003319241700000037
representing unknown missile flight parameters caused by uncertain disturbance factors;
similarly, during formation flight, said DiWill be subject to uncertainty due to interference from the external atmospheric wind field, and thus said DiDivided into a nominal parameter part and an uncertainty part, then
Figure FDA0003319241700000038
Figure FDA0003319241700000039
Representing production by earth's gravityThe resulting known acceleration vector is then used to determine,
Figure FDA00033192417000000310
representing an unknown acceleration vector caused by an uncertain disturbance factor;
the missile motion correction model after the interference source is borne in the formula (5) is written as the following formula:
Figure FDA00033192417000000311
DLirepresenting equivalent disturbance of the missile, including uncertainty of parameters, nonlinearity, external atmospheric wind field interference and other uncertainties; the above-mentioned
Figure FDA00033192417000000312
Step 5, constructing a directed connection topological structure diagram of the missile formation flight mission;
constructing a directed communication topological structure diagram of the missile formation system, and obtaining an adjacent matrix and a connected matrix according to the directed communication topological structure diagram;
step 6, setting a fully distributed self-adaptive fault-tolerant control law;
according to the missile formation motion models under various uncertainty, external environment disturbance and actuator fault modes, a completely distributed self-adaptive fault-tolerant control law UU is designedi(s) effecting a desired formation flight;
UU (fully distributed adaptive fault-tolerant control law)i(s) is:
Figure FDA0003319241700000041
s represents the laplacian operator;
αi(s) weight coupling gains representing missile motion modification models;
Kifeedback gain representing missile motion modification modelA matrix;
γi(s) communication relationship between missile and neighbor missile
Gi(s) a filter structure representing a missile motion modification model;
pirepresenting the position of the missile in an inertial coordinate system;
Figure FDA0003319241700000042
representing known missile flight parameters;
I3representing a 3 x 3 missile motion vector matrix;
Figure FDA0003319241700000043
representing a known acceleration vector generated by the earth's gravity.
2. The fully distributed missile formation cooperative adaptive fault-tolerant compensation controller of claim 1, wherein: the system is stored in a fault-tolerant control module and is an auxiliary compensation for the traditional missile autonomous formation cooperative guidance control algorithm.
CN202111240320.0A 2020-12-08 2021-10-25 Fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller Active CN114326781B (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202011440933 2020-12-08
CN2020114409334 2020-12-08

Publications (2)

Publication Number Publication Date
CN114326781A true CN114326781A (en) 2022-04-12
CN114326781B CN114326781B (en) 2024-03-15

Family

ID=81045177

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111240320.0A Active CN114326781B (en) 2020-12-08 2021-10-25 Fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller

Country Status (1)

Country Link
CN (1) CN114326781B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115639830B (en) * 2022-12-15 2023-03-14 北京航空航天大学 Air-ground intelligent agent cooperative formation control system and formation control method thereof
CN115877718A (en) * 2023-02-23 2023-03-31 北京航空航天大学 Data-driven heterogeneous missile formation switching communication topology cooperative control method

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110058519A (en) * 2019-04-02 2019-07-26 南京航空航天大学 A kind of active formation fault tolerant control method based on quick self-adapted technology
WO2019160973A1 (en) * 2018-02-13 2019-08-22 Idac Holdings, Inc. Methods for v2x autonomous directional resource selection
CN110262557A (en) * 2019-07-16 2019-09-20 南京航空航天大学 Quadrotor formation finite time fault tolerant control method based on sliding formwork control technology
EP3699825A2 (en) * 2019-02-22 2020-08-26 Ubotica Technologies Ltd. Systems and methods for deploying and updating neural networks at the edge of a network
CN111948944A (en) * 2020-08-07 2020-11-17 南京航空航天大学 Four-rotor formation fault-tolerant control method based on adaptive neural network
CN111970658A (en) * 2020-07-16 2020-11-20 西安理工大学 Unmanned aerial vehicle swarm formation network routing method based on optimal rigid graph

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019160973A1 (en) * 2018-02-13 2019-08-22 Idac Holdings, Inc. Methods for v2x autonomous directional resource selection
EP3699825A2 (en) * 2019-02-22 2020-08-26 Ubotica Technologies Ltd. Systems and methods for deploying and updating neural networks at the edge of a network
CN110058519A (en) * 2019-04-02 2019-07-26 南京航空航天大学 A kind of active formation fault tolerant control method based on quick self-adapted technology
CN110262557A (en) * 2019-07-16 2019-09-20 南京航空航天大学 Quadrotor formation finite time fault tolerant control method based on sliding formwork control technology
CN111970658A (en) * 2020-07-16 2020-11-20 西安理工大学 Unmanned aerial vehicle swarm formation network routing method based on optimal rigid graph
CN111948944A (en) * 2020-08-07 2020-11-17 南京航空航天大学 Four-rotor formation fault-tolerant control method based on adaptive neural network

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
穆晓敏;吴森堂;: "飞航导弹高动态自主编队协同控制系统的建立与仿真", 飞行力学, no. 04 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115639830B (en) * 2022-12-15 2023-03-14 北京航空航天大学 Air-ground intelligent agent cooperative formation control system and formation control method thereof
CN115877718A (en) * 2023-02-23 2023-03-31 北京航空航天大学 Data-driven heterogeneous missile formation switching communication topology cooperative control method

Also Published As

Publication number Publication date
CN114326781B (en) 2024-03-15

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
CN114326781B (en) Fully distributed missile formation cooperative self-adaptive fault-tolerant compensation controller
CN109597426A (en) Based on L1The four-rotor helicopter Trajectory Tracking Control method of self adaptive control
Van Oort et al. Full-envelope modular adaptive control of a fighter aircraft using orthogonal least squares
Sharma et al. Application and flight testing of an adaptive autopilot on precision guided munitions
CN115657730B (en) Robust clustering formation control method for large-scale multi-rotor unmanned aerial vehicle
CN115903865A (en) Aircraft near-distance air combat maneuver decision implementation method
CN107957686B (en) Unmanned helicopter auto landing on deck control system based on prediction control
CN115639830A (en) Air-ground intelligent agent cooperative formation control system and formation control method thereof
Falcón et al. A sliding‐mode‐based active fault‐tolerant control for robust trajectory tracking in quad‐rotors under a rotor failure
CN117471952A (en) Integrated control method for backstepping supercoiled sliding mode guidance of aircraft
Li et al. Cooperative path planning of UAV formation based on improved artificial potential field
CN116203842A (en) Self-adaptive fault-tolerant backstepping attitude control design method for carrier rocket
Wang et al. Distributed formation flight control with translational and rotational maneuvering
CN114995517A (en) Subsonic aircraft trajectory planning method based on trajectory deflection angle deviation correction
CN112161626B (en) High-flyability route planning method based on route tracking mapping network
CN115407661A (en) Multi-unmanned aerial vehicle system nonlinear robust tracking control method based on azimuth measurement information
CN113050679B (en) Fully-distributed robust missile formation cooperative controller
CN115421376A (en) Sliding mode fault-tolerant control method for predetermined performance of quad-rotor unmanned aerial vehicle with external disturbance and actuator fault
CN113721656B (en) Missile time-varying formation three-dimensional cooperative flight control method
Xiaomin et al. Behavior-based formation control of multi-missiles
Wang et al. Integrated 3‐D flight trajectory tracking control with aerodynamic constraints on attitude and control surfaces
CN113110428A (en) Carrier-based aircraft landing fixed time trajectory tracking method based on limited backstepping control
CN110673616A (en) Limited time fault-tolerant control method for fixed-wing unmanned aerial vehicle based on self-adaptive sliding mode

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