Non-singular finite time fault-tolerant formation cooperative control method

Abstract

The invention relates to a nonsingular finite time fault-tolerant formation cooperative control method, and belongs to the technical field of formation system intelligent cooperative control. Comprising the following steps: 1) establishing a speed layer and an attitude layer in a six-degree-of-freedom dynamic model of the fixed wing formation system; 2) aiming at the six-degree-of-freedom dynamic model, establishing an actuator fault model of a thrust actuator and a rudder actuator included in the six-degree-of-freedom dynamic model; 3) establishing a fixed wing formation system topological relation comprising a plurality of models in the step 1); (4) the adjacency error of the attitude layer and the velocity layer is solved; 5) designing a thrust control law and an adaptive law in a speed layer finite time controller; and 6) designing a virtual control law, a control surface control law and a self-adaptive law in the attitude layer finite time controller. The method can make up the vacancy of a formation system in the aspect of six-degree-of-freedom fixed wing model research, overcome the instability problem caused by actuator faults, and overcome the potential singular value problem in the attitude layer controller.

Description

Technical Field

[0001] The invention relates to a non-singular finite-time fault-tolerant formation cooperative control method, belonging to the technical field of formation system intelligent cooperative control. Background Art

[0002] Formation collaborative control technology has significant advantages in mission execution and cost reduction, so this field has developed rapidly. Research mainly focuses on maintaining and changing the shape, speed and attitude synchronization of the formation. Existing formation system models usually use a three-degree-of-freedom model or only consider a single attitude / longitudinal model, which is different from the six-degree-of-freedom model actually required. Therefore, there is an urgent need for more in-depth research on the six-degree-of-freedom fixed-wing formation system.

[0003] Current conditions show that actuator failures occur frequently due to the aging of formation system components and potential collisions. Researchers enhance the robustness of the system and ensure flight safety by applying fault-tolerant control methods. In addition, due to the rapidly changing actual mission environment, the formation system needs to achieve rapid convergence of attitude and speed to improve system performance. Although some progress has been made in finite-time control methods in the field of multi-agent and formation systems, there is a lack of comprehensive research on six-degree-of-freedom fixed-wing formation systems. At the same time, the negative power terms in the controller will cause singular value problems (non-differentiable), which is a challenge that needs to be addressed urgently. Summary of the invention

[0004] In view of the deficiencies in the above-mentioned prior art, the present invention provides a non-singular finite-time fault-tolerant formation collaborative control method, which can fill the gap in the research of six-degree-of-freedom fixed-wing models of formation systems, overcome the instability problem caused by actuator failure, and overcome the potential singular value problem in the attitude layer controller while ensuring that the speed and attitude of the formation system converge within a finite time.

[0005] A non-singular finite-time fault-tolerant formation cooperative control method of the present invention is special in that it comprises the following steps: Step 1: Establish the velocity layer and attitude layer in the six-degree-of-freedom dynamics model of the fixed-wing formation system; Step 2: establishing an actuator fault model of the thrust actuator and the rudder actuator included in the six-degree-of-freedom dynamic model established in step 1; Step 3: Establish a topological relationship of a fixed-wing formation system including multiple models in step 1; Step 4: Based on the topological relationship in step 3, solve the adjacency error of the attitude and velocity layers; Step 5: Based on the adjacent error of the velocity layer in step 4, the thrust control law and the adaptive law in the velocity layer finite time controller are designed; Step 6: Based on the attitude adjacency error in step 4, design the virtual control law, rudder control law and adaptive law in the attitude layer finite time controller.

[0006] Preferably, the velocity layer of the six-degree-of-freedom dynamics model established in step 1 is: ; in, Indicates the quality of the drone, represents the position vector in the ground coordinate system, represents the attitude angle vector, represents the attitude angular velocity vector, represents the thrust vector, is the acceleration due to gravity, express , is the external disturbance, is the transformation matrix between the body coordinate system and the ground coordinate system: ; in, and Respectively represent and , is the aerodynamic parameter, and its expression is: ; in, They are drag coefficient, sideslip coefficient and lift coefficient respectively.

[0007] Preferably, the six-degree-of-freedom dynamics model posture layer established in step 1 is: ; in, express , is the external disturbance, is the body coordinate system The inertia tensor of a plane is expressed as: ; is the transformation matrix of angular velocity and attitude angle projection, and its expression is: ; To control the effectiveness matrix, its expression is: ; is the dynamic vector, and its expression is: ; in, is the wing area, is the air pressure, is the air density, is the wingspan length, Along the body coordinate system The chord length of the shaft, is the average chord length, The body coordinate system The aerodynamic coefficient corresponding to the axis.

