Air-sea heterogeneous unmanned cluster cooperative formation control method under complex confrontation conditions
By constructing a kinematic model and a leader-follower model for heterogeneous air-sea unmanned swarms, and combining communication interference and an adaptive fault observer, the problems of network attacks and actuator failures in the formation control of heterogeneous air-sea unmanned swarms under complex adversarial conditions were solved, and the rapid and accurate tracking and stable control of swarm members were achieved.
Patent Information
- Application Number
- CN202411101127.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2044-08-12
AI Technical Summary
Existing technologies cannot effectively address the impact of cyberattacks and actuator failures in the formation control of heterogeneous air and sea unmanned swarms under complex adversarial conditions, resulting in insufficient security and accuracy of formation control.
A kinematic model of a heterogeneous air-sea unmanned swarm is constructed, a virtual navigator is set, a navigator-follower model is established, and based on this, a communication interference model and an adaptive fault observer are constructed. The cooperative formation control law of the heterogeneous air-sea unmanned swarm is designed, taking into account the impact of countering network attacks and actuator failures.
It achieves effective control of air-sea heterogeneous unmanned swarm cooperative formation under complex combat conditions. The position and velocity tracking errors of the formation members converge within a fixed time, ensuring the stability and safety of the formation configuration.
Smart Images

Figure CN119002549A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of air-sea heterogeneous unmanned swarm collaborative formation control, and in particular to an air-sea heterogeneous unmanned swarm collaborative formation control method under complex confrontation conditions. Background Art
[0002] Among the unmanned swarm projects currently put into practical application, most are single-platform unmanned swarms. However, for diverse tasks and complex environments, unmanned swarms composed of a single platform are difficult to meet the needs. Compared with a single platform, a system composed of a multi-platform heterogeneous unmanned swarm has the characteristics of comprehensive functions, strong adaptability, and strong robustness. It can perform more difficult tasks in more complex environments. Therefore, it is of great practical significance to study the collaborative formation control method of heterogeneous unmanned swarms.
[0003] The existing method discloses a heterogeneous cluster formation tracking control method of UAVs and unmanned vehicles under topology switching, which can enable the cluster system composed of multiple UAVs and unmanned vehicles to form the desired time-varying formation configuration under the topology switching condition while tracking the desired reference trajectory, thereby realizing the distributed time-varying formation tracking motion of the heterogeneous cluster system. However, it is unable to give the exact time of formation convergence, and is unable to complete the formation transformation within a certain time limit. In addition, this method does not take into account the complex confrontation conditions faced in actual situations.
[0004] Under complex confrontation conditions, unmanned swarms need to face various attacks and interferences. It is necessary to consider the impact of adversarial network attacks, the impact of the environment on unmanned swarms, the impact of adversarial network attacks on communications, and the impact of actuator failures in unmanned swarm formation members on formation control. Actuator failures mainly refer to problems with actuators such as motors and servos on the intelligent body, which will cause the intelligent body to be unable to perform the predetermined actions normally, affecting the performance and safety of the entire formation system. Actuator failures usually include but are not limited to stuck failures, bias failures, damage failures and out-of-control failures. In summary, unmanned swarm systems will inevitably encounter various network attacks and interferences in actual environments, which will threaten the security of unmanned swarm formation control. Therefore, studying the unmanned swarm formation control method under complex confrontation conditions is of great significance for the safe control of unmanned swarm formations. Summary of the invention
[0005] In view of the above-mentioned deficiencies in the prior art, the present invention provides a method for controlling an air-sea heterogeneous unmanned cluster collaborative formation under complex confrontation conditions, while taking into account the impact of countermeasures against network attacks on communications, as well as the impact of actuator failures in the members of the air-sea heterogeneous unmanned cluster formation on formation control, thereby realizing the control of the air-sea heterogeneous unmanned cluster collaborative formation under complex confrontation conditions.
[0006] In order to achieve the above-mentioned object of the invention, the technical solution adopted by the present invention is:
[0007] A method for controlling air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions comprises the following steps:
[0008] S1. Construct a kinematic model of an air-sea heterogeneous unmanned swarm, set up a virtual navigator, and construct a leader-follower model based on the kinematic model of an air-sea heterogeneous unmanned swarm and the virtual navigator;
[0009] S2. Based on the leader-follower model, a communication interference model of heterogeneous unmanned swarms in the air and sea is constructed;
[0010] S3. Establish an adaptive fault observer, establish the control law of air-sea heterogeneous unmanned swarm collaborative formation based on the leader-follower model and the adaptive fault observer, and control the air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions according to the communication interference model of the air-sea heterogeneous unmanned swarm and the control law of the air-sea heterogeneous unmanned swarm collaborative formation.
[0011] Furthermore, in step S1, a kinematic model of an air-sea heterogeneous unmanned swarm is constructed, including the following steps:
[0012] A1. Construct a three-degree-of-freedom point model of the UAV;
[0013] A2. Construct a particle model of the unmanned ship;
[0014] A3. Construct a three-degree-of-freedom particle kinematic model for an unmanned underwater vehicle;
[0015] A4. Based on the three-degree-of-freedom particle model of the UAV, the particle model of the unmanned ship and the three-degree-of-freedom particle kinematic model of the unmanned submarine, a kinematic model of heterogeneous unmanned clusters in the air and sea is constructed.
[0016] Furthermore, in step A4, a kinematic model of an air-sea heterogeneous unmanned swarm is constructed based on the three-degree-of-freedom mass model of the UAV, the mass model of the unmanned ship, and the three-degree-of-freedom mass kinematic model of the unmanned underwater vehicle, which is expressed as:
[0017]
[0018] Where: p i (t) is the three-dimensional spatial coordinate of agent i at time t, v i (t) is the speed of agent i at time t, u i (t) is the virtual control input of agent i at time t.
[0019] Furthermore, in the kinematic model of the air-sea heterogeneous unmanned swarm, the conversion relationship between the virtual control input and the actual control input in the kinematic model of the UAV is specifically as follows:
[0020]
[0021] Where: V cn (t) is the actual speed control input of UAV n at time t, χ cn (t) is the actual control input of the heading angle of UAV n at time t, γ cn (t) is the actual control input of the pitch angle of UAV n at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, τ γ is the time constant corresponding to the pitch angle, u xn (t) is the virtual control input of UAV n in the x direction at time t, u yn (t) is the virtual control input of UAV n in the y direction at time t, u zn (t) is the virtual control input of UAV n in the z direction at time t, V n (t) is the speed of UAV n at time t, χ n (t) is the heading angle of UAV n at time t, γ n (t) is the pitch angle of UAV n at time t;
[0022] The conversion relationship between the virtual control input and the actual control input in the kinematic model of the unmanned ship is as follows:
[0023]
[0024] Where: V cl (t) is the actual control input of the speed of the unmanned ship l at time t, ψ cl (t) is the actual control input of the heading angle of the unmanned ship l at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, u xl (t) is the virtual control input of the unmanned ship l in the x direction at time t, u yl (t) is the virtual control input of the unmanned ship l in the y direction at time t, V l (t) is the speed of the unmanned ship l at time t, ψ l (t) is the heading angle of the unmanned ship l at time t;
[0025] The conversion relationship between virtual control input and actual control input in the kinematic model of the unmanned underwater vehicle is as follows:
[0026]
[0027] Where: V ck(t) is the actual control input of the speed of the unmanned underwater vehicle k at time t, ψ ck (t) is the actual control input of the heading angle of the unmanned underwater vehicle k at time t, θ ck (t) is the actual control input of the longitudinal inclination angle of the unmanned underwater vehicle k at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, τ γ is the time constant corresponding to the longitudinal inclination angle, u xk (t) is the virtual control input of the unmanned underwater vehicle k in the x direction at time t, u yk (t) is the virtual control input of the unmanned underwater vehicle k in the y direction at time t, u zk (t) is the virtual control input of the unmanned underwater vehicle k in the z direction at time t, V k (t) is the speed of the unmanned underwater vehicle k at time t, ψ k (t) is the heading angle of the unmanned underwater vehicle k at time t, θ k (t) is the longitudinal inclination angle of the unmanned underwater vehicle k at time t.
[0028] Furthermore, in step S2, based on the leader-follower model, a communication interference model of the air-sea heterogeneous unmanned cluster is constructed, which is expressed as:
[0029] G δ(t) =(V, E δ(t) , A δ(t) )
[0030] Where: G δ(t) is an undirected graph with switching topology associated with time t, V is the velocity, E δ(t) and A δ(t) are the edge set and adjacency matrix associated with time t, respectively, and δ(t) is the switching signal of the communication topology.
[0031] Furthermore, in step S3, an adaptive fault observer is established, including the following steps:
[0032] B1. Setting the adaptive gain of the adaptive fault observer;
[0033] B2. Establish an adaptive fault observer according to the adaptive gain of the adaptive fault observer.
[0034] Further, in step B1, the adaptive gain of the adaptive fault observer is set, which is expressed as:
[0035]
[0036] Where: k d1 and k d2All are adaptive gain, s d is the auxiliary sliding variable, σ d is an arbitrary threshold greater than zero, and ω1, γ1, and ε1 are all constants with positive signs.
[0037] Further, in step B2, an adaptive fault observer is established according to the adaptive gain of the adaptive fault observer, which is expressed as:
[0038]
[0039] in: and All are sliding variables, u i is the control output of agent i, k d1 and k d2 All are adaptive gain, s d Auxiliary sliding variable.
[0040] Furthermore, based on the leader-follower model and the adaptive fault observer, the control law of the air-sea heterogeneous unmanned swarm collaborative formation is established, which is expressed as:
[0041]
[0042] Where: u i is the control output of agent i, l1 and l2 are the arrival law parameters, sig is the control law function, p2 and g2 are the control law parameters, s i is the fixed time sliding surface, Ψ i is the control compensation term, f si (e pi ) is the position tracking error e pi is the sliding mode function of the variable, is the observed value of the adaptive fault observer.
[0043] The present invention has the following beneficial effects:
[0044] (1) The present invention constructs a kinematic model of an air-sea heterogeneous unmanned cluster, sets a virtual navigator, and constructs a leader-follower model based on the kinematic model of the air-sea heterogeneous unmanned cluster and the virtual navigator. Then, based on the leader-follower model, a communication interference model of the air-sea heterogeneous unmanned cluster is constructed. Finally, an adaptive fault observer is established. Based on the leader-follower model and the adaptive fault observer, a control law for the coordinated formation of the air-sea heterogeneous unmanned cluster is established. The coordinated formation of the air-sea heterogeneous unmanned cluster under complex confrontation conditions is controlled according to the communication interference model of the air-sea heterogeneous unmanned cluster and the control law for the coordinated formation of the air-sea heterogeneous unmanned cluster. This process simultaneously considers the impact of the confrontation network attack on the communication and the impact of the actuator failure in the air-sea heterogeneous unmanned cluster formation members on the formation control, thereby realizing the control of the coordinated formation of the air-sea heterogeneous unmanned cluster under complex confrontation conditions.
[0045] (2) The present invention establishes a collaborative formation control law for heterogeneous unmanned aerial vehicle swarms in the air and at sea, which can complete the desired formation configuration task of the heterogeneous unmanned aerial vehicle swarm within a fixed time, and can control the position tracking error and speed tracking error of the formation members to converge to a certain range within a fixed time. BRIEF DESCRIPTION OF THE DRAWINGS
[0046] Figure 1 It is a flow chart of a method for controlling air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions;
[0047] Figure 2 This is a schematic diagram of the three-dimensional motion trajectory of the air-sea heterogeneous unmanned swarm;
[0048] Figure 3 It is the curve diagram of actual control command change;
[0049] Figure 4a It is the position tracking error map of UAV formation members;
[0050] Figure 4b It is the velocity tracking error diagram of the UAV formation members;
[0051] Figure 5a It is the position tracking error map of USV formation members;
[0052] Figure 5b It is the speed tracking error diagram of USV formation members;
[0053] Figure 6a It is the position tracking error map of UUV formation members;
[0054] Figure 6b This is the velocity tracking error diagram of the UUV formation members. DETAILED DESCRIPTION
[0055] The specific implementation modes of the present invention are described below so that those skilled in the art can understand the present invention. However, it should be clear that the present invention is not limited to the scope of the specific implementation modes. For those of ordinary skill in the art, as long as various changes are within the spirit and scope of the present invention as defined and determined by the attached claims, these changes are obvious, and all inventions and creations utilizing the concept of the present invention are protected.
[0056] like Figure 1 As shown, a method for controlling air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions includes steps S1-S3, which are specifically as follows:
[0057] S1. Construct a kinematic model of an air-sea heterogeneous unmanned swarm, set up a virtual navigator, and construct a leader-follower model based on the kinematic model of an air-sea heterogeneous unmanned swarm and the virtual navigator.
[0058] In an optional embodiment of the present invention, the present invention constructs a kinematic model of an air-sea heterogeneous unmanned swarm, including the following steps:
[0059] A1. Construct the three-degree-of-freedom point model of the UAV, expressed as:
[0060]
[0061] Among them: n∈{i|i=1, 2,..., N}, x n (t), y n (t), z n (t) are the x-coordinate, y-coordinate, and z-coordinate of the nth UAV at time t, respectively. V n (t), χ n (t), γ n (t) are velocity, heading angle, and pitch angle, respectively, V cn (t), χ cn (t), γ cn (t) are their control input, τ V , τ χ , τ γ are their corresponding time constants respectively.
[0062] A2. Construct a particle model of the unmanned ship, expressed as:
[0063]
[0064] Among them: l∈{i|i=1, 2,..., N}, x l (t) and y l (t) are the x-direction coordinates and y-direction coordinates of the lth unmanned ship at time t, V l (t) and ψ l(t) are the speed and heading angle of the lth unmanned ship at time t, V cl (t),ψ cl (t) are their control input, τ V , τ ψ are their corresponding time constants respectively.
[0065] A3. Construct a three-degree-of-freedom particle kinematic model of the unmanned underwater vehicle, expressed as:
[0066]
[0067] Among them: k∈{i|i=1, 2,..., N}, x k (t), y k (t), z k (t) are the x-coordinate, y-coordinate and z-coordinate of the kth unmanned underwater vehicle at time t, V k (t),ψ k (t),θ k (t) are the speed, heading angle, and longitudinal inclination angle of the kth unmanned underwater vehicle at time t, V cl (t),ψ cl (t),θ ck (t) are their control input, τ V , τx, τ θ are their corresponding time constants respectively.
[0068] A4. Based on the three-degree-of-freedom particle model of the UAV, the particle model of the unmanned ship and the three-degree-of-freedom particle kinematic model of the unmanned submarine, a kinematic model of heterogeneous unmanned clusters in the air and sea is constructed.
[0069] In order to facilitate the design of subsequent control algorithms, the three-degree-of-freedom particle model of the UAV, the particle model of the unmanned ship, and the three-degree-of-freedom particle kinematic model of the unmanned underwater vehicle are simplified into a second-order integrator to construct a kinematic model of the air-sea heterogeneous unmanned cluster, which can be expressed as:
[0070]
[0071] Where: p i (t) is the three-dimensional spatial coordinate of agent i at time t, p i (t) = [p xi (t),p yi (t),p zi (t)] T , v i (t) is the speed of agent i at time t, v i (t) = [v xi (t),v yi (t),vzi (t)] T ,u i (t) is the virtual control input of agent i at time t, u i (t)=[u xi (t),u yi (t),u zi (t)] T .
[0072] In the kinematic model of the air-sea heterogeneous unmanned swarm, the conversion relationship between the virtual control input and the actual control input in the kinematic model of the unmanned aerial vehicle is specifically as follows:
[0073]
[0074] Where: V cn (t) is the actual speed control input of UAV n at time t, χ cn (t) is the actual control input of the heading angle of UAV n at time t, γ cn (t) is the actual control input of the pitch angle of UAV n at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, τ γ is the time constant corresponding to the pitch angle, u xn (t) is the virtual control input of UAV n in the x direction at time t, u yn (t) is the virtual control input of UAV n in the y direction at time t, u zn (t) is the virtual control input of UAV n in the z direction at time t, V n (t) is the speed of UAV n at time t, χ n (t) is the heading angle of UAV n at time t, γ n (t) is the pitch angle of UAV n at time t.
[0075] The conversion relationship between the virtual control input and the actual control input in the kinematic model of the unmanned ship is as follows:
[0076]
[0077] Where: V cl (t) is the actual control input of the speed of the unmanned ship l at time t, ψ cl (t) is the actual control input of the heading angle of the unmanned ship l at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, u xl (t) is the virtual control input of the unmanned ship l in the x direction at time t, u yl(t) is the virtual control input of the unmanned ship l in the y direction at time t, V l (t) is the speed of the unmanned ship l at time t, ψ l (t) is the heading angle of the unmanned ship l at time t.
[0078] The conversion relationship between virtual control input and actual control input in the kinematic model of the unmanned underwater vehicle is as follows:
[0079]
[0080] Where: V ck (t) is the actual control input of the speed of the unmanned underwater vehicle k at time t, ψ ck (t) is the actual control input of the heading angle of the unmanned underwater vehicle k at time t, θ ck (t) is the actual control input of the longitudinal inclination angle of the unmanned underwater vehicle k at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, τ γ is the time constant corresponding to the longitudinal inclination angle, u xk (t) is the virtual control input of the unmanned underwater vehicle k in the x direction at time t, u yk (t) is the virtual control input of the unmanned underwater vehicle k in the y direction at time t, u zk (t) is the virtual control input of the unmanned underwater vehicle k in the z direction at time t, V k (t) is the speed of the unmanned underwater vehicle k at time t, ψ k (t) is the heading angle of the unmanned underwater vehicle k at time t, θ k (t) is the longitudinal inclination angle of the unmanned underwater vehicle k at time t.
[0081] The present invention sets a virtual navigator and establishes a virtual navigator and follower model, and completes the task of tracking the reference trajectory and forming the formation by controlling the movement of the virtual navigator.
[0082] The present invention designs the model of the virtual navigator into the following form:
[0083]
[0084] Where: p0(t) is the three-dimensional spatial position coordinate of the virtual navigator at time t, v0(t) is the speed of the virtual navigator at time t, and u0(t) is the virtual control input of the virtual navigator at time t.
[0085] S2. Based on the leader-follower model, a communication interference model of heterogeneous unmanned swarms in the air and sea is constructed.
[0086] In an optional embodiment of the present invention, the present invention constructs a communication interference model of an air-sea heterogeneous unmanned cluster based on a leader-follower model, which is expressed as:
[0087] G δ(t) =(V, E δ(t) , A δ(t) )
[0088] Where: G δ(t) is an undirected graph with switching topology associated with time t, V is the velocity, E δ(t) and A δ(t) are the edge set and adjacency matrix associated with time t, respectively, and δ(t) is the switching signal of the communication topology.
[0089] The present invention takes into account the impact of countering network attacks on communication. When the communication link between two formation members is attacked, the communication link is disconnected. If the communication link between the formation members is destroyed, the system can enable the communication plan, that is, the attacked formation member can connect the communication link with the unattacked formation by itself, and then re-establish communication with the system to ensure the connectivity of the topology graph. The present invention describes the impact of countering network attacks on communication as switching of communication topology, and uses the above undirected graph with switching topology to provide the communication topology structure of the air-sea heterogeneous unmanned cluster.
[0090] S3. Establish an adaptive fault observer, establish the control law of air-sea heterogeneous unmanned swarm collaborative formation based on the leader-follower model and the adaptive fault observer, and control the air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions according to the communication interference model of the air-sea heterogeneous unmanned swarm and the control law of the air-sea heterogeneous unmanned swarm collaborative formation.
[0091] In an optional embodiment of the present invention, the present invention establishes an adaptive fault observer, comprising the following steps:
[0092] B1. Set the adaptive gain of the adaptive fault observer, expressed as:
[0093]
[0094] Where: k d1 and k d2 All are adaptive gain, s d is the auxiliary sliding variable, σ d is an arbitrary threshold greater than zero, and ω1, γ1, and ε1 are all constants with positive signs.
[0095] Specifically, the actuator fault model in this paper can be described as follows:
[0096]
[0097] Where: u ic (t) is the desired control input command, is the control instruction actually received, d i =[d xi ,d yi ,d zi ] T For unknown paranoid failure.
[0098] When considering the influence of actuator failure, the second-order integrator model of the intelligent agent is constructed based on the air-sea heterogeneous unmanned swarm kinematic model as follows:
[0099]
[0100] B2. According to the adaptive gain of the adaptive fault observer, an adaptive fault observer is established, which is expressed as:
[0101]
[0102] in: and All are sliding variables, u i is the control output of agent i, k d1 and k d2 All are adaptive gain, s d Auxiliary sliding variable.
[0103] Auxiliary sliding variables, have the following form:
[0104]
[0105] Where: v i is the speed of agent i.
[0106] The present invention defines the observation error of the fault as:
[0107]
[0108] The auxiliary sliding variable s d The observation error of the fault d Satisfies the following state equation:
[0109]
[0110] The present invention sets the derivative of the actuator fault is bounded but the upper bound is unknown, therefore, consider the auxiliary sliding variable s d The observation error of the fault dSatisfying the above state equation, when the adaptive fault observer is designed as the above form, the adaptive gain of the adaptive fault observer is set to satisfy the above form, then there are positive constants ω1, γ1 and ε1 so that the observation error e of the fault d converges to zero in finite time.
[0111] The present invention establishes the air-sea heterogeneous unmanned swarm collaborative formation control law based on the leader-follower model and the adaptive fault observer, which is:
[0112]
[0113] Where: u i is the control output of agent i, l1 and l2 are the arrival law parameters, l1>0, l2>0, sig is the control law function, p2 and g2 are the control law parameters, 0 <p2<1,g2> 1,s ii is the fixed time sliding surface, Ψ i is the control compensation term, f si (e pi ) is the position tracking error e pi is the sliding mode function of the variable, is the observed value of the adaptive fault observer.
[0114] The control compensation term in the present invention is:
[0115] Ψ i =[Ψ i1 ,Ψ i2 , Ψxx] T ∈R 3 ,
[0116]
[0117] Among them: i1 ,Ψ i2 ,Ψ i3 are the control compensation items of UAV, UAV ship and UUV respectively, T is the transposition symbol, m=1,2,3, R,κ i , k u , ζ are constants, κ i , k u and ζ satisfy κ i ≥||u di ||, k u >0,ζ>0,u di is a constant with a known upper bound.
[0118] Control compensation term Ψ i With sliding surface s i Satisfies the following relationship:
[0119]
[0120] In the present invention, the position tracking error e pi is the sliding mode function of the variable, expressed as:
[0121]
[0122] in: They are UAV, unmanned ship and unmanned submarine. pi is the first-order derivative of the design function of the variable, a1, b1, a2, b2, m are all pre-designed constants, e vim is the component of velocity tracking error.
[0123] The present invention adopts the communication interference model of the air-sea heterogeneous unmanned cluster to always maintain communication connectivity. Under the condition of actuator failure, the above-mentioned air-sea heterogeneous unmanned cluster collaborative formation control law is adopted, and all variables in the closed-loop system are consistent and ultimately bounded.
[0124] In order to better demonstrate the effectiveness of the method provided by the present invention in controlling the air-sea heterogeneous unmanned swarm to perform formation tasks under complex confrontation conditions, a set of control experiments is set up to compare the control effects. When other conditions are exactly the same, the formation is first controlled using a formation control method based on sliding mode consistency. The controller does not consider the influence of external interference, but only considers the formation control task under ideal conditions.
[0125] Under the same conditions, the present invention uses the communication interference model of the air-sea heterogeneous unmanned swarm and the air-sea heterogeneous unmanned swarm cooperative formation control law designed by the present invention to control the air-sea heterogeneous unmanned swarm formation. The results of the simulation experiment are shown in Figure 2. Figures 2 to 6b As shown. Among them, Figure 2 This is a schematic diagram of the three-dimensional motion trajectory of a heterogeneous unmanned swarm in the air and sea. From the figure, we can see that the unmanned swarm quickly converges from the randomly distributed initial position to the configuration of the desired formation, and continues to move forward in a stable formation. Figure 3 This is a curve diagram of the actual control command changes. From the figure, we can see that under the action of the controller, the speed, yaw angle, and pitch angle of each member in the formation quickly converge to the expected values, which means that the unmanned cluster completed the desired formation configuration in a short time. Figures 4a to 6b is the state tracking error of each member of the air-sea heterogeneous unmanned swarm, Figure 4a is the position tracking error of the UAV formation members, Figure 4b is the velocity tracking error of the UAV formation members, Figure 5a is the position tracking error of the USV formation members, Figure 5b is the speed tracking error of USV formation members, Figure 6a is the position tracking error of the UUV formation members, Figure 6b is the speed tracking error of the UUV formation members. From these figures, we can see that the state tracking error of each formation member converges to zero within 15 seconds, which means that under the action of the controller, the formation control task of the air-sea heterogeneous unmanned swarm completed the expected formation configuration within 15 seconds under complex confrontation conditions.
[0126] Through the comparative analysis of the above two sets of simulation experiments, it can be seen that under complex confrontation conditions with denial of service attacks and actuator failures, the controller designed under ideal conditions based on the sliding mode consistency method is not effective in controlling the air-sea heterogeneous unmanned swarm formation, and the state tracking error of each formation member has large fluctuations, which means that the unmanned swarm cannot complete the desired formation configuration well. Under the control of the controller designed by the present invention, the air-sea heterogeneous unmanned swarm can complete the desired formation configuration under complex confrontation conditions. Therefore, the simulation experiments designed in this section verify the effectiveness of the control algorithm designed in this chapter.
[0127] The present invention is described with reference to flowcharts and / or block diagrams of methods, devices (systems), and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0128] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0129] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 A step that specifies a function in one or more boxes.
[0130] The present invention uses specific embodiments to illustrate the principles and implementation methods of the present invention. The description of the above embodiments is only used to help understand the method of the present invention and its core idea. At the same time, for those skilled in the art, according to the idea of the present invention, there will be changes in the specific implementation methods and application scope. In summary, the content of this specification should not be understood as a limitation on the present invention.
[0131] Those skilled in the art will appreciate that the embodiments described herein are intended to help readers understand the principles of the present invention, and should be understood that the protection scope of the present invention is not limited to such specific statements and embodiments. Those skilled in the art can make various other specific variations and combinations that do not deviate from the essence of the present invention based on the technical revelations disclosed by the present invention, and these variations and combinations are still within the protection scope of the present invention.
Claims
1. A method for controlling air-sea heterogeneous unmanned swarm collaborative formations under complex confrontation conditions. It is characterized in that The following steps are involved: S1. Construct a kinematic model of an air-sea heterogeneous unmanned swarm, set up a virtual navigator, and construct a leader-follower model based on the kinematic model of an air-sea heterogeneous unmanned swarm and the virtual navigator; S2. Based on the leader-follower model, a communication interference model of heterogeneous unmanned swarms in the air and sea is constructed; S3. Establish an adaptive fault observer, establish the control law of air-sea heterogeneous unmanned swarm collaborative formation based on the leader-follower model and the adaptive fault observer, and control the air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions according to the communication interference model of the air-sea heterogeneous unmanned swarm and the control law of the air-sea heterogeneous unmanned swarm collaborative formation.
2. According to the method for controlling the air-sea heterogeneous unmanned swarm coordinated formation under complex confrontation conditions described in claim 1, It is characterized in that In step S1, a kinematic model of an air-sea heterogeneous unmanned swarm is constructed, including the following steps: A1. Construct a three-degree-of-freedom point model of the UAV; A2. Construct a particle model of the unmanned ship; A3. Construct a three-degree-of-freedom particle kinematic model for an unmanned underwater vehicle; A4. Based on the three-degree-of-freedom particle model of the UAV, the particle model of the unmanned ship and the three-degree-of-freedom particle kinematic model of the unmanned submarine, a kinematic model of heterogeneous unmanned clusters in the air and sea is constructed.
3. According to the method for controlling the air-sea heterogeneous unmanned swarm coordinated formation under complex confrontation conditions described in claim 2, It is characterized in that In step A4, the kinematic model of the air-sea heterogeneous unmanned swarm is constructed based on the three-degree-of-freedom mass model of the UAV, the mass model of the unmanned ship, and the three-degree-of-freedom mass kinematic model of the unmanned underwater vehicle, which is expressed as: Where: p i (t) is the three-dimensional spatial coordinate of agent i at time t, v i (t) is the speed of agent i at time t, u i (t) is the virtual control input of agent i at time t.
4. According to the method for controlling the air-sea heterogeneous unmanned swarm coordinated formation under complex confrontation conditions described in claim 3, It is characterized in that In the kinematic model of heterogeneous unmanned swarm in air and sea, the conversion relationship between virtual control input and actual control input in the kinematic model of UAV is as follows: Where: V cn (t) is the actual speed control input of UAV n at time t, χ cn (t) is the actual control input of the heading angle of UAV n at time t, γ cn (t) is the actual control input of the pitch angle of UAV n at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, τ γ is the time constant corresponding to the pitch angle, u xn (t) is the virtual control input of UAV n in the x direction at time t, u yn (t) is the virtual control input of UAV n in the y direction at time t, u zn (t) is the virtual control input of UAV n in the z direction at time t, V n (t) is the speed of UAV n at time t, χ n (t) is the heading angle of UAV n at time t, γ n (t) is the pitch angle of UAV n at time t; The conversion relationship between the virtual control input and the actual control input in the kinematic model of the unmanned ship is as follows: Where: V cl (t) is the actual control input of the speed of the unmanned ship l at time t, ψ cl (t) is the actual control input of the heading angle of the unmanned ship l at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, u xl (t) is the virtual control input of the unmanned ship l in the x direction at time t, u yl (t) is the virtual control input of the unmanned ship l in the y direction at time t, V l (t) is the speed of the unmanned ship l at time t, ψ l (t) is the heading angle of the unmanned ship l at time t; The conversion relationship between virtual control input and actual control input in the kinematic model of the unmanned underwater vehicle is as follows: Where: V ck (t) is the actual control input of the speed of the unmanned underwater vehicle k at time t, ψ ck (t) is the actual control input of the heading angle of the unmanned underwater vehicle k at time t, θ ck (t) is the actual control input of the longitudinal inclination angle of the unmanned underwater vehicle k at time t, τ V is the time constant corresponding to the speed, τ χ is the time constant corresponding to the heading angle, τ γ is the time constant corresponding to the longitudinal inclination angle, u xk (t) is the virtual control input of the unmanned underwater vehicle k in the x direction at time t, u yk (t) is the virtual control input of the unmanned underwater vehicle k in the y direction at time t, u zk (t) is the virtual control input of the unmanned underwater vehicle k in the z direction at time t, V k (t) is the speed of the unmanned underwater vehicle k at time t, ψ k (t) is the heading angle of the unmanned underwater vehicle k at time t, θ k (t) is the longitudinal inclination angle of the unmanned underwater vehicle k at time t.
5. According to the method for controlling the air-sea heterogeneous unmanned swarm coordinated formation under complex confrontation conditions described in claim 1, It is characterized in that In step S2, based on the leader-follower model, a communication interference model of the air-sea heterogeneous unmanned cluster is constructed, which is expressed as: G δ(t) =(V,E δ(t) ,A δ(t) ) Where: G δ(t) is an undirected graph with switching topology associated with time t, V is the velocity, E δ(t) and A δ(t) are the edge set and adjacency matrix associated with time t, respectively, and δ(t) is the switching signal of the communication topology.
6. According to the method for controlling the air-sea heterogeneous unmanned swarm coordinated formation under complex confrontation conditions described in claim 1, It is characterized in that In step S3, an adaptive fault observer is established, including the following steps: B1. Setting the adaptive gain of the adaptive fault observer; B2. Establish an adaptive fault observer according to the adaptive gain of the adaptive fault observer.
7. According to claim 6, a method for controlling air-sea heterogeneous unmanned swarm collaborative formation under complex confrontation conditions, It is characterized in that In step B1, the adaptive gain of the adaptive fault observer is set, which is expressed as: Where: k d1 and k d2 All are adaptive gain, s d is the auxiliary sliding variable, σ d is any threshold greater than zero, ω 1 , γ 1 , ε 1 are all constants with positive signs.
8. According to claim 6, a method for controlling air-sea heterogeneous unmanned swarm collaborative formations under complex confrontation conditions, It is characterized in that In step B2, an adaptive fault observer is established according to the adaptive gain of the adaptive fault observer, which is expressed as: in: and are all sliding variables, u i is the control output of agent i, k d1 and k d2 All are adaptive gain, s d Auxiliary sliding variable.
9. According to the method for controlling air-sea heterogeneous unmanned swarm coordinated formation under complex confrontation conditions described in claim 1, It is characterized in that Based on the leader-follower model and adaptive fault observer, the control law of air-sea heterogeneous unmanned swarm cooperative formation is established, which is expressed as: Where: u i is the control output of agent i, l 1 and l 2 is the arrival law parameter, sig is the control law function, p 2 and g 2 is the control law parameter, s i is the fixed time sliding surface, Ψ i is the control compensation term, f si (e pi ) is the position tracking error e pi is the sliding mode function of the variable, is the observed value of the adaptive fault observer.
Citation Information
Patent Citations
Optimization self-adaptation-based offshore heterogeneous multi-agent speed cooperative control method
CN110515298A
Heterogeneous multi-unmanned-system formation and cooperative target expelling method
CN112612212A
Distributed sea area cross-medium heterogeneous system consistency formation method
CN113342015A
Heterogeneous unmanned cluster formation obstacle avoidance method and system
CN115033016A
Multi-unmanned ship fixed time distributed formation control method based on backstepping technology
CN115903824A
