Multi-unmanned system formation control method based on specified time convergence
The method stabilizes multi-unmanned systems by using a virtual leader and sliding mode control to ensure precise convergence at a specified time, addressing instability and collision risks in traditional systems.
Patent Information
- Application Number
- CN202411209238.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-30
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2044-08-30
AI Technical Summary
Traditional multi-unmanned systems struggle to converge to a common target state at a specified time under arbitrary initial states and dynamically changing environments, leading to instability, increased collision risk, and complex control algorithms.
A multi-unmanned system formation control method using a kinematic model with a virtual leader and a sliding mode controller to stabilize the system, ensuring convergence at a specified time by designing a formation controller based on a reference convergence function and sliding mode control.
Enables precise convergence of multi-unmanned systems to a common target state at a specified time, enhancing robustness and stability even under disturbances, thus improving control efficiency and reducing collision risks.
Smart Images

Figure CN119065389A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of unmanned system control, and in particular relates to a multi-unmanned system formation control method based on specified time convergence. Background Art
[0002] In recent years, with the development of other technologies such as robotics, automatic control theory, computer technology, sensor technology, wireless communication technology, etc., unmanned systems with unmanned vehicles as the main background have gradually emerged and have received widespread attention in various fields, and have been applied in fields such as smart agriculture and collaborative assembly. Unmanned systems are usually equipped with sensors, communication equipment, autonomous navigation and control units, and can perform tasks without direct human intervention. A multi-unmanned system cluster refers to multiple unmanned systems working together in a coordinated manner to form a whole to improve efficiency, enhance adaptability and robustness. The cluster can self-organize to adapt to changing task requirements and environmental conditions. In a multi-unmanned system cluster, each unmanned system member may need to collaborate, compete or work together to achieve system-level goals such as consistency, optimization, search, monitoring, etc. Among them, the consistency of a multi-unmanned system cluster refers to the fact that the states of all unmanned systems (such as position, speed, direction, etc.) eventually converge to a common target state, which is a key challenge for the control of a multi-unmanned system cluster, and is also the basis of a multi-unmanned system cluster and the key to its advantages.
[0003] In actual engineering, when a multi-unmanned system cluster is subjected to formation cooperative control, it is necessary to make all the unmanned systems in the formation converge to a common target state under dynamically changing environments and uncertain conditions. However, due to the influence of factors such as initial formation error, interference and noise in the external environment, obstacles in the environment, communication delays between multiple unmanned systems, and bandwidth limitations, the traditional multi-unmanned system formation control method can only make the states of multiple unmanned systems converge to a common target state within a limited time, and cannot meet strict time control requirements. At the same time, this may also cause the formation control to lose stability, increase the risk of collision, and increase the complexity of the control algorithm. Therefore, in view of the consistency problem in the formation control of multiple unmanned systems, the design method of the formation controller is studied so that each unmanned system member in the formation can converge to a common target state at a specified time under any initial state and dynamically changing environment, which has important theoretical research significance and important practical application value. Summary of the invention
[0004] The purpose of the present invention is to solve the problem that multiple unmanned systems cannot converge to a common target state at a specified time under arbitrary initial states and dynamically changing environments, and to propose a multi-unmanned system formation control method based on convergence at a specified time.
[0005] The technical solution adopted by the present invention to solve the above technical problems is: a multi-unmanned system formation control method based on specified time convergence, the method specifically comprises the following steps:
[0006] Step 1: Establish a kinematic model of the multi-unmanned system including position, velocity and control input information;
[0007] Step 2: Take each unmanned system as a follower, and in the multi-unmanned system formation model of actual follower-virtual leader, take the tracking error of each follower relative to the target position and the tracking error of each follower relative to the target speed as the state quantity;
[0008] Based on the reference convergence function ε(t), a reference differential convergence function ψ(s, t) is designed, and then the formation controller is designed according to the state quantity and the reference differential convergence function ψ(s, t);
[0009] Step 3: Based on sliding mode control and the formation controller designed in step 2, design the final formation controller of the multi-unmanned system with disturbances.
[0010] Furthermore, the kinematic model of the multi-unmanned system is established using a state space method.
[0011] Furthermore, the specific process of step one is:
[0012]
[0013] Among them, x i (t) represents the position of the i-th unmanned system, t is the time, x i (t)∈R m , R is a real number, m is the dimension, v i (t) represents the speed of the i-th unmanned system, v i (t)∈R m , represents the position change rate of the i-th unmanned system, represents the speed change rate of the i-th unmanned system, u i (t) represents the control input of the i-th unmanned system, u i (t)∈R m , N is the total number of unmanned systems in the formation.
[0014] Furthermore, in the multi-unmanned system formation model, the second-order system kinematic model of the virtual navigator is:
[0015]
[0016] Among them, x0(t) represents the position of the virtual navigator, x0(t)∈R m , v0(t) represents the speed of the virtual navigator, v0(t)∈R m , represents the rate of change of the virtual navigator's position, represents the speed change rate of the virtual navigator, u0(t) is the acceleration of the virtual navigator.
[0017] Furthermore, the tracking error of each follower relative to the target position and the tracking error of each follower relative to the target speed are taken as state quantities, and the state quantities are specifically:
[0018]
[0019] Among them, e i represents the state of the ith unmanned system, e ix represents the position tracking error of the i-th unmanned system, e iv represents the speed tracking error of the ith unmanned system, h i represents the ideal formation position vector from the i-th unmanned system to the virtual navigator, x i is x i (t) abbreviation, v i Yes i (t), x0 is the abbreviation of x0(t), v0 is the abbreviation of v0(t), 0 m is an m-dimensional zero vector.
[0020] Furthermore, the reference differential convergence function ψ(s, t) is designed based on the reference convergence function ε(t), specifically:
[0021]
[0022] Among them, ε(t) is the reference convergence function, t f is the specified time, η is the adjustment parameter, η>1, and ψ(s,t) is the reference differential convergence function.
[0023] Furthermore, the formation controller is designed according to the state quantity and the reference differential convergence function ψ(s, t), specifically:
[0024]
[0025] Among them, u i represents the control input of the ith unmanned system, u i is u i (t) abbreviation, e i2,d is the velocity tracking error e ivThe expected value of i2,d =-ψ1(σ i1 ,t),ψ1(σ i1 ,t)=η1σ i1 / (t f -t), σ i1 is the actual position tracking error of the i-th unmanned system, η1 is the adjustment parameter, Yes i2,d The first-order derivative of ψ2(σ i2 ,t)=η2σ i2 / (t f -t), σ i2 is the actual speed tracking error of the ith unmanned system, η2 is the adjustment parameter, and t0 is the control start time.
[0026] Furthermore, the adjustment parameters satisfy: η1>2 and η2>1.
[0027] Furthermore, the specific process of step three is:
[0028] The kinematic model of the multi-unmanned system with disturbance is:
[0029]
[0030] Among them, d i (t) is the disturbance of the ith unmanned system, and |d i (t)|≤C1, |·| represents the absolute value, C1 is |d i The upper limit value of (t)|, Yes i The first derivative of (t), C2 is The upper limit value of
[0031] Then the final formation controller u of the i-th unmanned system is i 'for:
[0032] u i ′=u i +u i,disc (7)
[0033] Among them, u i,disc is the control for disturbance constraints imposed according to sliding mode control;
[0034]
[0035] Among them, k i,1 and k i,2 is a positive constant, s i,1 is the sliding mode variable of the ith unmanned system, sign(·) is the sign function, and τ is the integral variable.
[0036] Furthermore, the sliding mode variable s of the i-th unmanned system i,1 for:
[0037]
[0038] in, Yes i The first derivative of .
[0039] The beneficial effects of the present invention are:
[0040] The present invention utilizes a state space method to establish a kinematic model of a multi-unmanned system with position, velocity and control input information, adopts a system formation control mode of a virtual leader-follower, takes the tracking error of each follower in the formation relative to its target position as the state quantity, and designs a controller based on a reference convergence function and a reference differential convergence function, so that the specified state quantity in the multi-unmanned system can converge to the target state at a specified time, and there is no need to consider the initial state of each unmanned system. Therefore, the controller designed by the present invention can enable the multi-unmanned system to strictly complete the ideal formation at a specified time without being affected by the initial formation error.
[0041] At the same time, the method of the present invention also uses sliding mode control to design a matching anti-disturbance function for the controller. When the dynamically changing environment brings disturbances, it can still converge to the target state at a specified time, thereby improving the robustness of the formation control method. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] Figure 1 It is a schematic diagram of the motion trajectory of a multi-unmanned system formation under strictly specified time convergence control;
[0043] Figure 2 is the X-direction position error of the UAV follower under strictly specified time convergence control;
[0044] Figure 3 is the Y-direction position error of the UAV follower under strictly specified time convergence control;
[0045] Figure 4 is the velocity error in the X direction of the UAV follower under strictly specified time convergence control;
[0046] Figure 5 is the velocity error in the Y direction of the UAV follower under strictly specified time convergence control;
[0047] Figure 6 is the position error in the X direction of the unmanned surface ship follower under strict time convergence control;
[0048] Figure 7It is the Y-direction position error of the unmanned surface ship follower under strictly specified time convergence control. DETAILED DESCRIPTION
[0049] Specific implementation method 1: A multi-unmanned system formation control method based on specified time convergence described in this implementation method specifically includes the following steps:
[0050] Step 1: Establish a kinematic model of the multi-unmanned system including position, velocity and control input information;
[0051] Step 2: Take each unmanned system as a follower, and in the multi-unmanned system formation model of actual follower-virtual leader, take the tracking error of each follower relative to the target position and the tracking error of each follower relative to the target speed as the state quantity;
[0052] Based on the reference convergence function ε(t), a reference differential convergence function ψ(s, t) is designed, and then the formation controller is designed according to the state quantity and the reference differential convergence function ψ(s, t);
[0053] Step 3: Based on sliding mode control and the formation controller designed in step 2, design the final formation controller of the multi-unmanned system with disturbances.
[0054] Specific implementation method 2: This implementation method is different from specific implementation method 1 in that the kinematic model of the multi-unmanned system is established using the state space method.
[0055] The other steps and parameters are the same as those in the first embodiment.
[0056] Specific implementation method three: This implementation method is different from specific implementation methods one or two in that the specific process of step one is as follows:
[0057]
[0058] Among them, x i (t) represents the position of the i-th unmanned system, t is the time, x i (t)∈R m , R is a real number, m is the dimension, v i (t) represents the speed of the i-th unmanned system, v i (t)∈R m , represents the position change rate of the i-th unmanned system, represents the speed change rate of the i-th unmanned system, u i (t) represents the control input of the i-th unmanned system, u i (t)∈R m, N is the total number of unmanned systems in the formation.
[0059] The other steps and parameters are the same as those in the first or second embodiment.
[0060] Specific implementation method 4: This implementation method is different from any one of the specific implementation methods 1 to 3 in that, in the multi-unmanned system formation model, the second-order system kinematic model of the virtual navigator is:
[0061]
[0062] Among them, x0(t) represents the position of the virtual navigator, x0(t)∈R m , v0(t) represents the speed of the virtual navigator, v0(t)∈R m , represents the rate of change of the virtual navigator's position, represents the speed change rate of the virtual navigator, u0(t) is the given speed change function, that is, the acceleration of the virtual navigator.
[0063] The other steps and parameters are the same as those in Specific Embodiments 1 to 3.
[0064] The formation model adopted in the present invention is a multi-unmanned system formation model of "actual follower-virtual navigator", in which the information of the virtual navigator is shared by each unmanned system, and each unmanned system can achieve its own movement by obtaining the information of the virtual navigator and the information of the neighboring nodes to achieve the ultimate formation purpose. By designing the control signal u0(t) of the navigator, its motion trajectory is specified, and then the motion trajectory of the formation is indirectly designed. In the formation process, the role of the navigator is to control the route of the entire formation. As a follower, the formation can be controlled by maintaining a certain relative deviation with the navigator. In the actual formation model, the navigator can be either a real individual member or a virtual navigator. The navigator considered in the present invention is a virtual navigator. Since there is no navigator entity, there is no need to worry about the problem of navigator failure.
[0065] Specific implementation mode 5: This implementation mode is different from any one of the specific implementation modes 1 to 4 in that the tracking error of each follower relative to the target position and the tracking error of each follower relative to the target speed are used as state quantities, and the state quantities are specifically:
[0066]
[0067] Among them, e i represents the state of the ith unmanned system, e ix represents the position tracking error of the i-th unmanned system, e ivrepresents the speed tracking error of the ith unmanned system, h i represents the ideal formation position vector from the i-th unmanned system to the virtual navigator, x i is x i (t) abbreviation, v i Yes i (t), x0 is the abbreviation of x0(t), v0 is the abbreviation of v0(t), 0 m is an m-dimensional zero vector.
[0068] The other steps and parameters are the same as those in Specific Embodiments 1 to 4.
[0069] When e i =0, i=1,2,...,N, it means that the multi-unmanned system has achieved the desired formation.
[0070] Specific implementation method 6: This implementation method is different from any one of the specific implementation methods 1 to 5 in that the reference differential convergence function ψ(s, t) is designed based on the reference convergence function ε(t), specifically:
[0071]
[0072] Among them, ε(t) is the reference convergence function, t f is the specified time, η is the adjustment parameter, η>1, and ψ(s,t) is the reference differential convergence function.
[0073] The other steps and parameters are the same as those in Specific Implementation Methods 1 to 5.
[0074] Specific implementation method 7: This implementation method is different from any one of the specific implementation methods 1 to 6 in that the formation controller is designed according to the state quantity and the reference differential convergence function ψ(s, t), specifically:
[0075]
[0076] Among them, u i represents the control input of the ith unmanned system, u i is u i (t) abbreviation, e i2,d is the velocity tracking error e iv The expected value of i2,d =-ψ1(σ i1 ,t),ψ1(σ i1 ,t)=η1σ i1 / (t f -t), σ i1 is the actual position tracking error of the i-th unmanned system, η1 is the adjustment parameter, Yes i2,dThe first-order derivative of ψ2(σ i2 ,t)=η2σ i2 / (t f -t), σ i2 is the actual speed tracking error of the ith unmanned system, η2 is the adjustment parameter, and t0 is the control start time.
[0077] The other steps and parameters are the same as those in Specific Embodiments 1 to 6.
[0078] The present invention uses the reference differential convergence function as the time-varying feedback function, and then designs the controller based on the time-varying feedback function. The controller of the present invention can achieve strict time convergence, which solves the problem that the traditional multi-unmanned system formation control method can only make the states of the multi-unmanned systems converge to a common target state within a limited time, but cannot converge within a strictly specified time and cannot meet the strict time control requirements. Under the action of the formation controller designed by the present invention, when t≥t f Time ix = 0, that is, the multi-unmanned system under consideration can be f Realize formation of team.
[0079] Specific implementation eight: This implementation differs from any one of specific implementations one to seven in that the adjustment parameters satisfy: η1>2 and η2>1.
[0080] The other steps and parameters are the same as those in Specific Embodiments 1 to 7.
[0081] Specific implementation method 9: This implementation method is different from specific implementation methods 1 to 8 in that the specific process of step 3 is as follows:
[0082] The kinematic model of the multi-unmanned system with disturbance is:
[0083]
[0084] Among them, d i (t) is the disturbance of the ith unmanned system, and |d i (t)|≤C1, |·| represents the absolute value, C1 is |d i The upper limit value of (t)|, Yes i The first derivative of (t), C2 is The upper limit value of
[0085] Sliding mode control is used to constrain the impact of disturbances, so the final formation controller u of the i-th unmanned system is i 'for:
[0086] u i ′=ui +u i,disc (7)
[0087] Among them, u i,disc is the control for disturbance constraints imposed according to sliding mode control;
[0088]
[0089] Among them, k i,1 and k i,2 is a positive constant, s i,1 is the sliding mode variable of the ith unmanned system, sign(·) is the sign function, and τ is the integral variable.
[0090] The other steps and parameters are the same as those in Specific Embodiments 1 to 8.
[0091] Specific implementation method 10: This implementation method is different from any one of the specific implementation methods 1 to 9 in that the sliding mode variable s of the i-th unmanned system i,1 for:
[0092]
[0093] in, Yes i The first derivative of .
[0094] The other steps and parameters are the same as those in Specific Embodiments 1 to 9.
[0095] The state trajectory of the multi-unmanned system is initially on the sliding surface, and the disturbance is suppressed from the beginning. i The control achieves the desired instantaneous stability. Under this robust formation control, when t ≥ t f Time ix = 0, that is, the multi-unmanned system under consideration can f Realize formation and have strong robustness to disturbances.
[0096] In order to verify and demonstrate the effectiveness of the formation control algorithm designed by the present invention, the present invention conducts formation control simulation verification with a multi-unmanned system cluster consisting of four drones and two unmanned surface ships as the background, demonstrating the strong robust formation control effect of the multi-unmanned system with specified time convergence of the present invention.
[0097] In the mission environment, the height of UAV followers 1 and 2 is set to Z1 = 10m, the height of UAV followers 3 and 4 is set to Z2 = 5m, and the height of unmanned surface ship followers 1 and 2 is set to Z3 = 0. At the same time, the height of the virtual UAV navigator is set to Z1 = 10m, the height of the virtual unmanned surface ship navigator is set to Z3 = 0, and the initial horizontal positions of the two virtual navigators are set to x0(0) = [0,0] T , the initial velocity is v0(0)=[1,1] T The ideal formation vectors of the six unmanned systems to the virtual navigator are At the same time, the initial positions of the six unmanned systems are set as follows:
[0098] And their initial velocities are all 0.
[0099] Under the control of the method of the present invention, the specified convergence time is set to t f = 2s, the parameters of the UAV follower are η1 = 3, η2 = 2, and the parameters of the unmanned surface ship are μ = 3. The motion trajectory of the multi-unmanned system formation under the control of the method of the present invention is obtained as follows: Figure 1 As shown, the position error of the drone follower is Figure 2 and Figure 3 As shown, the UAV follower speed error is Figure 4 and Figure 5 As shown, the position error of the unmanned surface ship follower is Figure 6 and Figure 7 shown.
[0100] 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 multi-unmanned system formation control method based on specified time convergence, characterized in that: The method specifically comprises the following steps: Step 1: Establish a kinematic model of the multi-unmanned system including position, velocity and control input information; Step 2: Take each unmanned system as a follower, and in the multi-unmanned system formation model of actual follower-virtual leader, take the tracking error of each follower relative to the target position and the tracking error of each follower relative to the target speed as the state quantity; Based on the reference convergence function ε(t), a reference differential convergence function ψ(s, t) is designed, and then the formation controller is designed according to the state quantity and the reference differential convergence function ψ(s, t); Step 3: Based on sliding mode control and the formation controller designed in step 2, design the final formation controller of the multi-unmanned system with disturbances.
2. The multi-unmanned system formation control method based on specified time convergence according to claim 1 is characterized in that: The kinematic model of the multi-unmanned system is established using the state space method.
3. The multi-unmanned system formation control method based on specified time convergence according to claim 1 is characterized in that: The specific process of step one is: Among them, x i (t) represents the position of the i-th unmanned system, t is the time, x i (t)∈R m , R is a real number, m is the dimension, v i (t) represents the speed of the i-th unmanned system, v i (t)∈R m , represents the position change rate of the i-th unmanned system, represents the speed change rate of the i-th unmanned system, u i (t) represents the control input of the i-th unmanned system, u i (t)∈R m , N is the total number of unmanned systems in the formation.
4. The multi-unmanned system formation control method based on specified time convergence according to claim 3 is characterized in that: In the multi-unmanned system formation model, the second-order system kinematic model of the virtual navigator is: Among them, x0(t) represents the position of the virtual navigator, x0(t)∈R m , v0(t) represents the speed of the virtual navigator, v0(t)∈R m , represents the rate of change of the virtual navigator's position, represents the speed change rate of the virtual navigator, u0(t) is the acceleration of the virtual navigator.
5. The multi-unmanned system formation control method based on specified time convergence according to claim 4 is characterized in that: The tracking error of each follower relative to the target position and the tracking error of each follower relative to the target speed are taken as state quantities, and the state quantities are specifically: Among them, e i represents the state of the ith unmanned system, e ix represents the position tracking error of the i-th unmanned system, e iv represents the speed tracking error of the ith unmanned system, h i represents the ideal formation position vector from the i-th unmanned system to the virtual navigator, x i is x i (t) abbreviation, v i Yes i (t), x0 is the abbreviation of x0(t), v0 is the abbreviation of v0(t), 0 m is an m-dimensional zero vector.
6. The multi-unmanned system formation control method based on specified time convergence according to claim 5 is characterized in that: The reference differential convergence function ψ(s, t) is designed based on the reference convergence function ε(t), specifically: Among them, ε(t) is the reference convergence function, t f is the specified time, η is the adjustment parameter, η>1, and ψ(s,t) is the reference differential convergence function.
7. The multi-unmanned system formation control method based on specified time convergence according to claim 6 is characterized in that: The formation controller is designed according to the state quantity and the reference differential convergence function ψ(s, t), specifically: Among them, u i represents the control input of the ith unmanned system, u i is u i (t) abbreviation, e i2,d is the velocity tracking error e iv The expected value of i2,d =-ψ1(σ i1 ,t),ψ1(σ i1 ,t)=η1σ i1 / (t f -t), σ i1 is the actual position tracking error of the i-th unmanned system, η1 is the adjustment parameter, Yes i2,d The first-order derivative of ψ2(σ i2 ,t)=η2σ i2 / (t f -t), σ i2 is the actual speed tracking error of the ith unmanned system, η2 is the adjustment parameter, and t0 is the control start time.
8. The multi-unmanned system formation control method based on specified time convergence according to claim 7 is characterized in that: The adjustment parameters satisfy: η1>2 and η2>1.
9. The multi-unmanned system formation control method based on specified time convergence according to claim 8, characterized in that: The specific process of step three is: The kinematic model of the multi-unmanned system with disturbance is: Among them, d i (t) is the disturbance of the ith unmanned system, and |d i (t)|≤C1, |·| represents the absolute value, C1 is |d i The upper limit value of (t)|, Yes i The first derivative of (t), C2 is The upper limit value of Then the final formation controller u of the i-th unmanned system is i 'for: in i ′=u i +in i,disc (7) Among them, u i,disc is the control for disturbance constraints imposed according to sliding mode control; Among them, k i,1 and k i,2 is a positive constant, s i,1 is the sliding mode variable of the ith unmanned system, sign(·) is the sign function, and τ is the integral variable.
10. The multi-unmanned system formation control method based on specified time convergence according to claim 9, characterized in that: The sliding mode variable s of the i-th unmanned system i,1 for: in, Yes i The first derivative of .
Citation Information
Patent Citations
Multi-agent formation tracking control method and system
CN109445447A
Formation control method for mobile robots under consideration of external interference
CN113110495A
Multi-agent formation control method with variable node number
CN114371625A
Unmanned aerial vehicle-unmanned ship heterogeneous cooperative obstacle avoidance formation control method based on preset performance control
CN118151527A
Flight trajectory planning method and system based on random event capture, and storage medium
WO2024164498A1
