Multi-unmanned aerial vehicle formation cooperative surrounding target control method using azimuth angle information

By using azimuth information to design relative position estimator and surround control algorithm, the collaborative surround encirclement of multiple drones in the GPS denial environment is achieved, and the problems of large errors and high costs in the existing technology are solved, and the drone is realized Accurate and even surround the target.

CN119088052APending Publication Date: 2024-12-06NORTHWESTERN POLYTECHNICAL UNIV
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411155787.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-22
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

The existing multi-UAV collaborative surround and surround control method is difficult to work effectively in GPS denial environments, and there are large errors when using distance change rate information, which increases the cost and exposure risk of drones.

Method used

Design a multi-UAV formation collaboratively surround target control method using azimuth information, design relative position estimator through azimuth information, reconstruct the actual distance information, and design the surround control algorithm and distributed speed control algorithm based on this to generate Control command group to achieve uniform surround and surround of the drone.

Benefits of technology

In the denial environment, the drone accurately surrounds the target, reduces the risk and cost of drone exposure, improves the algorithm performance, and does not require the drone's own positioning information and target status information.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119088052A_ABST
    Figure CN119088052A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of flight control. The invention provides a multi-unmanned aerial vehicle formation cooperative surrounding target control method using azimuth angle information. According to the embodiment of the invention, the azimuth angle signal is used to design the relative position estimator to position the target; reconstructing estimated distance information of the unmanned aerial vehicle relative to the target based on the azimuth angle signal and the relative position estimator, and designing a target surrounding control algorithm by using the estimated distance signal and the azimuth angle information to realize surrounding of the target by the single unmanned aerial vehicle; on the basis of a positioning and target surrounding control algorithm, a distributed speed coordination controller is designed by utilizing relative position information, azimuth angle information and speed information and course angles of the unmanned aerial vehicles, and uniform surrounding of the target by the multiple unmanned aerial vehicles is realized. According to the invention, positioning information of the unmanned aerial vehicle and state information of the target are not needed, and only azimuth angle information is needed, so that a target surrounding task in a denial environment can be realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The disclosed embodiments relate to the field of flight control technology, and more particularly to a method for controlling a multi-UAV formation to collaboratively surround a target using azimuth information. Background Art

[0002] In recent years, drones have been widely used in the fields of formation search, path tracking, collaborative positioning, and encirclement due to their high efficiency, low cost, few environmental restrictions, high mobility and flexibility. Among them, multiple drone formations can coordinate to perform encirclement and encirclement tasks on ground targets, which can effectively realize reconnaissance and surveillance of targets, collect target information, improve situational awareness, and further provide key information for subsequent directional expulsion and coordinated attacks.

[0003] As a control technology to improve the autonomy level of drones, surround control obtains the state information of the target through the sensors carried by the drones, and then formulates corresponding control strategies to achieve surround control of the target. Furthermore, it performs multiple key tasks such as target positioning, area monitoring and search. For most existing multi-drone collaborative surround control methods, the design of their control methods usually assumes that complete information of the target, such as position and speed, can be obtained, which often requires a high cost and increases the risk of exposure of the drone itself. For non-cooperative targets in some specific application scenarios, it is difficult for drones to obtain prior information on the target's position, and the above control methods will be difficult to apply. In addition, with the development of area denial technology and anti-drone technology, the GPS signal of drones may be deceived, blocked or interfered, which poses a severe test to the survival environment of drones and the design of surround control technology. Therefore, it is more realistic to explore how to use surround control algorithms in GPS denial environments.

[0004] Although many achievements have emerged for the surround control algorithm in the denial environment, such as using only distance measurement information or using distance and distance change rate information to design the surround control algorithm, or using distance measurement information and azimuth information to design the algorithm, for the use of distance measurement information, it is essentially an active detection method, which requires the drone to continuously transmit signals to obtain the relative distance to the target, which will undoubtedly increase the risk of drone exposure. When using distance change rate information, due to the existence of measurement noise, whether it is differential filtering or numerical differentiation, it will lead to large errors, resulting in a decrease in algorithm performance. For algorithms that use both distance measurement information and azimuth information, it is necessary to install both distance measurement sensors and azimuth sensors, which increases the cost of the drone. In addition, the failure of any sensor will lead to a decrease in the performance of the algorithm or the failure of the algorithm. Therefore, it is more valuable to study the design of surround control methods using azimuth information obtained by passive detection under the constraints of detection resources. Summary of the invention