[0008] Preferably, the thrust actuator and rudder actuator actuator fault models in step 2 include effectiveness loss and bias fault, which are respectively: , ; in, represents the thrust actuator efficiency, Indicates the bias fault size; represents the thrust actuator efficiency, Indicates the bias fault size; Considering the influence of actuator failure, the velocity and attitude layer dynamics model of the fixed-wing formation system is expressed as: ; in, Indicates the combined speed of the drone. and represents the modeling error.

[0009] Preferably, the specific steps of step three are as follows: Establishing topological relationships ; in, Represents each fixed-wing system node; Indicates i The first j The connection between the fixed-wing systems, i.e. the edge set; represents the weight of the corresponding edge set; if This indicates that i The first j There is a connection between the fixed-wing systems, and vice versa ;No. i The adjacency matrix of a fixed-wing system is expressed as ; and is the speed and posture to be tracked, and the adjacency error of the posture and speed layers in step 4 satisfies: ; ; in, , , , is the tracking error, , , , is a normal number, and are the expected speed and attitude respectively, and satisfy , , , , , .

[0010] Preferably, in step three The uncertain terms are approximated by RBF neural network: ; in, , Meets the boundedness condition.

[0011] Preferably, the thrust control law in the speed layer finite time controller in step 5 is: ; in, ; Preferably, the adaptive law in the speed layer finite time controller in step 5 is: ; Among them, the adaptive parameters satisfy , , the estimated error is , , , is a positive constant; Preferably, in step 2 The uncertain terms are approximated by RBF neural network: ; in, , Meet the boundedness condition; Preferably, the attitude layer finite time controller in step 6 has a singular value problem, and the switching function is introduced as follows: ; in, is a small positive constant, , , , , , ; Preferably, the virtual control law in the attitude layer finite time controller in step 6 is: ; in, , , .

[0012] Preferably, the control law of the rudder surface in the attitude layer finite time controller in step 6 is as follows: ; in, , , , .

[0013] Preferably, the adaptive law in the speed layer finite time controller of step six is ​​as follows: ; Among them, the adaptive parameters satisfy , The estimated error is , , Is a normal number.

[0014] The present invention designs a non-singular finite-time fault-tolerant formation cooperative control method, which solves the cooperative control problem of a six-degree-of-freedom fixed-wing formation system, and has the following beneficial effects: 1. For the speed and attitude layers of the fixed-wing formation system, the speed and attitude finite-time formation collaborative control strategies are designed respectively. By flexibly switching between fractional and exponential functions, the singular value (non-differentiable) problem in the controller is eliminated, and the finite-time control of the fixed-wing formation system is realized; 2. Considering the actuator failures in the system, an adaptive update law for fault parameters is designed to solve the actuator failure problem. BRIEF DESCRIPTION OF THE DRAWINGS

[0015] Figure 1 is a flow chart of the present invention; Figure 2 is the roll-on angle tracking response diagram; Figure 3 is the pitch angle tracking response diagram; Figure 4 is the heading angle tracking response diagram; Figure 5 is the speed tracking response plot. DETAILED DESCRIPTION

[0016] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.

[0017] Example 1 A non-singular finite-time fault-tolerant formation cooperative control method of this embodiment is shown in the attached flowchart. Figure 1 , including the following steps: Step 1: Establish the velocity layer and attitude layer in the six-degree-of-freedom dynamics model of the fixed-wing formation system; The velocity layer in the six-degree-of-freedom dynamic model of the fixed-wing formation system established in step 1 is: ; in, Indicates the quality of the drone, represents the position vector in the ground coordinate system, represents the attitude angle vector, represents the attitude angular velocity vector, represents the thrust vector, is the acceleration due to gravity, express , For external disturbance. is the transformation matrix between the body coordinate system and the ground coordinate system: ; in, and Respectively represent and , is the aerodynamic parameter, and its expression is: ; in, are the drag coefficient, sideslip coefficient and lift coefficient respectively; The attitude layer in the six-degree-of-freedom dynamics model of the fixed-wing formation system established in step 1 is: ; in, express , is the external disturbance, is the body coordinate system The inertia tensor of a plane is expressed as: ; is the transformation matrix of angular velocity and attitude angle projection, and its expression is: ; To control the effectiveness matrix, its expression is: ; is the dynamic vector, and its expression is: ; in, is the wing area, is the air pressure, is the air density, is the wingspan length, Along the body coordinate system The chord length of the shaft, is the average chord length, The body coordinate system The aerodynamic coefficient corresponding to the axis.

