Cluster cooperative control method based on dual-leader mode with azimuth measurement only
By adopting dual-leader mode and azimuth measurement information in the drone cluster, the problem of leaders in the unmanned aerial vehicle cannot indicate the direction of travel and detection capabilities in the coordinated operation of the drone is solved, and the automatic rotation and scaling of the drone cluster is achieved. Control simplifies hardware equipment, reduces costs, and achieves task goals.
Patent Information
- Application Number
- CN202210890434.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-27
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2042-07-27
AI Technical Summary
In the coordinated operation of multiple drones, a single leader cannot indicate the direction of the formation, and the detection capabilities of the drone are limited, and global or local coordinate information cannot be obtained, which affects the efficiency of cluster control.
Using a dual-leader model based on azimuth measurement, the UAV cluster is realized by assigning leaders, deputy leaders and followers, using adjacency matrix to specify communication relationships, and using azimuth measurement information to design triangular positioning and motion control law. the formation follows the behavior.
It simplifies hardware equipment, reduces costs, realizes automatic rotation and scaling control of drone clusters, and can collaborate in unknown areas to complete task goals.
Smart Images

Figure CN115145312B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of cluster intelligent control, and in particular relates to a cluster collaborative control method based on a dual-leader mode under azimuth measurement only. Background Art
[0002] With the improvement of automation and electronic technologies in recent years, the application fields of using drones with certain autonomous mission capabilities to perform tasks have made great progress, such as agricultural plant protection, emergency search and rescue, etc. Compared with the current more common single-machine operation mode, the collaborative operation of multiple drones can increase the amount of tasks completed within a unit mission time and reduce the overall time to complete the task. In order to avoid overlapping mission areas, affecting efficiency, and colliding with each other and causing losses, multiple drones need to design communication methods between multiple drones and control laws for each drone to control their paths and behaviors.
[0003] In the field of multi-UAV control, the leader-follower formation method is a commonly used method, but a single leader cannot indicate the direction of travel of the formation, nor does it have a length scale. Using a dual-leader design, the leader role can be expanded to a rigid body with a large and directional size, thereby enhancing the control capability of followers in the cluster. In cluster control, it is usually necessary for follower drones to obtain the global coordinates, local coordinates or distance information of other intelligent bodies through sensors or communications for positioning. If the detection capability of the drone is limited and the above three types of information cannot be obtained, the relative azimuth measurement information of other drones can be obtained based on simple sensors. The present invention provides a cluster collaborative control scheme based on dual-leader constraints under azimuth measurement only. Summary of the invention
[0004] In order to solve the above technical problems, the present invention proposes a cluster control method based on a dual-leader mode with only azimuth measurement.
[0005] The technical solution adopted by the present invention is: a cluster control method based on a dual-leader mode under azimuth measurement only, and the specific steps are as follows:
[0006] S1. Assign identities to all agents in the drone cluster and determine the leader, deputy leader, and remaining followers;
[0007] S2. Use the adjacency matrix to define the communication relationship between each UAV in the formation;
[0008] S3, the drone calculates its position using the azimuth measurement information;
[0009] S4, the UAV inputs the motion control law according to the target error and completes the formation following behavior;
[0010] S5. Determine whether the agent has reached the target position. If so, end the process. If not, return to step S3.
[0011] Furthermore, the roles in the drone cluster include a leader, a first follower as a deputy leader, and a number of other followers, a total of three types. The leader and the first follower are allowed to carry more complex detectors and communication equipment to complete advanced tasks in formation control, while the other followers are only equipped with detectors and communication equipment sufficient to obtain relative azimuth measurement information of the dual leader drones.
[0012] Furthermore, in step S2, for an intelligent formation with n drones in dual-leader mode, the adjacency matrix representing the information acquisition relationship is determined as:
[0013]
[0014] Among them, the element a in the adjacency matrix ij , which means the information flow capability from the UAV numbered i to the UAV numbered j. If it is 0, it cannot flow, and if it is 1, it can flow. ij =a ji The information between the drone numbered i and the drone numbered j is bidirectional, and here the adjacency matrix indicates that the information from the dual leaders to the remaining followers is transmitted unidirectionally.
[0015] Furthermore, in step S3, the drone can use the azimuth measurement information of the leader and the first follower in its own coordinate system to triangulate the dual leader rigid bodies to determine its own position. The intelligent agent n can obtain the angle between its own forward direction and the global coordinate system as θ asn , the distance between the leader and the first follower is ρ s , and this forms a dual leader rigid body, which is in the nth follower coordinate system C n The relative angle θ snl and θ sns1 , then we can calculate the position of the drone follower n in the leader coordinate system C l The current position is s n =(x n ,y n ) T , where T represents the matrix transpose, (x n ,y n ) is the two-dimensional coordinate value of the drone follower n at this time, and the calculation method is as follows:
[0016]
[0017] In step S4, the nth follower UAV can obtain its target position s in the leader coordinate system t , according to the calculated s n , the error value of the relative target position is calculated as
[0018] Furthermore, in step S4, The design control rate is:
[0019]
[0020] Among them, ω fi is the direction the agent is pointing to, u fi is the speed target of the agent at this time. Under the constraints of the two, the follower agent converges to the expected position in the formation; K ai is the amplitude parameter, which, combined with the physical meaning of the system, is the maximum movement speed allowed by the follower; K fi It is a frequency parameter. By properly adjusting its parameter value, the control effect of the system can be adjusted.
[0021] Furthermore, in step S5, a sufficiently small judgment threshold is set. Represents the absolute value of the error. When , it is considered that a good enough convergence effect has been achieved and the UAV has reached the target position; when When , it is considered that the UAV has not reached the target position, and the process returns to step S3 to update the control law and track the formation.
[0022] Beneficial effects of the present invention: The method of the present invention first assigns identities to all intelligent agents in the drone cluster, determines the leader, the deputy leader and the remaining followers, uses the adjacency matrix to specify the communication relationship between the drones in the formation, and the drone uses the azimuth measurement information to calculate the position, inputs the motion control law according to the target error, completes the formation following behavior, and finally determines whether the intelligent agent has reached the target position. The advantage of the dual leader mode used in the present invention is that the leader and the first follower form a rigid body system with a motion direction and a motion speed on a two-dimensional plane, and can distinguish the azimuth angle by themselves, so that the follower drone positioned by it can maintain a position relative to the formation shape, and the formation as a whole can achieve relatively simple rotation and scaling control; in addition, the method of the present invention only needs to be equipped with a sensor device capable of detecting the relative azimuth angle of the leader and the first follower on the drone, and only has high equipment requirements for the leader and the first follower, thereby simplifying the hardware equipment and reducing the cost. Under simple constraints, it can automatically follow the expected angle and scaling scale of the formation as a whole, realize the motion control of the cluster, and conduct cooperative sweeping of unknown areas to complete the mission objectives. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] Figure 1 The present invention is a flow chart of a cluster control method based on a dual-leader mode with azimuth angle measurement only.
[0024] Figure 2 : is the relationship between the speed of the saturation control law and the error distance in the embodiment of the present invention.
[0025] Figure 3 Schematic diagram of a task process based on azimuth only and dual-leader mode in an embodiment of the present invention.
[0026] Figure 4 It is a schematic diagram of expanding the size of a formation through Henenberg constraints in an embodiment of the present invention. DETAILED DESCRIPTION
[0027] The technical solution of the present invention is further described below in conjunction with the accompanying drawings.
[0028] like Figure 1 As shown, a flow chart of a cluster control method based on a dual leader mode under azimuth measurement only of the present invention, the specific steps are as follows:
[0029] S1. Assign identities to all agents in the drone cluster and determine the leader, deputy leader, and remaining followers;
[0030] S2. Use the adjacency matrix to define the communication relationship between each UAV in the formation;
[0031] S3, the drone calculates its position using the azimuth measurement information;
[0032] S4, the UAV inputs the motion control law according to the target error and completes the formation following behavior;
[0033] S5. Determine whether the agent has reached the target position. If so, end the process. If not, return to step S3.
[0034] In this embodiment, the roles in the drone cluster include a leader, a first follower as a deputy leader, and a number of other followers, a total of three types. The leader and the first follower are allowed to carry more complex detectors and communication equipment to complete advanced tasks in formation control, while the other followers are only equipped with detectors and communication equipment sufficient to obtain relative azimuth measurement information of the dual leader drones.
[0035] In this embodiment, in step S2, for an intelligent formation with n drones in dual-leader mode, the adjacency matrix representing the information acquisition relationship is determined as:
[0036]
[0037] Among them, the element a in the adjacency matrix ij , which means the information flow capability from the UAV numbered i to the UAV numbered j. If it is 0, it cannot flow, and if it is 1, it can flow. ij =a ji The information between the drone numbered i and the drone numbered j is bidirectional, and here the adjacency matrix indicates that the information from the dual leaders to the remaining followers is transmitted unidirectionally.
[0038] In this example, in step S3, the drone uses the azimuth measurement information of the leader and the first follower in its own coordinate system to triangulate the dual leader rigid bodies to determine its own position. The intelligent agent n can obtain the angle between its own forward direction and the global coordinate system as θ asn , the distance between the leader and the first follower is ρ s , and this forms a dual leader rigid body, which is in the nth follower coordinate system C n The relative angle θ snl and θ sns1 , then we can calculate the position of the drone follower n in the leader coordinate system C l The current position is s n =(x n ,y n ) T , where T represents the matrix transpose, (x n ,y n ) is the two-dimensional coordinate value of the drone follower n at this time, and the calculation method is as follows:
[0039]
[0040] In step S4, the nth follower UAV can obtain its target position s in the leader coordinate system t , according to the calculated s n , the error value of the relative target position is calculated as
[0041] In this embodiment, the step S4 uses The design control rate is:
[0042]
[0043] Among them, ω fi is the direction the agent is pointing to, u fi is the speed target of the agent at this time. Under the constraints of the two, the follower agent converges to the expected position in the formation; K ai is the amplitude parameter, which, combined with the physical meaning of the system, is the maximum movement speed allowed by the follower; Kfi is the frequency parameter. By adjusting its parameter value appropriately, the control effect of the system can be adjusted. The speed v of the controlled drone fi The absolute value of the error The relationship image is as follows Figure 2 shown.
[0044] The design principle of the motion control law in step S4 is to take into account the performance constraints of the intelligent body itself. In reality, the maximum speed and maximum rotation speed of the car are limited. In the setting, the maximum speed of the follower intelligent body must have a certain relationship with the maximum speed of the leader to meet the basic conditions of following. The inherent characteristics of the inverse hyperbolic tangent function image and the value range of the function itself are used to limit it. It is globally differentiable. The limiting function is the maximum follower speed control allowed by the system to ensure that it is within the range of maneuverability constraints. In the process of relative distance from far to infinity, it gradually approaches its maximum speed, and quickly reduces the speed when approaching the desired position to control its overshoot effect. In subsequent numerical experiments, the system parameter K of the control law can be appropriately adjusted according to the experimental results. ai , K fi , in order to improve the speed and stability of the system. fi The difference in values can also be used to represent the different performance of different agents themselves.
[0045] In this embodiment, in step S5, a sufficiently small judgment threshold is set. Represents the absolute value of the error. When , it is considered that a good enough convergence effect has been achieved and the UAV has reached the target position; when When , it is considered that the UAV has not reached the target position, and the process returns to step S3 to update the control law and track the formation.
[0046] Figure 3 This is a typical cluster collaborative mission process based on the dual-leader mode with only azimuth measurement. In mission phase 1, each UAV moves to the target position to complete the formation. The leader and the first follower form a dual-leader rigid body, and the other followers use it to locate and converge to the required position. In mission phase 2, the dual-leader rigid body moves and rotates in azimuth, and the other followers automatically follow the formation rotation according to the consistent constraint information. In mission phase 3, the dual-leader rigid body is enlarged by increasing the distance between the first follower and the leader, and the formation is scaled as a whole.
[0047] Figure 4 It is the topological relationship of information flow in the formation when the number of other follower drones in the formation increases. When any other follower drone is added to the formation, the dual leader rigid body formed by the leader and the first follower is used to measure and locate the azimuth only.
Claims
1. The cluster cooperative control method based on the dual-leader mode with only azimuth measurement, the specific steps are as follows: S1. Assign identities to all agents in the drone cluster and determine the leader, deputy leader, and remaining followers; S2. Use the adjacency matrix to define the communication relationship between each UAV in the formation; S3, the drone calculates its position using the azimuth measurement information; S4, the UAV inputs the motion control law according to the target error and completes the formation following behavior; S5, determine whether the agent has reached the target position, if yes, then end, if no, return to step S3; In step S3: The drone uses the azimuth measurement information of the leader and the first follower in its own coordinate system to determine its own position through triangulation using the dual leader rigid bodies. The intelligent agent n obtains the angle between its own forward direction and the global coordinate system as θ asn , the distance between the leader and the first follower is ρ s , forming a dual leader rigid body, in the local coordinate system C of the nth follower intelligent body n The relative azimuth of the leader is θ snl , determine the relative azimuth angle of the first follower as θ sns1 , calculate the position of the drone follower n in the leader coordinate system C l The current position is s n =(x n ,y n ) T ,in, T represents the matrix transpose, (x n ,y n ) is the two-dimensional coordinate value of the drone follower n at this time: The nth follower drone obtains its target position s in the leader's coordinate system t , according to the calculated s n , the error value of the relative target position is calculated as In step S4: use The design control rate is: Among them, ω fi is the direction the agent is pointing to, u fi is the speed target of the agent at this time. Under the constraints of the two, the follower agent converges to the expected position in the formation; K ai is the amplitude parameter, K fi is the frequency parameter.
2. The cluster cooperative control method based on dual leader mode under azimuth angle measurement only according to claim 1, characterized in that: The roles in the drone cluster include a leader, a first follower as a deputy leader and several other followers, a total of three types; the leader and the first follower are allowed to carry more complex detectors and communication equipment to complete advanced tasks in formation control, while the other followers are only equipped with detectors and communication equipment sufficient to obtain relative azimuth measurement information of the dual-leader drones.
3. The cluster cooperative control method based on dual leader mode under azimuth angle measurement only according to claim 2 is characterized in that: In step S2: In the dual-leader mode, there is an intelligent formation of n drones, and the adjacency matrix representing the information acquisition relationship is determined as: Among them, the element a in the adjacency matrix ij , which means the information flow capability from the UAV numbered i to the UAV numbered j. If it is 0, it cannot be circulated, if it is 1, it can be circulated. ij =a ji The information between the UAV numbered i and the UAV numbered j is bidirectional, and here the adjacency matrix indicates that the information from the dual leaders to the remaining followers is transmitted unidirectionally.
4. The cluster cooperative control method based on dual leader mode under azimuth angle measurement only according to claim 3 is characterized in that: In step S5: Set a sufficiently small judgment threshold Represents the absolute value of the error. When , it is considered that a good enough convergence effect has been achieved and the UAV has reached the target position; when When , it is considered that the UAV has not reached the target position, and the process returns to step S3 to update the control law and track the formation.