[0005] In order to avoid the shortcomings of the prior art, the present application provides a method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information, which is used to solve the problem that the prior art uses distance change rate information. Due to the existence of measurement noise, whether it is a differential filter or a numerical differential method, it will result in a large error, resulting in a decrease in algorithm performance. For algorithms that use both ranging information and azimuth information, it is necessary to install both ranging sensors and azimuth sensors, which increases the cost of the UAV.

[0006] According to an embodiment of the present disclosure, a method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information is provided, the method comprising: Design a relative position estimator using the target's azimuth information; Reconstructing actual distance information using the relative position estimator to obtain estimated distance information, and designing a target surround control algorithm based on the azimuth information and the estimated distance information; Designing a distributed speed control algorithm using the azimuth information, the heading information and the speed information of each UAV, and generating a control instruction group according to the distributed speed control algorithm and the surround control algorithm, wherein the control instruction group includes a speed control instruction, an altitude control instruction and a roll angle control instruction; The control instructions are respectively input into a controller group to achieve uniform surrounding of the target by all the drones, wherein the controller group includes a speed controller, an altitude controller and a roll angle controller.

[0007] Furthermore, the expression of the relative position estimator is:

[0008] in, is the relative position vector The estimated value of is the second-order identity matrix, is the gain to be designed, is the heading angle of the UAV, is the speed of the drone, It is the unit vector on the line of sight between the drone and the target.

[0009] Further, the steps of reconstructing the actual distance information by using the relative position estimator to obtain estimated distance information, and designing a target surround control algorithm according to the azimuth information and the estimated distance information include: Based on the relative kinematic equation of the UAVs cooperatively surrounding the target, an initial surround control algorithm is constructed according to the azimuth information and actual distance information of the target; reconstructing the actual distance information using the relative position estimator to obtain the estimated distance information, and replacing the actual distance information with the estimated distance information; A target surround control algorithm is designed according to the azimuth information and the estimated distance information.

[0010] Furthermore, the relative kinematics equation is expressed as:

[0011] in, is the relative distance of the drone to the target The differential of The lateral angle The differential signal of is the phase separation angle The calculus, is the heading angle of the drone The differential of For the i The azimuth information of each UAV relative to the target, for The differential of For the i +1 information about the azimuth of the drone relative to the target, for The differential of The expression of the initial surround control algorithm is:

[0012] The expression of the target surround control algorithm is:

[0013] in, is the preset surrounding radius, For damping, To control the gain.

[0014] Further, the steps of designing a distributed speed control algorithm using the azimuth information, the heading information and the speed information of each UAV, and generating a surround control instruction and a speed control instruction according to the distributed speed control algorithm and the surround control algorithm include: Designing the distributed speed control algorithm according to the azimuth information, the heading information and the speed information; Design a distributed cooperative encirclement control algorithm for formation UAVs based on the distributed speed control algorithm and the target encirclement control algorithm; The surround control instruction and the speed control instruction are generated according to the distributed cooperative surround control algorithm.

[0015] Furthermore, the expression of the distributed speed control algorithm is:

[0016] The expression of the distributed cooperative encirclement control algorithm is:

[0017] in, is the speed control command, For the i- The speed of a drone, is the control gain to be designed.

[0018] Furthermore, the expression of the height controller is:

[0019] in, is the elevator command, is the pitch angle loop proportional gain, is the pitch angle loop integral gain, is the pitch angle rate Loop gain, is the height loop proportional gain, is the height loop differential gain, is the height loop integral gain, For a given height command, It is a height feedback signal; The expression of the roll angle controller is:

[0020] in, Enter the command for the roll angle, represents the acceleration due to gravity, is the aileron command, is the rudder command, Roll angle Loop proportional gain, is the roll angular rate Gain, is the yaw rate Gain, Side slip angle Gain, is the aileron linkage signal gain; The expression of the speed controller is:

[0021] in, is the throttle command, is the speed loop proportional gain, is the speed loop integral gain.

