Multi-unmanned aerial vehicle group distributed formation control method based on relative information
By setting up a controller in the drone and using topology map connections, drone formation control is carried out based on relative information, the formation control problem under no communication conditions is solved, and efficient formation tracking and control effects are achieved in complex environments.
Patent Information
- Application Number
- CN202310670034.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-06-07
- Publication Date
- 2024-12-13
- Estimated Expiration
- 2043-06-07
AI Technical Summary
The prior art is difficult to effectively realize drone formation control under the condition of no communication, especially in external attacks or electromagnetic interference environments, which affects the control effect of drone formation.
A distributed formation control method for multi-UAV population based on relative information is designed. By setting up a controller in the UAV, the topological diagram is used to realize the connection between the UAV and the pilot UAV, and control it through thrust and torque. , based on adaptive distributed controllers and state observers, only rely on relative information for formation tracking.
It realizes effective control of the UAV formation under no communication conditions, improves the formation control performance in complex electromagnetic environments, avoids the direct use of absolute state information, and improves control accuracy and stability.
Smart Images

Figure CN119126847A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a distributed formation control method for a group of multiple unmanned aerial vehicles based on relative information, and belongs to the field of guidance control. Background Art
[0002] The control problem of rotary-wing UAVs usually achieves formation control based on communication. If they are attacked by the outside world or in an electromagnetic interference environment, the control effect of the UAV formation will be severely affected.
[0003] Therefore, it is necessary to study a method to realize UAV formation control under non-communication conditions. Summary of the invention
[0004] In order to overcome the above problems, the inventors conducted in-depth research and designed a distributed formation control method for a multi-UAV group based on relative information, including the following steps:
[0005] S1. Set up a controller in each drone except the pilot drone;
[0006] S2. Use a topology map to form a formation of different drones, so that any drone in the cluster can be connected to the pilot drone through at least one link;
[0007] S3. Except for the pilot UAV, the other UAVs track the UAVs connected to their links through the controller, thereby realizing the formation tracking of the pilot UAV by the cluster.
[0008] In a preferred embodiment, in S1, the controller includes thrust control and torque control. The thrust control part can be expressed as:
[0009] T i =m i ‖u ci ‖
[0010]
[0011]
[0012] Among them, T i represents the thrust required by the i-th UAV, g is the acceleration due to gravity, m i is the mass of the ith UAV, R i is the rotation matrix of the i-th UAV, R ci is the control rotation matrix of the i-th UAV, u ci represents the control input of the ith UAV, u i represents the thrust control quantity of the i-th UAV, Q is a positive definite matrix, K is a feedback gain matrix; β is a positive constant, is the adaptive coupling gain, ξ i represents the consistency error vector, represents the consistency error estimate, B[0 3×3 ,3×3] T .
[0013] In a preferred embodiment, the thrust required by the i-th UAV is T i Based on the kinematic and dynamic model design of the UAV, the kinematic and dynamic model of the i-th UAV is expressed as:
[0014]
[0015]
[0016] Among them, is the position of the ith UAV, and is the speed of the ith drone, g is the acceleration due to gravity, m i is the mass of the ith UAV, T i is the applied thrust of the ith UAV, R i is the rotation matrix of the i-th UAV, is the angular velocity of the i-th UAV, is the inertia matrix of the i-th UAV, is the control torque of the ith UAV, R ci is the control rotation matrix of the i-th drone.
[0017] In a preferred embodiment, in thrust control, the thrust control amount u of the i-th UAV is i It is expressed as:
[0018]
[0019] Where g is the acceleration due to gravity, m i is the mass of the ith UAV, T i is the applied thrust of the ith UAV, R i is the rotation matrix of the i-th UAV, R ci is the control rotation matrix of the i-th UAV, u ci represents the control input of the i-th UAV.
[0020] In a preferred embodiment, the consistency error vector ξ is estimated by a state observer using the relative state measurement information of the drone. i , and obtain the consistent error estimate Using the consistent error estimate Design the controller to avoid using absolute state information of neighboring drones.
[0021] In a preferred embodiment, the state observer is expressed as:
[0022]
[0023] Where E = B[(CB) T CB] -1 (CB) T , G=I+EC, F is the feedback gain matrix and satisfies F(CI)=0, A, B, C are constant matrices, I represents the unit matrix, o i is the process intermediate quantity, I m represents an m*m unit matrix, j represents different drones, N represents the total number of drones in the drone cluster, a ij represents the adjacent state of UAV i and UAV j, δ ij represents the expected deviation between the i-th UAV and the j-th UAV, and the expected deviation includes a position deviation and a speed deviation.
[0024] In a preferred embodiment, a high-order synovial differentiator is used to ci and its derivatives to obtain the control angular velocity ω ci and ci Derivative, and then obtain the control torque τ of the controller i .
[0025] In a preferred embodiment, a high-order synovial differentiator is used to ci The process of estimating and its derivative form can be expressed as:
[0026]
[0027]
[0028]
[0029] Wherein, the subscript k = x, y, z, indicating different directions, i.e., u = u x ,u y ,u z ] T ; For u ci An estimated value of For An estimated value of For The estimated value of ; λ0, λ1, λ2 are positive constants.
[0030] In a preferred embodiment, in S1, the torque control part can be expressed as:
[0031]
[0032] η i =ω ei +k ε ε i ;
[0033]
[0034] Among them, τ i represents the control torque of the ith UAV, k ε and k η is a positive constant, η i , is an intermediate variable;
[0035] ω i is the angular velocity vector of the i-th UAV, J i is the inertia matrix of the i-th UAV; ω ei is the error angular velocity of the i-th UAV, R ei is the error rotation matrix of the i-th UAV, I3 is the three-dimensional unit matrix, tr () represents the trace of the matrix, ω ci is the control angular velocity of the i-th UAV.
[0036] In a preferred embodiment, the control angular velocity and its derivative in the attitude control part are estimated, and the estimation result is used as the aircraft attitude control parameter at the next moment.
[0037] The beneficial effects of the present invention include:
[0038] (1) The present invention realizes the UAV formation control effect based on active measurement, realizes the estimation of system state quantity based on relative information measurement only based on observer, and realizes the formation control effect based on adaptive distributed controller;
[0039] (2) In complex electromagnetic environments or environments with communication interference, UAV formation control is performed through active measurement, which improves the formation control performance of multi-UAV systems in complex electromagnetic environments. BRIEF DESCRIPTION OF THE DRAWINGS
[0040] Figure 1 A schematic flow chart of a method for controlling a multi-UAV group distributed formation based on relative information according to a preferred embodiment of the present invention is shown;
[0041] Figure 2 The formation intention of 9 drones in Example 1 is shown;
[0042] Figure 3 The three-dimensional tracking evolution diagram of the formation in Example 1 is shown;
[0043] Figure 4 The figure shows the position error variation diagram of the four UAVs in Example 1. DETAILED DESCRIPTION
[0044] The present invention will be further described in detail below through the accompanying drawings and embodiments. Through these descriptions, the characteristics and advantages of the present invention will become more clear and distinct.
[0045] The word "exemplary" is used exclusively herein to mean "serving as an example, embodiment, or illustration." Any embodiment described herein as "exemplary" is not necessarily to be construed as preferred or advantageous over other embodiments. Although various aspects of the embodiments are shown in the drawings, the drawings are not necessarily drawn to scale unless otherwise noted.
[0046] A distributed formation control method for a multi-UAV group based on relative information provided by the present invention comprises the following steps:
[0047] S1. Set up a controller in each drone except the pilot drone;
[0048] S2. Use a topology map to form a formation of different drones, so that any drone in the cluster can be connected to the pilot drone through at least one link;
[0049] S3. Except for the pilot UAV, the other UAVs track the UAVs connected to their links through the controller, thereby realizing the formation tracking of the pilot UAV by the cluster.
[0050] According to the present invention, in S1, the controller includes thrust control and torque control.
[0051] Furthermore, the thrust control produces a control effect on the position of the drone. Further, the thrust control can be expressed as:
[0052] T i =m i ‖u ci ‖
[0053]
[0054]
[0055] Among them, u i represents the thrust control quantity of the i-th UAV, Q is a positive definite matrix, K is a feedback gain matrix; β is a positive constant and satisfies Input upper bound for pilot drone control, is the adaptive coupling gain, and its initial value And its derivative satisfies where ξ i represents the consistency error vector, Represents the consistency error estimate.
[0056] According to a preferred embodiment of the present invention, the thrust control is performed by an adaptive controller, and the output of the adaptive controller is u i .
[0057] In the present invention, by setting a consistency error estimation value in thrust control, direct use of the absolute state quantity measured by the UAV is avoided, thereby improving control accuracy.
[0058] In a preferred embodiment, in the thrust control part, the inverse matrix of the positive definite matrix Q satisfies:
[0059] Q -1 A T +AQ -1 +Q -1 -2BB T <0
[0060] The feedback gain matrix K satisfies: K = B T Q.
[0061] In a preferred embodiment, the thrust required by the i-th UAV is T i and the required torque τ i The kinematic and dynamic models of the UAV are designed and obtained, and the kinematic and dynamic models are expressed as follows:
[0062]
[0063]
[0064] Among them, is the position of the ith UAV, and is the speed of the ith drone, g is the acceleration due to gravity, m i is the mass of the ith UAV, T i is the applied thrust of the ith UAV, R i is the rotation matrix of the i-th UAV, is the angular velocity of the i-th UAV, is the inertia matrix of the i-th UAV, is the control torque of the ith UAV, R ci is the control rotation matrix of the i-th drone.
[0065] Further preferably, according to the above kinematic and dynamic models, the thrust control amount u of the i-th UAV is i It is expressed as:
[0066]
[0067] Where g is the acceleration due to gravity, m i is the mass of the ith UAV, T i is the thrust required by the i-th UAV, R i is the rotation matrix of the i-th UAV, R ci is the control rotation matrix of the i-th UAV, u ci represents the control input of the i-th UAV.
[0068] Furthermore, the required thrust can be expressed by T i =m i ‖u ci ‖Get, where The control rotation matrix can be expressed as follows
[0069]
[0070] Among them, u cxi 、u cyi 、u czi are the components of the control input of the ith UAV on the x, y, and z axes respectively;
[0071] In order to simplify the expression, the position dynamics system state is expressed in the following form:
[0072]
[0073] Among them, x i =[p i ,v i ] T Represents the system state, y i represents the position dynamics output of the i-th UAV, C is a constant matrix, is the position of the ith UAV, and is the speed of the ith UAV, A and B are constant matrices.
[0074] In a preferred embodiment, the consistency error estimate in the controller is obtained through a state observer to obtain an estimated deviation between the current position of the drone and the expected position. The estimated deviation is used as the deviation, combined with the current position of the drone, to obtain the expected position of the drone at the next moment.
[0075] According to the thrust control proposed in the present invention, the output of the desired position of the aircraft can be achieved. Specifically, it can be proved by the following theoretical derivation:
[0076] In order to achieve posture tracking, the rotation matrix needs to converge to R ci And the angular velocity error ω ei satisfy The error rotation matrix and error angular velocity are defined as follows
[0077]
[0078]
[0079] Therefore R i =R ci Can be R ei =I3 represents, R ei The derivative of represent.
[0080] Definition 1: and Satisfies the following equation
[0081] tr(x × M)=-x T (MM T )
[0082] (x × M+M T x × ) ∨ =(tr(M)I3-M)x
[0083] According to Definition 1, we can get
[0084]
[0085] in
[0086] Definition 2: For a rotation matrix R, the following relationship exists
[0087]
[0088] tr(I3-R)=2(1-cosθ)
[0089] Based on Definition 2, we can know that if ε i =0, which means R ei =I3 or θ ei =π (which is not what we expect). By the equation tr(I3-R)=
[0090] 2(1-cosθ), we can replace θei =π is converted to tr(I3-R ei )=4. Therefore, when And tr(I3-R ei )≠4, posture tracking is achieved.
[0091] Based on the attitude dynamics of the rotorcraft, we can get the following error attitude dynamics expression:
[0092]
[0093] According to the above analysis, the system control target can be obtained as follows:
[0094]
[0095] That is, if the controller meets the current conditions, it can achieve posture tracking control.
[0096] Based on the designed adaptive control rate, the consistency error derivative can be written as follows:
[0097]
[0098] Notice Therefore, the Written in the following form
[0099]
[0100] in
[0101] Consider the following Lyapunov equation
[0102]
[0103] in S is a positive definite matrix, and α1 and α2 are positive constants. Definition -X=-S(GA-FC)-(GA-FC) T S<0. When GA-FC is stable, it is easy to know that matrices D and S exist. is non-negative, so is non-decreasing. Therefore, we can get V p The derivative form of is as follows
[0104]
[0105] in Notice that there is
[0106]
[0107]
[0108] because We can get
[0109]
[0110]
[0111] Define W(QA+A T Q+Q-2QBB T Q, from the P matrix satisfying the conditions, it can be deduced that W>0. Therefore, we can get the following formula
[0112]
[0113] Other And there is
[0114]
[0115] make Choose α2 ≥ γλ max (S / λ min (X, α1≥α3+(α2+γ)α0, so
[0116]
[0117] Let α3 satisfy α3≥max{d i} max (QBB T Q / λ min (Q)λ0), we can get
[0118]
[0119] That is
[0120]
[0121] Therefore, by defining Can be written as
[0122]
[0123] Therefore, we know that V p (t, are bounded, which means that ψ and are all bounded. Since u N is bounded, which means is also bounded, so obviously is bounded. So V pnon-increasing and positive. We can infer The limit is finite. Integrating the above equation gives the following equation
[0124]
[0125] Therefore, it can be known Finite. Since ψ and is bounded, so it can be deduced that The derivative of is also bounded. This means is uniformly continuous. According to Barbara's definition, when t→∞, Therefore, we know that ψ→0, Hence consistency tracking is achieved.
[0126] Further preferably, the state observer is expressed as:
[0127]
[0128] Where E = B[(CB) T CB] -1 (CB) T , G=I+EC, F is the feedback gain matrix and satisfies F(CI)=0, I represents the unit matrix, o i It is an intermediate quantity in the process and has no physical meaning. m represents an m*m unit matrix, j represents different drones, N represents the total number of drones in the drone cluster, a ij represents the adjacent state of UAV i and UAV j, δ ij represents the expected deviation between the i-th UAV and the j-th UAV, and the expected deviation includes a position deviation and a speed deviation.
[0129] Furthermore, the expected deviation between the i-th UAV and the j-th UAV can be expressed as:
[0130] δ ij =δ i -δ j
[0131] Among them, δ i represents the expectation of the i-th UAV, δ j represents the expectation of the j-th UAV, is the expected position of the ith UAV, is the expected speed of the ith UAV, δ j Same reason.
[0132] The state observer proposed in the present invention has extremely high stability, which can be specifically proved by the following theoretical derivation:
[0133] Definition of the estimated error of the consistency error So we can get the estimation error dynamics
[0134]
[0135] Note that (EC+I)B = 0 and F(CI) = 0. If δ v = 0, we have
[0136]
[0137] The estimation error dynamics can thus be transformed into
[0138]
[0139] Consider a candidate Lyapunov function It is easy to prove that when GA-FC is stable, e i It converges gradually to 0, that is, the observer can obtain the observation results stably.
[0140] In a preferred embodiment, a high-order synovial differentiator is used to ci and its derivatives to obtain the control angular velocity ω ci and ci Derivative, and then obtain the control torque τ of the controller i .
[0141] In a preferred embodiment, the thrust controller output u is estimated by a high-order sliding film differentiator i The process of its derivative can be expressed as:
[0142]
[0143]
[0144]
[0145] Wherein, the subscript k = x, y, z, indicating different directions, i.e., u = u x ,u y ,u z ] T ; For u ci An estimated value of For An estimated value of For The estimated value of ; λ0, λ1, λ2 are positive constants.
[0146] In a preferred embodiment, in S1, the torque control can be expressed as:
[0147]
[0148] η i =ω ei +k ε ε i ;
[0149]
[0150] Among them, τ i represents the control torque of the ith UAV, k ε and k η is a positive constant, η i represents the error vector, is the intermediate variable; i is the angular velocity vector of the i-th UAV, J i is the inertia matrix of the i-th UAV; ω ei is the error angular velocity of the i-th UAV, R ei is the error rotation matrix of the i-th UAV, I3 is the three-dimensional unit matrix, I3∈R 3×3 , tr(represents the trace of the matrix, ω ci is the control angular velocity of the i-th UAV.
[0151] Further, according to η i =ω ei +k ε ε i , we can get
[0152]
[0153] Furthermore, the following expression can be obtained:
[0154]
[0155] Furthermore, according to the control torque, we can get The expression is:
[0156]
[0157] In a preferred embodiment, the error rotation matrix R of the i-th UAV is ei It can be expressed as
[0158]
[0159] The error angular velocity ω of the i-th UAV ei It can be expressed as:
[0160]
[0161] in, is the angular velocity of the i-th UAV, is the inertia matrix of the i-th UAV, is the control torque of the ith UAV.
[0162] The torque control proposed in the present invention can well complete the autonomous attitude control of the aircraft. Specifically, it can be proved by the following theoretical derivation:
[0163] Design the following Lyapunov function
[0164]
[0165] Taking the derivative of the above Lyapunov function, we get
[0166]
[0167] According to Definition 2, we can get the following inequality:
[0168]
[0169] Therefore, it can be Simplify to get
[0170]
[0171] where ι i =min{k ε ,2k η / λ(J i )}. So we have
[0172]
[0173] This means that there is and Therefore, it can be inferred that Due to η i =ω ei +k ε ε i , so we can get In addition, from the above formula we can get
[0174]
[0175] Therefore, it is easy to obtain tr(I3-R ei ≠4). Proof: The proposed posture dynamics form is obtained if the initial rotation matrix satisfies tr(I3-R ei(0) )∈[0,4), the proposed applied force formula can achieve and And tr(I3-R ei )≠4.
[0176] According to a preferred embodiment of the present invention, the control angular velocity and its derivative in the torque control are calculated, and the calculation result is used as the aircraft attitude control parameter at the next moment.
[0177] Further preferably, the control angular velocity and its derivative are expressed as:
[0178]
[0179]
[0180] Among them, the control rotation matrix R ci It is expressed as:
[0181]
[0182]
[0183]
[0184]
[0185]
[0186]
[0187]
[0188] Among them, R i1 , R i2 , R i3 , σ i ,φ i , Θ i ,Π,Λ i is the intermediate parameter.
[0189] According to the present invention, in S2, a directed graph is used to construct a drone formation topology structure, such as Figure 2 As shown, it is used to indicate whether there is a path for obtaining information between drones.
[0190] A directed graph is a commonly used form in graph theory. The specific process of constructing a directed graph is a conventional technical means in this field and will not be described in detail in the present invention.
[0191] In the present invention, represents a directed graph, where and are the node set and edge set respectively. Edge (i, j)∈ε means that node i is a neighbor of node j, that is, node j can obtain information from node i. represents the neighbor set of node i. If there is an ordered edge (i k ,i k+1 ),k=1,…,p-1, then we believe that node i1 has p The direct path of The adjacency matrix of It has the following characteristics: (1) a ii =0; (2) If (j,i)∈ε, then a ij >0; (3) otherwise a ij = 0. Laplace matrix There are the following definitions, l ij =-a ij ,i≠j, definition As the neighbor set of node i.
[0192] In S3, the drone's own position and speed, the relative position and speed between the drone and adjacent drones obtained by measurement, and the drone's own attitude information are input into the drone's controller, and the controller outputs the required thrust and torque of the drone at the next moment. Each drone tracks other drones and adjusts their flight attitude based on the thrust and torque, thereby achieving formation tracking of the leading drone.
[0193] Example
[0194] Example 1
[0195] In the simulation experiment, 9 UAVs were used to form a cluster for formation control. The tracking trajectory of the leader was designed as follows
[0196]
[0197] where p x0 , p y0 With p z0 They are the initial point positions of the navigator, set at the origin of the coordinate system.
[0198] The formation control is performed by the following steps:
[0199] S1. Except for the pilot drone, a controller is set in each of the remaining drones;
[0200] S2. Design a directed topology graph so that there is a directed spanning tree, that is, any UAV in the cluster can connect to the pilot UAV through at least one link;
[0201] S3. Except for the pilot UAV, the other UAVs track the UAVs connected to their links through the controller, thereby realizing the formation tracking of the pilot UAV by the cluster.
[0202] In S1, the controller includes thrust control and torque control. The thrust control can be expressed as
[0203]
[0204] in,
[0205] The estimated output of the consistency error in the controller is obtained through the state observer, and the current consistency error of the UAV is obtained. The estimated value is used as the actual value, combined with the current position of the UAV, to obtain the required thrust of the UAV at the next moment.
[0206] The state observer is expressed as:
[0207]
[0208] in,
[0209] Since the control torque design process uses the control angular velocity and its derivative, the control angular velocity and its derivative need to be controlled by the thrust controller u i and its derivatives. Since its expression is complex and difficult to obtain, the high-order synovial differentiator is used to estimate u i The estimation process of and its derivatives can be expressed as:
[0210]
[0211]
[0212]
[0213] In S1, the torque control can be expressed as:
[0214]
[0215] η i =ω ei +k ε ε i ;
[0216]
[0217] Among them, k η =2, k ε =2.
[0218] The control angular velocity and its derivative in torque control are calculated, and the calculation results are used as the aircraft attitude control parameters at the next moment.
[0219] In S2, a directed graph is used to construct a UAV formation, and the result is as follows: Figure 2shown.
[0220] The final tracking effect is as follows Figure 3 As shown in the figure, it can be seen that the cluster can effectively and stably track the flight trajectory of the pilot aircraft.
[0221] Figure 4 The formation tracking error curve of the four UAVs in the cluster is shown. It can be seen from the figure that when the tracking starts, the UAVs will have a small tracking error, but the maximum error is less than 0.7 meters. After 5 seconds, the UAVs in the cluster can accurately track the pilot aircraft.
[0222] In the description of the present invention, it should be noted that the terms "upper", "lower", "inner", "outer", "front", "rear", etc. indicate positions or positional relationships based on the working state of the present invention, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", "third", and "fourth" are only used for descriptive purposes and cannot be understood as indicating or implying relative importance.
[0223] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected" and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0224] The present invention has been described above in conjunction with preferred embodiments, but these embodiments are only exemplary and serve only as an illustration. On this basis, the present invention may be subjected to a variety of substitutions and improvements, all of which fall within the scope of protection of the present invention.
Claims
1. A distributed formation control method for multiple UAV groups based on relative information, characterized in that: The following steps are involved: S1. Set up a controller in each drone except the pilot drone; S2. Use a topology map to form a formation of different drones, so that any drone in the cluster can be connected to the pilot drone through at least one link; S3. Except for the pilot UAV, the other UAVs track the UAVs connected to their links through the controller, thereby realizing the formation tracking of the pilot UAV by the cluster.
2. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 1, characterized in that: In S1, the controller includes thrust control and torque control, and the thrust control can be expressed as: T i =m i ‖u ci ‖ Among them, T i represents the thrust required by the i-th UAV, g is the acceleration due to gravity, m i is the mass of the ith UAV, R i is the rotation matrix of the ith UAV, R ci is the control rotation matrix of the i-th UAV, u ci represents the control input of the ith UAV, u i represents the thrust control quantity of the i-th UAV, Q is a positive definite matrix, K is the feedback gain matrix; β is a positive constant, is the adaptive coupling gain, ξ i represents the consistency error vector, represents the consistency error estimate, B = [0 3×3 ,I 3×3 ] T .
3. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 2, characterized in that: The thrust T required by the i-th UAV i Based on the kinematic and dynamic model design of the UAV, the kinematic and dynamic model of the i-th UAV is expressed as: Among them, is the position of the ith UAV, and is the speed of the ith drone, g is the acceleration due to gravity, m i is the mass of the ith UAV, T i is the applied thrust of the ith UAV, R i is the rotation matrix of the i-th UAV, is the angular velocity of the i-th UAV, is the inertia matrix of the i-th UAV, is the control torque of the ith UAV, R ci is the control rotation matrix of the i-th drone.
4. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 2, characterized in that: In thrust control, the thrust control value u of the i-th UAV is i It is expressed as: Where g is the acceleration due to gravity, m i is the mass of the ith UAV, T i is the applied thrust of the ith UAV, R i is the rotation matrix of the i-th UAV, R ci is the control rotation matrix of the i-th UAV, u ci represents the control input of the i-th UAV.
5. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 2, characterized in that: The state observer uses the relative state measurement information of the UAV to obtain the consistency error estimate This avoids the use of absolute status information of adjacent drones.
6. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 5, characterized in that: The state observer is expressed as: Where E = B[(CB) T CB] -1 (CB) T , G=I+EC, F is the feedback gain matrix and satisfies F(CI)=0, A, B, C are constant matrices, I represents the unit matrix, o i is the process intermediate quantity, I m represents an m*m unit matrix, j represents different drones, N represents the total number of drones in the drone cluster, a ij represents the adjacent state of UAV i and UAV j, δ ij represents the expected deviation between the i-th UAV and the j-th UAV, and the expected deviation includes a position deviation and a speed deviation.
7. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 6, characterized in that: Through the high-order synovial differentiator, u ci and its derivatives to obtain the control angular velocity ω ci and ci Derivative, and then obtain the control torque τ of the controller i .
8. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 7, characterized in that: Through the high-order synovial differentiator, u ci The process of estimating and its derivative form can be expressed as: Wherein, the subscript k = x, y, z, indicating different directions, i.e., u = u x ,u y ,u z ] T ; For u ci An estimated value of For An estimated value of For The estimated value of ; λ0,λ1,λ2 are positive constants.
9. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 7, characterized in that: In S1, the torque control can be expressed as: or i =ω ei +k ε e i ; Among them, τ i represents the control torque of the ith UAV, k ε and k η is a positive constant, η i , is an intermediate variable; ω i is the angular velocity vector of the i-th UAV, J i is the inertia matrix of the i-th UAV; ω ei is the error angular velocity of the i-th UAV, R ei is the error rotation matrix of the i-th UAV, I3 is the three-dimensional unit matrix, tr ( represents the trace of the matrix, ω ci is the control angular velocity of the i-th UAV.
10. The method for controlling a multi-UAV group distributed formation based on relative information according to claim 9, characterized in that: The control angular velocity and its derivative in torque control are estimated, and the estimation results are used as the aircraft attitude control parameters at the next moment.
Citation Information
Patent Citations
Cluster UAV (unmanned aerial vehicle) locus and attitude cooperative control method for safety domain
CN108388270A
Multi-unmanned-aerial-vehicle formation consistency control method based on event-triggered communication
CN111638726A
Quadrotor formation control method without speed measurement under directed interactive topology
CN114153228A
Grouping-based multi-unmanned aerial vehicle formation control method
CN115167515A
Shared control of semi-autonomous vehicles including collision avoidance in multi-agent scenarios
US20150284010A1