[0018] Step 2: establishing an actuator fault model of the thrust actuator and the rudder actuator included in the six-degree-of-freedom dynamic model established in step 1; The thrust actuator and rudder actuator actuator fault models in step 2 include effectiveness loss and bias failure, which are: , ; in, represents the thrust actuator efficiency, Indicates the bias fault size; represents the thrust actuator efficiency, Indicates the bias fault magnitude.

[0019] Considering the influence of actuator failure, the velocity and attitude layer dynamics model of the fixed-wing formation system is expressed as: ; in, Indicates the combined speed of the drone. and represents the modeling error.

[0020] Step 3: Establish a topological relationship for the actuator fault model in step 2; Step 3 Topological relationship The meaning is as follows: Nodes representing each fixed-wing system; Indicates i The first j The connection between the fixed-wing systems, i.e. the edge set; represents the weight of the corresponding edge set. If This indicates that i The first j There is a connection between the fixed-wing systems, and vice versa . No. i The adjacency matrix of a fixed-wing system is expressed as .

[0021] Step 4: Based on the topological relationship in step 3, solve the adjacency error of the velocity and attitude layers; In step four, and is the speed and attitude to be tracked, and the adjacency error solution of the speed and attitude layer is: ; ; in, , , , is the tracking error, , , , is a normal number, and are the expected speed and attitude respectively, and satisfy , , , , , .

[0022] Step 5: Design a velocity layer finite time controller for the velocity layer adjacency error in step 4; In step 5, the speed layer finite time controller design process is: Approximating the uncertainty in step 4 using RBF neural network : ;

[0023] in, , Meets the boundedness condition.

[0024] The thrust control law in the speed layer finite time controller in the design step 5 is: ; in, .

[0025] The adaptive law in the speed finite time controller described in the design step 5 is as follows: ; Among them, the adaptive parameters satisfy , , The estimated error is , , , Is a normal number.

[0026] Step 6: Design a finite-time controller for the attitude layer according to the speed layer finite-time controller in step 5; In step 6, the design process of the attitude layer finite time controller is: Use RBF neural network to approximate the uncertain terms in step 2 :

[0027] in, , Meets the boundedness condition.

[0028] The attitude finite time controller has a singular value problem, and the switching function is introduced as follows: ; in, is a small normal number. , , , , , .

[0029] The virtual control law in the attitude layer finite time controller described in the design step six is:

[0030] in, , , .

[0031] The control law of the rudder surface in the attitude layer finite time controller described in design step 6 is as follows: ; in,

[0032] , , , .

[0033] The adaptive law in the attitude layer finite time controller described in design step 6 is as follows: ; Among them, the adaptive parameters satisfy , The estimated error is , , Is a normal number.

[0034] Example 2 Considering that the six-degree-of-freedom fixed-wing system is a more common system than the fixed-wing system, a six-degree-of-freedom fixed-wing formation composed of three fixed-wing systems is taken as an example to further prove the effectiveness of the proposed non-singular finite-time fault-tolerant formation cooperative control method. The adjacency matrix of the model can be expressed as: ; The initial states of the three fixed-wing systems can be expressed as: , , .

[0035] The tasks to be performed are: Three six-degree-of-freedom fixed-wing systems perform maneuvering rotation and climbing tasks, ensuring that the speed is quickly increased to On the other hand, its posture is required to achieve posture tracking in a limited time, and the tracking trajectory is as follows: ; Actuator faults are: Assume that Wingman 2 encounters an actuator failure after 5 seconds: , and the fault will be eliminated after 10 seconds.

[0036] Considering the actual performance of the fixed-wing system, the following constraints are made: , , , , the angular acceleration cannot exceed .

[0037] The attitude tracking response of the fixed-wing system is shown in Figure 2-4 , speed tracking response see Figure 5 , the dotted line in the attitude tracking response represents the trajectory to be tracked, Figure 2-5 It can be seen that after adding the actuator failure, the fixed-wing system can still ensure the finite time convergence and the attitude angles and velocities do not exceed the allowable range. However, due to the uncertainty of the finite time convergence time, the accurate convergence time cannot be guaranteed. In addition, when the error of the attitude layer converges to near 0, there is no singularity problem, which shows that the singularity problem has been effectively solved.