[0022] The technical solution provided by the embodiments of the present disclosure may have the following beneficial effects: In the embodiments of the present disclosure, through the above-mentioned multi-UAV formation collaborative encirclement target control method using azimuth information, on the one hand, the azimuth signal is used to design a relative position estimator to achieve the positioning of the target; based on the azimuth signal and the relative position estimator, the estimated distance information of the UAV relative to the target is reconstructed, and the target surround control algorithm is designed using the estimated distance signal and azimuth information to achieve the surround of the target by a single UAV; on the basis of the positioning and target surround control algorithm, the relative position information, azimuth information, the speed information and heading angle of the UAV itself are used to design a distributed speed coordination controller to achieve uniform surround of the target by multiple UAVs. On the other hand, the UAV's own positioning information and the target's state information are not required, and only the azimuth information is needed to achieve the target surround task in a denied environment. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] The accompanying drawings herein are incorporated into the specification and constitute a part of the specification, illustrate embodiments consistent with the present disclosure, and together with the specification are used to explain the principles of the present disclosure. Obviously, the accompanying drawings described below are only some embodiments of the present disclosure, and for ordinary technicians in this field, other accompanying drawings can be obtained based on these accompanying drawings without creative work.

[0024] Figure 1 A step diagram showing a method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information in an exemplary embodiment of the present disclosure; Figure 2 A schematic diagram showing the geometric relationship of a system of formation drones cooperatively encircling an unknown target in an exemplary embodiment of the present disclosure; Figure 3 A schematic diagram showing the communication topology connection of a formation of UAVs in an exemplary embodiment of the present disclosure is shown; Figure 4 A specific flow chart showing a method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information in an exemplary embodiment of the present disclosure; Figure 5 The motion trajectories of the drone and the target in the exemplary embodiment of the present disclosure are shown; Figure 6 The distance between the drone and the target in the exemplary embodiment of the present disclosure is shown; Figure 7 Shows the roll angle control command and response in an exemplary embodiment of the present disclosure; Figure 8 shows the speed change in the exemplary embodiment of the present disclosure; Fig. 9 The east-west position estimation position error in the exemplary embodiment of the present disclosure is shown; Fig.10 The estimated position error of the north position in the exemplary embodiment of the present disclosure is shown; Fig.11 The motion trajectories of three drones and a target in an exemplary embodiment of the present disclosure are shown; Fig.12 The distance between the drone and the target and the distance between the drones in the exemplary embodiment of the present disclosure are shown; Fig.13 Shows the roll angle control command and response in an exemplary embodiment of the present disclosure; Fig.14 illustrates aileron and rudder deflection of a drone in an exemplary embodiment of the present disclosure; Fig.15 The speed changes of three drones in an exemplary embodiment of the present disclosure are shown; Fig.16 The phase separation angle variation in the exemplary embodiment of the present disclosure is shown. DETAILED DESCRIPTION

[0025] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in a variety of forms and should not be construed as limited to the examples set forth herein; rather, these embodiments are provided so that the disclosure will be more comprehensive and complete and to fully convey the concepts of the example embodiments to those skilled in the art. The described features, structures, or characteristics may be combined in any suitable manner in one or more embodiments.

[0026] In addition, the accompanying drawings are only schematic illustrations of the embodiments of the present disclosure and are not necessarily drawn to scale. The same reference numerals in the figures represent the same or similar parts, and their repeated descriptions will be omitted. Some of the block diagrams shown in the accompanying drawings are functional entities and do not necessarily correspond to physically or logically independent entities.

[0027] This example embodiment provides a method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information. Figure 1 As shown in , the method for controlling a multi-UAV formation to collaboratively surround a target using azimuth information may include: steps S101 to S104.

[0028] Step S101: designing a relative position estimator using the azimuth information of the target; Step S102: reconstructing the actual distance information using the relative position estimator to obtain estimated distance information, and designing a target surround control algorithm based on the azimuth information and the estimated distance information; Step S103: designing a distributed speed control algorithm using the azimuth information, the heading information and the speed information of each UAV, and generating a control instruction group according to the distributed speed control algorithm and the surround control algorithm, wherein the control instruction group includes a speed control instruction, an altitude control instruction and a roll angle control instruction; Step S104: inputting the control instructions into the controller group respectively to achieve uniform surrounding of the target by all the drones, wherein the controller group includes a speed controller, an altitude controller and a roll angle controller.

