Unmanned aerial vehicle system based on improved intelligent potential field and consensus protocol and obstacle avoidance algorithm thereof
By improving the intelligent potential field and consensus protocol of the UAV system and optimizing the obstacle avoidance algorithm of the UAV swarm, the problems of obstacle avoidance efficiency and formation stability of the UAV swarm in complex environments are solved, and more efficient and safer flight performance is achieved.
Patent Information
- Application Number
- CN202411002568.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-25
- Publication Date
- 2024-11-08
AI Technical Summary
Existing drone swarm obstacle avoidance algorithms are vulnerable to damage in complex environments, have low mission efficiency, and high energy consumption, which affects flight safety and reliability.
An improved intelligent potential field and consensus protocol-based unmanned aerial vehicle (UAV) system is developed. By optimizing the calculation of potential field forces and introducing a consensus protocol, a control protocol that ensures consistent speed and position is designed. Combined with high-order exponential scaling and normalization processing, collaborative obstacle avoidance of UAV swarms is achieved.
It significantly reduces formation loss, mission failure probability, and flight path length, improves obstacle avoidance efficiency and formation stability of UAV swarms, reduces energy consumption, and enhances flight safety.
Smart Images

Figure CN118915820A_ABST
Abstract
Description
Technical field:
[0001] The present invention relates to the technical field of drone cluster control, and in particular to a drone system and an obstacle avoidance algorithm thereof based on an improved intelligent potential field and consensus protocol. Background technology:
[0002] Drone swarm technology has shown great potential in a variety of application scenarios, but it often faces challenges in complex obstacle environments when performing tasks. Existing obstacle avoidance algorithms have problems such as the formation structure being easily destroyed, reduced task execution efficiency, and increased energy consumption in multi-drone collaborative operations. These problems not only limit the operational capabilities of drone swarms, but also affect the safety and reliability of flight.
[0003] In view of the limitations of existing obstacle avoidance algorithms, researchers have tried a variety of improvement methods, including artificial potential field method and consistency protocol. The artificial potential field method guides drones to avoid obstacles by simulating gravity and repulsion, but may encounter local optimal solution problems; the consistency protocol focuses on maintaining the formation consistency of the drone cluster, but its adaptability in dynamic obstacle environments needs to be improved.
[0004] In order to solve the above problems, the present invention proposes a drone system and its obstacle avoidance algorithm based on improved intelligent potential field and consensus protocol. The algorithm aims to improve the obstacle avoidance efficiency of drone clusters in complex environments, enhance formation stability, reduce the risk of mission failure, and reduce energy consumption by optimizing the artificial potential field algorithm and introducing the consensus protocol, in order to promote the further development and application of drone cluster technology. Summary of the invention:
[0005] The purpose of the present invention is to overcome the above-mentioned defects existing in the background technology and provide a drone system and an obstacle avoidance algorithm based on an improved intelligent potential field and consensus protocol.
[0006] The present invention adopts the following technical solutions to solve the above technical problems:
[0007] The UAV system based on the improved intelligent potential field and consensus protocol specifically includes: multiple UAVs, each of which is equipped with sensors and communication equipment for detecting obstacles and communicating with other UAVs in the cluster; a control unit for generating control instructions according to an obstacle avoidance algorithm to achieve collaborative obstacle avoidance of the UAV cluster.
[0008] The obstacle avoidance algorithm of the UAV system based on the improved intelligent potential field and consensus protocol specifically includes the following steps:
[0009] 2-1. Design a control protocol to keep the speed and position consistent according to the control law of the multi-rotor drone;
[0010] 2-2. Use normalization and high-order exponential scaling to transform the artificial potential field force to solve the oscillation failure problem caused by excessive changes in the potential field force;
[0011] 2-3. Introduce intelligent potential field force to adjust the consensus protocol expected formation to solve the control conflict problem of the combined algorithm of intelligent potential field method and consensus protocol;
[0012] 2-4. In a complex obstacle environment, the effectiveness of the algorithm is verified by simulation results, where the average loss degree of the formation, the average failure degree of the mission and the total length of the flight path are significantly reduced.
[0013] Furthermore, the control protocol includes:
[0014] 3-1. Design a time-varying formation protocol to maintain the speed and position consistency of the UAV formation;
[0015] 3-2. Use normalization processing to reduce the fluctuation of potential field force and improve the stability and adaptability of the algorithm through high-order exponential scaling.
[0016] Furthermore, the algorithm comprises the following steps:
[0017] 4-1. When the distance between the drone and the obstacle is ρ obs Less than or equal to the influence radius ρ 0 When , the size of the repulsive field Urep is calculated to ensure that the potential field force gradually increases as the drone approaches the obstacle. The formula is:
[0018]
[0019] Among them, η is the repulsive force scale factor, which is adjusted according to the dynamic characteristics of the drone; k is a high-order exponent, which is used to adjust the rate of repulsive force growth to ensure that the drone can respond in time when approaching obstacles;
[0020] 4-2. When the distance between the drone and the obstacle is ρ obs Greater than the influence radius ρ 0 When the repulsive field is smooth, it transitions to zero, which reduces the obstacle avoidance action of the UAV and avoids unnecessary energy loss and extension of the flight path.
[0021] Furthermore, through simulation verification, the collaborative obstacle avoidance performance of the algorithm in a complex flight environment with multiple obstacles includes but is not limited to: the average loss of formation is significantly reduced; the average failure of mission is significantly reduced; the total length of the flight path is reduced, and the flight efficiency is improved.
[0022] A computer-readable storage medium includes a stored computer program, which, when executed by a computer, can achieve the following operations: construct and apply a synchronization control protocol to maintain the consistency of the speed and position of a group of drones; optimize the artificial potential field force to overcome the oscillation failure problem during obstacle avoidance; and verify the effectiveness of the algorithm in an environment with multiple obstacles through simulation tests.
[0023] Compared with the prior art, the present invention adopts the above technical solution and has the following beneficial effects:
[0024] (1) By improving the intelligent potential field method, the algorithm of the present invention can respond to obstacle avoidance requirements more quickly and effectively reduce the oscillation and unstable behavior of the drone during obstacle avoidance.
[0025] (2) The consensus protocol introduced in this invention ensures that the UAVs can maintain the formation structure during the obstacle avoidance process, reducing the loss of formation and maintaining the integrity of the formation even in complex environments. By adjusting the expected formation and optimizing the obstacle avoidance path in real time, this algorithm significantly reduces the probability of flight mission failure due to obstacle avoidance.
[0026] (3) The present invention improves computing efficiency and reduces the requirements for computing resources by reducing the planning space and optimizing the calculation process, so that the algorithm can respond to obstacle avoidance needs in real time.
[0027] (4) The present invention helps to improve the safety of UAV flight and reduce the potential risk of mid-air collisions through effective obstacle avoidance and formation maintenance strategies. The algorithm of the present invention provides a new technical solution for the field of UAV cluster control and promotes the innovative development of related technologies. After simulation verification, the algorithm of the present invention has high application value in actual flight environments and can significantly improve the ability of UAV clusters to perform complex tasks. Description of the drawings:
[0028] Figure 1 The diagram of the steps of cooperative obstacle avoidance of the UAV of the present invention
[0029] Figure 2 This is a diagram showing the vibration effect during the obstacle avoidance process of the drone of the present invention;
[0030] Figure 3 This is a schematic diagram of the obstacle avoidance failure of the UAV of the present invention;
[0031] Figure 4 This is a comparison chart of simulation test results of the present invention; Specific implementation method:
[0032] The following will clearly and completely describe the technical solutions in the embodiments of the present invention in conjunction with the drawings of the specification. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary persons in the art without creative work are within the scope of protection of the present invention.
[0033] A drone obstacle avoidance algorithm based on improved intelligent potential field and consensus protocol, specifically including:
[0034] (1) Design of control law and synchronization maintenance:
[0035] 1.1) Accurate establishment of dynamic model: For multi-rotor UAVs, a dynamic model with 4 degrees of freedom is established, taking into account parameters such as mass, speed, acceleration, attitude angle and angular velocity. The dynamic equation is as follows:
[0036]
[0037] Among them, m is the mass of the drone, F is the resultant external force vector, and g is the gravitational acceleration vector.
[0038] 1.2) Control law synchronization algorithm: A control law based on Lyapunov stability theory is designed to ensure the consistency of speed and position. The control law is as follows:
[0039] u=-K p (x d -x)-K v (v d -v)
[0040] Where u is the control input, x d and v d are the expected position and velocity, K p and K v are the proportional and speed control gains.
[0041] (2) Improved intelligent potential field force calculation:
[0042] 2.1) Redefinition of potential field force model: For the repulsive field and gravitational field in the intelligent potential field method, the model parameters and formulas are redefined to better meet the needs of obstacle avoidance scenarios. The purpose of the repulsive field is to generate a force that repels the drone away from obstacles, while the gravitational field attracts the drone to move toward the target point.
[0043] 2.2) Introduction of dynamic characteristics of repulsive field: The parameters of repulsive field are given dynamic characteristics, which are adaptively adjusted according to the relative speed and approach rate between the drone and the obstacle. This dynamic adjustment enables the repulsive field to more flexibly cope with obstacles of different speeds and sizes. The improved repulsive function expression is as follows:
[0044]
[0045] Among them, ρ obs represents the distance between the drone and the obstacle, ρ 0 It is the set obstacle influence radius.
[0046] 2.3) Optimization of the gravitational field: The parameter ξ of the gravitational field is optimized to reduce unnecessary interference with the obstacle avoidance path. The calculation formula of the gravitational field is as follows:
[0047]
[0048] Among them, q i is the position of the drone, q goal is the target position, ρ tar is the distance from the drone to the target.
[0049] 2.4) Normalization of potential field: In order to avoid control problems caused by excessive or insufficient potential field force, the repulsive field and gravitational field are normalized to ensure that the potential field force changes within a reasonable range.
[0050] 2.5) High-order exponential scaling transformation: High-order exponential scaling is introduced to adjust the strength of the potential field force, so that the drone can respond to obstacle avoidance requirements more quickly when approaching obstacles. The scaling formula is as follows:
[0051]
[0052] Among them, k n is the scaling factor, n is the exponent, and ρ obs is the distance between the drone and the obstacle.
[0053] 2.6) Real-time calculation of potential field force: The calculation of potential field force is designed to be performed in real time to adapt to sudden obstacle avoidance situations encountered by the drone during flight. Real-time calculation ensures that the drone can respond quickly to environmental changes.
[0054] 2.7) Parameter optimization algorithm: A parameter optimization algorithm was developed to automatically adjust the parameters of the repulsive and gravitational fields based on historical flight data and obstacle avoidance experience through machine learning technology to improve obstacle avoidance efficiency and accuracy.
[0055] 2.8) Multi-objective trade-off of potential field force: When calculating the potential field force, the trade-offs between multiple objectives are considered, such as obstacle avoidance efficiency, flight stability, and energy consumption, to achieve a comprehensive optimal obstacle avoidance path.
[0056] (3) Expected formation adjustment of consensus protocol:
[0057] 3.1) Dynamic Modeling of Expected Formation State: First, the expected formation state is dynamically modeled, taking into account various situations that the UAV cluster may encounter during flight, such as the appearance of obstacles, speed changes, etc. The expected formation state includes not only the distance and direction between UAVs, but also the time variable to adapt to the dynamic environment.
[0058] 3.2) Mathematical description of the consensus protocol: The consensus protocol is explicitly described using a mathematical algorithm. The protocol uses the Laplace matrix to describe the topological structure and interaction of the drone cluster. Through the design of the control law, it is ensured that the state of the drone cluster converges to the desired formation state. The update formula of the consensus protocol is as follows:
[0059]
[0060] 3.3) Control input for desired formation adjustment: For each UAV, the required control input is calculated based on its position and role in the formation to adjust its speed and direction to achieve tracking of the desired formation. The control input is calculated as follows:
[0061] u i =K p (h desired -h i )+K v (v desired -v i )
[0062] Among them, u i is the control input of drone i, h desired and v desired are the desired formation position and speed, h i and v i is the current position and speed of the drone, K p and K v is the control gain.
[0063] 3.4) Integration of intelligent potential field forces: Integrate intelligent potential field forces into the consensus protocol to adjust the response of drones to the desired formation state. The introduction of intelligent potential field forces, especially the repulsive field, helps drones maintain the desired relative position when avoiding obstacles.
[0064] 3.5) Real-time update of formation adjustment: The formation adjustment strategy needs to be updated in real time to adapt to the formation changes that may occur in the UAV cluster during the obstacle avoidance process. This requires the UAVs to quickly calculate and respond to the new desired formation state.
[0065] (4) Implementation of collaborative obstacle avoidance algorithm:
[0066] 4.1) Algorithm design principles: The collaborative obstacle avoidance algorithm is based on the principle of distributed control. Each drone, as an intelligent agent, makes independent obstacle avoidance decisions based on its own perception information and preset rules, while maintaining coordination with the cluster.
[0067] 4.2) Obstacle avoidance decision making: The drone makes obstacle avoidance decisions based on its own status and surrounding environment information using an improved intelligent potential field method and consistency protocol. Obstacle avoidance decisions not only consider individual safety, but also the collaborative obstacle avoidance effect of the entire cluster.
[0068] 4.3) Path planning and optimization: The obstacle avoidance algorithm needs to generate obstacle avoidance paths in real time and optimize them to minimize deviations from the original flight plan. Path planning adopts a multi-stage planning strategy, taking into account factors such as current position, target position, and obstacle distribution.
[0069] 4.4) Dynamic obstacle avoidance strategy: The drone dynamically adjusts the obstacle avoidance strategy based on the real-time perceived obstacle information. When encountering unknown or moving obstacles, the drone can quickly replan the obstacle avoidance path to ensure the real-time and effectiveness of obstacle avoidance.
[0070] 4.5) Formation coordination mechanism: During the obstacle avoidance process, the UAV exchanges status information and obstacle avoidance decisions with other UAVs through the communication network to coordinate obstacle avoidance actions and avoid the destruction of the formation structure caused by individual obstacle avoidance.
[0071] 4.6) Obstacle avoidance conflict resolution: When multiple drones face conflicting obstacle avoidance paths, the algorithm can resolve the obstacle avoidance conflicts according to preset priority rules or through a distributed negotiation mechanism to ensure the consistency and coordination of cluster obstacle avoidance.
[0072] (5) Simulation verification and performance analysis:
[0073] 5.1) Algorithm Integration and Deployment: The collaborative obstacle avoidance algorithm is integrated into the simulation environment to ensure that the algorithm can be automatically executed in the simulation software. During the deployment process, necessary adjustments are made to the algorithm to adapt to the characteristics and limitations of the simulation environment.
[0074] 5.2) Parameter setting and adjustment: In the simulation experiment, the flight parameters of the drone (such as speed, acceleration, flight altitude, etc.) and the control parameters of the obstacle avoidance algorithm (such as potential field strength, consistency gain, etc.) were set in detail. Through parameter adjustment, the performance of the algorithm under different conditions was tested.
[0075] 5.3) Definition of performance indicators: A series of performance indicators are defined to evaluate the effectiveness of the algorithm, including obstacle avoidance success rate, formation maintenance, path deviation, flight time, energy consumption, etc. These indicators can fully reflect the performance of the algorithm in practical applications.
[0076] 5.4) Data Collection and Processing: During the simulation experiment, the flight data and obstacle avoidance behavior data of the drone were collected in real time. The data included position, speed, acceleration, control input, obstacle avoidance action, etc. The collected data was processed and analyzed to evaluate the algorithm performance.
[0077] 5.5) Result analysis and evaluation: The performance of the collaborative obstacle avoidance algorithm is compared with other existing obstacle avoidance algorithms (such as artificial potential field method, dynamic window method, etc.). The evaluation results include the algorithm's obstacle avoidance effect, formation stability, path optimization degree, etc.
[0078] (6) Application of structural similarity index:
[0079] 6.1) SSIM definition and calculation: SSIM is an indicator that measures the structural similarity of two signals or images, and its value ranges from -1 to 1. In the present invention, SSIM is used to calculate the similarity between the actual flight formation of the UAV formation and the expected formation. The calculation of SSIM is based on three factors: brightness (I(x,y)), contrast (c(x,y)) and structure (s(x,y)), and its formula is as follows:
[0080]
[0081] Among them, μ a and μ b are the means of the two formations, σ a and σ b is the standard deviation, σ ab is the covariance, C 1 and C 2 is a small constant that prevents the denominator from being zero.
[0082] 6.2) Quantification of formation similarity: The similarity of the formation is quantified by calculating the SSIM value between the flight formation of the UAV formation at different time points and the expected formation. This value reflects the integrity and stability of the formation of the UAV formation during the obstacle avoidance process.
[0083] 6.3) Time Series Analysis: Since UAV formation flight is a dynamic process, SSIM is used to analyze the changes in formation over time during flight. By calculating the SSIM value at each sampling moment, time series data of formation similarity is generated.
[0084] 6.4) Similarity threshold setting: According to the range of SSIM values, a threshold is set to determine whether the formation meets the predetermined integrity requirements. For example, an SSIM value close to 1 indicates that the formation is well maintained, while a value close to 0 indicates that the formation has a large deviation.
[0085] 6.5) Performance evaluation: The SSIM value is used to evaluate the impact of different obstacle avoidance algorithms on the UAV formation. By comparing the formation division obstacle avoidance algorithm, dynamic window obstacle avoidance algorithm and the algorithm proposed in this invention used in the experiment, their performance in maintaining formation stability is evaluated.
[0086] (7) Algorithm optimization and parameter adjustment:
[0087] The algorithm was optimized, including parameter selection and adjustment, to adapt to different environments and task requirements. The optimal value range of the algorithm parameters was determined through simulation experiments, which improved the adaptability and robustness of the algorithm.
[0088] The above content describes the preferred embodiment of the present invention, but it should be emphasized that for professionals in this technical field, many variations and adjustments can be made without departing from the core principles of the present invention. All these variations and adjustments, as long as they are within the creative concept and essential scope of the present invention, should be regarded as part of the protection of the present invention.
Claims
1. UAV system based on improved intelligent potential field and consensus protocol, It is characterized in that The system includes: multiple drones, each of which is equipped with sensors and communication equipment for detecting obstacles and communicating with other drones in the cluster; a control unit for generating control instructions based on an obstacle avoidance algorithm to achieve collaborative obstacle avoidance of the drone cluster.
2. According to claim 1, an unmanned aerial vehicle system based on an improved intelligent potential field and consensus protocol, an obstacle avoidance algorithm for the unmanned aerial vehicle system based on an improved intelligent potential field and consensus protocol, It is characterized in that The algorithm specifically includes the following steps: 2-1. Design a control protocol to keep the speed and position consistent according to the control law of the multi-rotor drone; 2-2. Use normalization and high-order exponential scaling to transform the artificial potential field force to solve the oscillation failure problem caused by excessive changes in the potential field force; 2-3. Introduce intelligent potential field force to adjust the consensus protocol expected formation to solve the control conflict problem of the combined algorithm of intelligent potential field method and consensus protocol; 2-4. In a complex obstacle environment, the effectiveness of the algorithm is verified by simulation results, where the average loss degree of the formation, the average failure degree of the mission and the total length of the flight path are significantly reduced.
3. According to claim 2, an obstacle avoidance algorithm for a drone system based on an improved intelligent potential field and consensus protocol, It is characterized in that The control protocol includes: 3-1. Design a time-varying formation protocol to maintain the speed and position consistency of the UAV formation; 3-2. Use normalization processing to reduce the fluctuation of potential field force and improve the stability and adaptability of the algorithm through high-order exponential scaling.
4. According to claim 2, an obstacle avoidance algorithm for a drone system based on an improved intelligent potential field and consensus protocol, It is characterized in that The algorithm comprises the following steps: 4-1. When the distance between the drone and the obstacle is ρ obs Less than or equal to the influence radius ρ 0 When , the size of the repulsive field Urep is calculated to ensure that the potential field force gradually increases as the drone approaches the obstacle. The formula is: Among them, η is the repulsive force scale factor, which is adjusted according to the dynamic characteristics of the drone; k is a high-order exponent, which is used to adjust the rate of repulsive force growth to ensure that the drone can respond in time when approaching obstacles; 4-2. When the distance between the drone and the obstacle is obs Greater than the influence radius ρ 0 When the repulsive field is smooth, it transitions to zero, which reduces the obstacle avoidance action of the UAV and avoids unnecessary energy loss and extension of the flight path.
5. An obstacle avoidance algorithm for a drone system based on an improved intelligent potential field and consensus protocol according to any one of claims 2 to 4, It is characterized in that The collaborative obstacle avoidance performance of the algorithm in a complex flight environment with multiple obstacles has been verified through simulation, including but not limited to: the average loss of formation is significantly reduced; the average failure of mission is significantly reduced; the total length of the flight path is reduced, and the flight efficiency is improved.
6. A computer-readable storage medium, It is characterized in that The computer-readable storage medium includes a stored computer program, which is used to execute the method according to any one of claims 2 to 5 when the computer program is executed. When the program is executed by a computer, the following operations can be implemented: constructing and applying a synchronization control protocol to maintain the speed and position of the drone group consistent; Optimize the artificial potential field force to overcome the oscillation failure problem during obstacle avoidance; and verify the effectiveness of the algorithm in an environment with multiple obstacles through simulation tests.
Citation Information
Cited By
Unmanned aerial vehicle formation anti-collision method based on three-dimensional speed obstacle model and improved artificial potential field method
CN119576000A
Low-altitude aircraft air traffic management method and system
CN119905019A
Unmanned aerial vehicle group congestion obstacle avoidance control method
CN119937627A
Multi-agent collaborative integrated navigation virtual simulation system and method based on Unity 3D
CN120063244A
Unity3D-based multi-agent collaborative integrated navigation virtual simulation system and method
CN120063244B