[0038] The above calculation examples of the present invention are only used to explain the calculation model and calculation process of the present invention in detail, and are not intended to limit the implementation methods of the present invention. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is impossible to list all the implementation methods here. All obvious changes or modifications derived from the technical solution of the present invention are still within the scope of protection of the present invention.

Claims

1. A non-singular finite-time fault-tolerant formation cooperative control method, Features The following steps are involved: Step 1: Establish the velocity layer and attitude layer in the six-degree-of-freedom dynamics model of the fixed-wing formation system; Step 2: establishing an actuator fault model of the thrust actuator and the rudder actuator included in the six-degree-of-freedom dynamic model established in step 1; Step 3: Establish a topological relationship of a fixed-wing formation system including multiple models in step 1; Step 4: Based on the topological relationship in step 3, solve the adjacency error of the attitude and velocity layers; Step 5: Based on the adjacent error of the velocity layer in step 4, the thrust control law and the adaptive law in the velocity layer finite time controller are designed; Step 6: Based on the attitude adjacency error in step 4, design the virtual control law, rudder control law and adaptive law in the attitude layer finite time controller.

2. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features The velocity layer of the six-degree-of-freedom dynamics model established in step 1 is: ； in, Indicates the quality of the drone, represents the position vector in the ground coordinate system, represents the attitude angle vector, represents the attitude angular velocity vector, represents the thrust vector, is the acceleration due to gravity, express , is the external disturbance, is the transformation matrix between the body coordinate system and the ground coordinate system: ； in, and Respectively represent and , is the aerodynamic parameter, and its expression is: ； in, are the drag coefficient, sideslip coefficient and lift coefficient respectively; The six-degree-of-freedom dynamics model posture layer established in step 1 is: ； in, express , is the external disturbance, is the body coordinate system The inertia tensor of a plane is expressed as: ； is the transformation matrix of angular velocity and attitude angle projection, and its expression is: ； To control the effectiveness matrix, its expression is: ； is the dynamic vector, and its expression is: ； in, is the wing area, is the air pressure, is the air density, is the wingspan length, Along the body coordinate system The chord length of the shaft, is the average chord length, The body coordinate system The aerodynamic coefficient corresponding to the axis.

3. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features The thrust actuator and rudder actuator actuator fault models in step 2 include effectiveness loss and bias failure, which are: ， ； in, represents the thrust actuator efficiency, Indicates the bias fault size; represents the thrust actuator efficiency, Indicates the bias fault size; Considering the influence of actuator failure, the velocity and attitude layer dynamics model of the fixed-wing formation system is expressed as: ； in, Indicates the combined speed of the drone. and represents the modeling error.

4. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features The specific steps of step three are as follows: Establishing topological relationships ; in, Represents each fixed-wing system node; Indicates i The first j The connection between the fixed-wing systems, i.e. the edge set; represents the weight of the corresponding edge set; if This indicates that i The first j There is a connection between the fixed-wing systems, and vice versa ;No. i The adjacency matrix of a fixed-wing system is expressed as ; and is the speed and posture to be tracked, and the adjacency error of the posture and speed layers in step 4 satisfies: ； ； in, , , , is the tracking error, , , , is a normal number, and are the expected speed and attitude respectively, and satisfy , , ， ， ， 。 5. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 4, It is characterized in that In step three The uncertain terms are approximated by RBF neural network: ； in, , Meets the boundedness condition.

6. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features The thrust control law in the speed layer finite time controller in step 5 is: ； in, ; The adaptive law in the speed layer finite time controller in step 5 is: ； Among them, the adaptive parameters satisfy , , The estimated error is , , , Is a normal number.

7. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 3, Features In step 2 The uncertain terms are approximated by RBF neural network: ； in, , Meets the boundedness condition.

8. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features In step 6, the attitude layer finite time controller has a singular value problem, and the switching function is introduced as follows: ； in, is a small positive constant, , , , , , .

9. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features The virtual control law in the attitude layer finite time controller in step 6 is: ； in, , , ; The control law of the rudder surface in the attitude layer finite time controller in step 6 is as follows: ； in, , ， ， 。 10. A non-singular finite-time fault-tolerant formation cooperative control method according to claim 1, Features The adaptive law in the speed layer finite time controller of step six is ​​as follows: ； Among them, the adaptive parameters satisfy , The estimated error is , , Is a normal number.

Images