[0029] Through the above-mentioned multi-UAV formation cooperative encirclement target control method using azimuth information, on the one hand, the azimuth signal is used to design a relative position estimator to achieve the positioning of the target; based on the azimuth signal and the relative position estimator, the estimated distance information of the UAV relative to the target is reconstructed, and the target encirclement control algorithm is designed using the estimated distance signal and azimuth information to achieve the encirclement of the target by a single UAV; on the basis of the positioning and target encirclement control algorithm, the relative position information, azimuth information, the speed information and heading angle of the UAV itself are used to design a distributed speed coordination controller to achieve uniform encirclement of the target by multiple UAVs. On the other hand, the UAV's own positioning information and the target's state information are not required, and only the azimuth information is needed to achieve the target encirclement task in a denied environment.

[0030] Next, we will refer to Figures 1 to 16 The various steps of the above-mentioned multi-UAV formation collaborative encirclement target control method using azimuth information in this example implementation are described in more detail.

[0031] In step S101 and step S102, consider a cooperative surrounding system consisting of M drones on a two-dimensional horizontal plane, such as Figure 2 As shown. Schematic diagram of the communication topology connection of the formation UAV, as shown Figure 3 shown.

[0032] is the drone position vector, is the position vector of the surrounded target, is the relative position vector of the UAV relative to the target, and the distance of the UAV relative to the target is , the unit vector on the line of sight between the drone and the target is .definition Defines the azimuth angle for the preset surround radius The phase angle is the angle between the line connecting the drone targets and the geographic east direction. is the angle between the line between the drone targets and the geographic north direction, which can be expressed as , for The north component of for The eastward component of is the heading angle of the UAV, is the speed of the UAV, and the phase separation angle is defined as , , lateral angle is the angle between the UAV velocity vector and the normal of the UAV target line. According to the relationship between the various angles, , , we can get the relative kinematic equation of the formation UAVs cooperatively encircling the target as: (1) The control goal is to design a distributed control algorithm so that , rad.

[0033] Assume that the drone can obtain the relative distance signal relative to the target and azimuth signal , this application will propose the following surround control algorithm: (2) In the formula , the azimuth signal that can be obtained by the azimuth sensor And the UAV's own heading angle signal Get, To control the gain, here it is preferably 10, is damping, and 0.707 is preferred here. The characteristics of this algorithm are as follows: when the distance to the target is far, the distance signal plays a major role, ensuring that the UAV quickly approaches the target and improving the anti-interference ability of the UAV when making coordinated turns; when approaching the target, the lateral angle signal is similar to the training of the pilot when turning at a certain point, and the pilot adjusts the tilt angle of the aircraft according to the relative offset of the target point. By introducing the lateral angle signal, the convergence accuracy of the relative distance can be improved.

[0034] This application will propose the following relative position estimation algorithm, and the relative position estimator is designed as follows: (3) In the formula is the relative position vector The estimated value of is the second-order identity matrix, is the gain to be designed, which is preferably The relative distance between the UAV and the target can be estimated as , using the estimated relative distance signal to replace the actual ranging information in equation (2), the present application proposes the following surround control algorithm using only azimuth information: (4) This control algorithm only requires azimuth sensing signals, without the need for ranging sensors and the drone's own positioning information, and can achieve surround encirclement of the target in a GPS-denied environment.

[0035] In step S103, in order to realize the coordinated encirclement of ground targets by a multi-UAV formation, the present application proposes the following distributed speed coordination controller: (5) In the formula is the speed control command, is the speed of the i-1th UAV, is the control gain to be designed, which is preferably ,UAVs only need to exchange the UAV and azimuth signals of adjacent UAVs, which requires less information to be transmitted and less resources to be occupied.

[0036] Combining the distributed speed control algorithm (5) and the surround control algorithm (4), the present application proposes the following distributed cooperative surround control algorithm for formation UAVs: (7) At this point, the design of the distributed encirclement control algorithm is completed.

[0037] In step S104, in order to enable the UAV to respond quickly and accurately to the instructions of the guidance law, the speed controller, altitude controller and roll angle controller are designed as follows: (1) Height controller The aircraft's altitude hold system can keep the aircraft at a fixed altitude in the air, and can accurately maintain the altitude when the aircraft is flying around. Keep it as the inner loop and add the height difference to the outer loop feedback to maintain and control the aircraft's altitude.

[0038] (8) In the formula is the elevator command, is the pitch angle loop proportional gain, is the pitch angle loop integral gain, is the pitch angle rate Loop gain, is the height loop proportional gain, is the height loop differential gain, is the height loop integral gain, For a given height command, is a height feedback signal. Preferably, , , , , , .

[0039] (2) Roll angle controller When the UAV is performing an encirclement control task, the roll hold and control system needs to control the roll angle of the UAV so that the UAV can respond well to the command of formula (4). Formula (4) cannot be directly input into the roll angle loop, and the coordinated turning command is used to convert its command: (9) In the formula Enter the command for the roll angle, Represents the acceleration due to gravity.

[0040] The roll angle control adopts the following control law: (10) In the formula Aileron command, used for roll angle maintenance, The rudder commands are used to reduce the Dutch roll mode and help coordinate turns. Roll angle Loop proportional gain, is the roll angular rate Gain, is the yaw rate Gain, Side slip angle Gain, is the aileron linkage signal gain, which is used to help coordinate turns and eliminate sideslip. , , , , .

[0041] (3) Speed ​​control law The speed controller is used to respond to the speed command in equation (5). Due to the coupling relationship between the altitude and airspeed of the drone, controlling the engine thrust alone may cause the drone to climb or descend, but the airspeed does not increase. It needs to be used together with the altitude hold mode to achieve speed control. The speed controller is: (11) In the formula is the throttle command, is the speed loop proportional gain, is the speed loop integral gain. Preferably, , .

[0042] like Figure 4 As shown, it is a flow chart of the distributed surround control algorithm using only azimuth information.

[0043] In a specific embodiment, Figures 5 to 10 The simulation results of the single-machine surround control algorithm (4) proposed in this application using only azimuth information to surround an unknown variable-speed moving target are shown, with a preset surround radius of 300m. The UAV starts from (0,0)m, the speed command is maintained at 30m / s, the initial heading angle is 0°, and the relative position estimator (3) is initialized to (320,280)m. The surround starts from (300,300)m with a north velocity component of 8m / s and an east velocity component of 8m / s. m / s variable speed motion target, the other parameters are consistent with those used in the manual. Figure 5 and Figure 6 As shown in the figure, the drone can stably circle the target with a preset 300m radius. Due to the lack of target speed information, the relative distance fluctuates around 300m, and the fluctuation range is less than 20m. Figure 7 and Figure 8 As shown, the designed roll angle controller (10) and speed controller (11) can achieve stable tracking of the roll angle command and the speed command. Fig. 9 and Fig.10 The error of the relative position component estimated by the designed relative position estimator (3) is shown. It can be seen that the steady-state estimation error of the north and east components is less than 15m, which can achieve relative positioning of the target.

[0044] Figures 11 to 16 The simulation results of collaboratively surrounding an unknown moving target using the distributed surround control algorithm (7) proposed in this application using only the azimuth angle are shown. Three drones are used to surround a uniform moving target starting from (0,0) m with a velocity component of 8 m / s in the north and east directions. The surround radius is set to 300 m. The initial positions of the three drones are set to , , , the initial heading angle is , , , the height command is 200m. The relative position estimator (3) is initialized to (800,600)m, (-700,450)m, (400,-700)m respectively, and the other control gain parameters are the same as those in the manual. Fig.11 and Fig.12The global asymptotic convergence of the distributed surround control algorithm (7) is demonstrated, and the UAV can achieve stable surround of the target at any heading angle and any position configuration. Fig.13 and Fig.14 It demonstrates that the deflection of the drone's rudder surfaces is within a reasonable range, enabling rapid tracking and response to control commands. Fig.15 and Fig.16 It is shown that by adjusting the speed of the drone, uniform tracking of the target can be achieved, the phase separation angle of the drone converges to the desired phase separation angle, and even if the speed of the drone fluctuates greatly, the distributed speed coordination algorithm (6) still converges. In summary, the distributed surround control algorithm (7) proposed in this application is effective.

[0045] Through the above-mentioned multi-UAV formation cooperative encirclement target control method using azimuth information, on the one hand, the azimuth signal is used to design a relative position estimator to achieve the positioning of the target; based on the azimuth signal and the relative position estimator, the estimated distance information of the UAV relative to the target is reconstructed, and the target encirclement control algorithm is designed using the estimated distance signal and azimuth information to achieve the encirclement of the target by a single UAV; on the basis of the positioning and target encirclement control algorithm, the relative position information, azimuth information, the speed information and heading angle of the UAV itself are used to design a distributed speed coordination controller to achieve uniform encirclement of the target by multiple UAVs. On the other hand, the UAV's own positioning information and the target's state information are not required, and only the azimuth information is needed to achieve the target encirclement task in a denied environment.

[0046] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present disclosure. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification.

[0047] Those skilled in the art will readily appreciate other embodiments of the present disclosure after considering the specification and practicing the invention disclosed herein. This application is intended to cover any modification, use or adaptation of the present disclosure, which follows the general principles of the present disclosure and includes common knowledge or customary techniques in the art that are not disclosed in the present disclosure. The specification and examples are intended to be exemplary only, and the true scope and spirit of the present disclosure are indicated by the appended claims.

Claims

1. A multi-UAV formation cooperative encirclement target control method using azimuth information, It is characterized in that The method includes: Design a relative position estimator using the target's azimuth information; Reconstructing actual distance information using the relative position estimator to obtain estimated distance information, and designing a target surround control algorithm based on the azimuth information and the estimated distance information; Designing a distributed speed control algorithm using the azimuth information, the heading information and the speed information of each UAV, and generating a control instruction group according to the distributed speed control algorithm and the surround control algorithm, wherein the control instruction group includes a speed control instruction, an altitude control instruction and a roll angle control instruction; The control instructions are respectively input into a controller group to achieve uniform surrounding of the target by all the drones, wherein the controller group includes a speed controller, an altitude controller and a roll angle controller.

2. According to the method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information according to claim 1, It is characterized in that The expression of the relative position estimator is: in, is the relative position vector The estimated value of is the second-order identity matrix, is the gain to be designed, is the heading angle of the UAV, is the speed of the drone, It is the unit vector on the line of sight between the drone and the target.

3. According to claim 2, the method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information, It is characterized in that The steps of reconstructing the actual distance information by using the relative position estimator to obtain the estimated distance information, and designing the target surround control algorithm according to the azimuth information and the estimated distance information include: Based on the relative kinematic equation of the UAVs cooperatively surrounding the target, an initial surround control algorithm is constructed according to the azimuth information and actual distance information of the target; reconstructing the actual distance information using the relative position estimator to obtain the estimated distance information, and replacing the actual distance information with the estimated distance information; A target surround control algorithm is designed according to the azimuth information and the estimated distance information.

4. According to claim 3, the method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information, It is characterized in that The relative kinematics equation is expressed as: in, is the relative distance of the drone to the target The differential of The lateral angle The differential signal of is the phase separation angle The calculus, is the heading angle of the drone The differential of For the i The azimuth information of each UAV relative to the target, for The differential of For the i +1 information about the azimuth of the drone relative to the target, for The differential of The expression of the initial surround control algorithm is: The expression of the target surround control algorithm is: in, is the preset surrounding radius, For damping, To control the gain.

5. According to claim 4, the method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information, It is characterized in that The steps of designing a distributed speed control algorithm using the azimuth information, the heading information and the speed information of each UAV, and generating a surround control instruction and a speed control instruction according to the distributed speed control algorithm and the surround control algorithm include: Designing the distributed speed control algorithm according to the azimuth information, the heading information and the speed information; Design a distributed cooperative encirclement control algorithm for formation UAVs based on the distributed speed control algorithm and the target encirclement control algorithm; The surround control instruction and the speed control instruction are generated according to the distributed cooperative surround control algorithm.

6. The method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information according to claim 5, It is characterized in that The expression of the distributed speed control algorithm is: The expression of the distributed cooperative encirclement control algorithm is: in, is the speed control command, For the i- The speed of a drone, is the control gain to be designed.

7. The method for controlling a multi-UAV formation to cooperatively surround a target using azimuth information according to claim 6, It is characterized in that The expression of the height controller is: in, is the elevator command, is the pitch angle loop proportional gain, is the pitch angle loop integral gain, is the pitch angle rate Loop gain, is the height loop proportional gain, is the height loop differential gain, is the height loop integral gain, For a given height command, It is a height feedback signal; The expression of the roll angle controller is: in, Enter the command for the roll angle, represents the acceleration due to gravity, is the aileron command, is the rudder command, Roll angle Loop proportional gain, is the roll angular rate Gain, is the yaw rate Gain, Side slip angle Gain, is the aileron linkage signal gain; The expression of the speed controller is: in, is the throttle command, is the speed loop proportional gain, is the speed loop integral gain.

Citation Information

Cited By

  • Unmanned aerial vehicle surrounding control method based on quadratic programming

    CN120871947A