A method for controlling a cluster of fixed-wing UAVs in coordinated formation

By determining the formation role and parameters in the fixed-wing drone cluster, and using rolling angle, speed and height control, the problem of drone collision is solved, and the stability and efficiency of the formation is improved.

CN118584981BActive Publication Date: 2024-11-15四川腾盾科技有限公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411074702.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-07
Publication Date
2024-11-15
Estimated Expiration
2044-08-07

AI Technical Summary

Technical Problem

In fixed-wing drone cluster formation control, existing methods have failed to effectively avoid the problem of drone collisions, especially when small-pitch formation flights are required.

Method used

By determining the formation role and formation parameters of each drone, we can determine whether formation assembly is needed, and coordinated formation control is carried out using rolling angle, speed and height control methods to ensure a safe distance between drones.

Benefits of technology

It effectively avoids drone collisions, improves the mission robustness and flight efficiency of the cluster, and ensures the stability and safety of the formation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118584981B_ABST
    Figure CN118584981B_ABST
Patent Text Reader

Abstract

The present invention relates to the technical field of unmanned aerial vehicle path planning, and provides a method for coordinated formation control of a fixed-wing unmanned aerial vehicle cluster, including: determining the formation role of each fixed-wing unmanned aerial vehicle; determining the formation parameters of the fixed-wing unmanned aerial vehicle cluster; judging whether the fixed-wing unmanned aerial vehicle cluster needs to be assembled in formation based on the formation parameters of the fixed-wing unmanned aerial vehicle cluster and the formation role of each fixed-wing unmanned aerial vehicle; performing coordinated formation control of the fixed-wing unmanned aerial vehicle cluster based on the formation parameters of the fixed-wing unmanned aerial vehicle cluster and the formation role of each fixed-wing unmanned aerial vehicle; and judging whether the fixed-wing unmanned aerial vehicle cluster ends the coordinated formation control. The present invention is reasonably designed and efficient, and can effectively divide different roles for each fixed-wing unmanned aerial vehicle in the cluster. Through the different formation control logics of the long wingman, the problem that the formation of the fixed-wing unmanned aerial vehicle cluster is difficult to be coordinated and controlled, which easily causes the fixed-wing unmanned aerial vehicles in the cluster to collide, is solved in a coordinated manner.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of unmanned aerial vehicle (UAV) path planning, and in particular to a method for controlling a fixed-wing UAV cluster coordinated formation. Background Art

[0002] Drones are flexible, convenient and fast, and are widely used in civil and military fields. For example, drones are used in agriculture to spray pesticides, so that crops in the cultivated land can be fully covered with pesticides; in geographical surveying and mapping, drones are used to replace manpower to complete panoramic surveying and mapping in high-cold or high-altitude areas; drones are used in earthquake relief to search and rescue trapped people in disaster-stricken areas, etc.

[0003] Fixed-wing UAVs have broader prospects in industry, agriculture, rescue, scientific research and military due to their high maneuverability, high speed, long range and greater payload. When the mission is more complex, a single UAV may have problems such as too long mission duration, high battery consumption, insufficient remaining flight time, limited flight range and low mission robustness, and cannot complete the mission alone. Therefore, it is necessary to use multiple UAVs to form a cluster to solve practical problems through autonomous collaboration.

[0004] However, when fixed-wing UAV swarms deployed in actual scenarios perform specific tasks, they need to fly in a small-spacing formation. Coordinated control of fixed-wing UAV swarm formations to avoid collisions between fixed-wing UAVs within the formation is an important factor that needs to be considered. Existing methods do not give an appropriate response to this factor. Summary of the invention

[0005] The present invention aims to provide a method for coordinated formation control of a fixed-wing UAV cluster, so as to solve the problem of coordinated control to avoid collision in the formation control of a fixed-wing UAV cluster.

[0006] The present invention provides a method for controlling a fixed-wing UAV cluster coordinated formation, comprising the following steps:

[0007] S1, determine the formation role of each fixed-wing UAV;

[0008] S2, determine the formation parameters of the fixed-wing UAV cluster;

[0009] S3, based on the formation parameters of the fixed-wing UAV cluster and the formation role of each fixed-wing UAV, determines whether the fixed-wing UAV cluster needs to be assembled in formation;

[0010] S4, based on the formation parameters of the fixed-wing UAV cluster and the formation role of each fixed-wing UAV, the fixed-wing UAV cluster collaborative formation control is performed;

[0011] S5, determining whether the fixed-wing UAV cluster has ended the coordinated formation control.

[0012] Furthermore, in step S1, the formation role of each fixed-wing UAV in the fixed-wing UAV cluster includes setting a number for each fixed-wing UAV before takeoff, and the fixed-wing UAV with the smallest number is the lead aircraft by default, and the remaining fixed-wing UAVs are wingmen.

[0013] Furthermore, in step S2, determining the formation parameters of the fixed-wing UAV cluster includes determining the formation of the fixed-wing UAV cluster, the horizontal spacing and height difference spacing of each wingman relative to the lead aircraft, and the real-time position of the lead aircraft.

[0014] Further, in step S3, determining whether the fixed-wing UAV cluster needs to be assembled in formation includes:

[0015] According to the formation parameters of the fixed-wing UAV cluster, the number of each fixed-wing UAV, the horizontal and height difference distance between each wingman and the lead aircraft, and the real-time position of the lead aircraft, the expected position of each wingman relative to the lead aircraft is determined; when the distance between a wingman and the expected position exceeds the distance threshold, the wingmen will assemble in formation.

[0016] Furthermore, the formation assembly includes roll angle control, speed control and altitude control;

[0017] The roll angle control formula for wingman formation assembly is as follows:

[0018]

[0019]

[0020]

[0021] in: is the wingman roll angle; is the north component of the vector from the wingman’s current position to the desired position, is the east component of the vector from the wingman's current position to the desired position; The desired track angle for the wingman; is the current track angle of the wingman; is the wingman's expected track angular velocity; is the angular velocity conversion gain; Ground speed for the wingman; is the acceleration due to gravity; Sat() indicates the limited output; is the minimum roll angle of the wingman, is the maximum roll angle of the wingman;

[0022] The speed control formula for wingman formation assembly is as follows:

[0023]

[0024]

[0025] in, is the wingman speed, is the minimum speed of the wingman, is the maximum speed of the wingman; Take the absolute value of the deviation between the wingman's expected track angle and the wingman's current track angle;

[0026] The altitude control formula for wingman formation assembly is:

[0027]

[0028] in, is the wingman altitude, is the height of the long aircraft, The number of the lead aircraft in the current formation. The number of the wingman in the current formation. It is the height difference between the lead aircraft and the wingman.

[0029] Furthermore, in step S4, the fixed-wing UAV cluster coordinated formation control includes lead aircraft formation control and wingman formation control.

[0030] Furthermore, only speed control is required in the lead aircraft formation control; the speed control formula for the lead aircraft formation control is:

[0031]

[0032] in, Long machine speed, The default expected speed of the long-distance aircraft. is the minimum speed of the long machine, is the maximum speed of the long-haul aircraft, is the number of wingmen in the fixed-wing UAV cluster, For the i The formation waiting distance of wingmen, is the long machine speed gain, It is the limit value of the wingman's standby distance.

[0033] Furthermore, the wingman formation control includes roll angle control, speed control and altitude control;

[0034] The roll angle control formula for wingman formation control is:

[0035]

[0036]

[0037]

[0038]

[0039]

[0040]

[0041] in; is the roll angle of the wingman formation control, is the minimum roll angle of the wingman formation control, The maximum roll angle for wingman formation control; The waiting distance for the wingman formation. It is the side deviation distance of the wingman formation; is the foresight distance; is the current track angle of the lead aircraft; is the current track angle of the wingman; The desired track angle for the wingman; is the wingman's expected track angular velocity; is the angular velocity conversion gain; is the desired roll angle; is the roll angle limit; is the flight path angular velocity of the lead aircraft; the ground speed of the lead aircraft and wingman ground speed The wingman's roll angle at the same time Roll angle with the lead aircraft same; is the acceleration due to gravity;

[0042] The speed control formula for wingman formation control is as follows:

[0043]

[0044]

[0045]

[0046] in, is the wingman speed; is the desired velocity vector of the wingman in an ideal situation; and is the control gain; the actual track direction of the wingman and the speed of the leader The deviation is ;

[0047] The altitude control formula for wingman formation control is:

[0048]

[0049] in, is the wingman altitude, is the height of the long aircraft, The number of the lead aircraft in the current formation. The number of the wingman in the current formation. It is the height difference between the lead aircraft and the wingman.

[0050] Furthermore, in step S5, determining whether the collaborative formation control of the fixed-wing UAV cluster has ended includes: determining whether the collaborative formation control of the fixed-wing UAV cluster in step S4 has ended based on control feedback information; if the collaborative formation control of the fixed-wing UAV cluster in step S4 has not ended, then returning to execute step S2 after a period of time; otherwise, ending the control process of the fixed-wing UAV cluster collaborative formation control method.

[0051] In summary, due to the adoption of the above technical solution, the beneficial effects of the present invention are:

[0052] The fixed-wing UAV cluster collaborative formation control method provided by the present invention is reasonably designed and efficient, and can effectively divide different roles for each fixed-wing UAV in the cluster. Through the different formation control logics of the leader and wingman, the problem of the difficulty in collaborative control of the fixed-wing UAV cluster formation, which easily causes collisions between the fixed-wing UAVs in the cluster, is collaboratively solved. BRIEF DESCRIPTION OF THE DRAWINGS

[0053] Figure 1 Flow chart of a method for controlling a cluster of fixed-wing UAVs in a coordinated formation according to an embodiment of the present invention.

[0054] Figure 2 Schematic diagram of the relative positions of the lead aircraft and the wingman in an embodiment of the present invention.

[0055] Figure 3 It is a schematic diagram of the wingman formation assembly in an embodiment of the present invention.

[0056] Figure 4 Schematic diagram of the lead aircraft formation control in an embodiment of the present invention.

[0057] Figure 5 Schematic diagram of wingman formation control in an embodiment of the present invention. DETAILED DESCRIPTION

[0058] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Generally, the components of the embodiments of the present invention described and shown in the drawings here can be arranged and designed in various different configurations.

[0059] Therefore, the following detailed description of the embodiments of the present invention provided in the accompanying drawings is not intended to limit the scope of the invention claimed for protection, but merely represents selected embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0060] Example

[0061] like Figure 1 As shown, this embodiment proposes a fixed-wing UAV cluster coordinated formation control method, including the following steps:

[0062] S1, determine the formation role of each fixed-wing UAV in the fixed-wing UAV cluster;

[0063] like Figure 2 As shown, the preferred embodiment of this embodiment is that the formation role of each fixed-wing UAV in the fixed-wing UAV cluster includes setting a number for each fixed-wing UAV before take-off, and the fixed-wing UAV with the smallest number is the lead aircraft by default, and the remaining fixed-wing UAVs are wingmen.

[0064] S2, determine the formation parameters of the fixed-wing UAV cluster;

[0065] like Figure 2 As shown, the preferred embodiment of this invention is to determine the formation parameters of the fixed-wing UAV cluster, including determining the formation shape of the fixed-wing UAV cluster, the horizontal spacing and height difference spacing of each wingman relative to the lead aircraft, and the real-time position of the lead aircraft and other parameters.

[0066] S3, based on the formation parameters of the fixed-wing UAV cluster and the formation role of each fixed-wing UAV, determines whether the fixed-wing UAV cluster needs to be assembled in formation;

[0067] like Figure 3 As shown, in the preferred embodiment of this invention, determining whether the fixed-wing UAV cluster needs to be assembled in formation includes:

[0068] According to the formation parameters of the fixed-wing UAV cluster, the number of each fixed-wing UAV, the horizontal and height difference distance between each wingman and the lead aircraft, and the real-time position of the lead aircraft, the expected position of each wingman relative to the lead aircraft is determined; when a wingman is too far away from the expected position (exceeding the distance threshold, such as 1000 meters), the wingmen will form a formation to quickly approach the expected position. At this time, the control amount of the wingman is independent of the track angle direction of the lead aircraft.

[0069] Furthermore, the formation assembly includes roll angle control, speed control and altitude control.

[0070] like Figure 3 As shown in the figure, the roll angle control formula for the wingman to form a formation is as follows:

[0071]

[0072]

[0073]

[0074] in: is the wingman roll angle; is the north component of the vector from the wingman’s current position to the desired position, is the east component of the vector from the wingman's current position to the desired position; The desired track angle for the wingman; is the current track angle of the wingman; is the wingman's expected track angular velocity; is the angular velocity conversion gain, which can be taken as 1.0; Ground speed for the wingman; is the acceleration due to gravity; Sat() indicates the limited output; is the minimum roll angle of the wingman, is the maximum roll angle of the wingman.

[0075] The speed control formula for wingman formation assembly is as follows:

[0076]

[0077]

[0078] in, is the wingman speed, is the minimum speed of the wingman, is the maximum speed of the wingman; is the absolute value of the deviation between the wingman’s expected track angle and the wingman’s current track angle. Less than When the aircraft is in the desired position, it accelerates to the desired position; otherwise, it goes in the reverse state and flies at the minimum speed.

[0079] The altitude control formula for wingman formation assembly is:

[0080]

[0081] in, is the wingman altitude, is the height of the long aircraft, The number of the lead aircraft in the current formation. The number of the wingman in the current formation. It is the height difference between the lead aircraft and the wingman.

[0082] S4, coordinated formation control of fixed-wing UAV cluster based on the formation parameters of the fixed-wing UAV cluster and the formation role of each fixed-wing UAV;

[0083] Preferably, the fixed-wing UAV cluster coordinated formation control includes lead aircraft formation control and wingman formation control.

[0084] Furthermore, the leader will fly autonomously according to the route waypoints during formation flight, and the leader only needs to perform speed control during formation control. If the leader is flying at the lowest or highest speed, the wingman lacks speed adjustment space, and appropriate intervention in the leader's speed can greatly shorten the formation time. Therefore, the leader uses the fixed speed attribute set at the waypoint as the speed control benchmark. The leader collects the formation waiting distance of each wingman and adjusts the leader's flight speed according to the average waiting distance of the wingman as a whole lagging behind or exceeding the expected position.

[0085] like Figure 4 As shown in the figure, the speed control formula for the lead aircraft formation control is:

[0086]

[0087] in, Long machine speed, The default expected speed of the long-distance aircraft. is the minimum speed of the long machine, is the maximum speed of the long-haul aircraft, is the number of wingmen in the fixed-wing UAV cluster, For the i The formation waiting distance of wingmen, is the long machine speed gain, which can be 1. The limit value of the wingman's standby distance can be 1000m.

[0088] Furthermore, the wingman follows the lead aircraft, and the wingman formation control includes two parts: trajectory tracking control of the wingman and the lead aircraft and attitude tracking control of the wingman and the lead aircraft. The former is suitable for following the straight segment trajectory, and the latter is suitable for following the lead aircraft in turns and maintaining the distance when following the lead aircraft in turns. The two are combined to form the wingman tracking control law, which generates the roll angle control, speed control and altitude control of the wingman formation control.

[0089] Schematic diagram of wingman formation control Figure 5 As shown, The waiting distance for the wingman formation. is the wingman formation side deviation distance. The purpose of wingman formation control is to make .

[0090] Roll angle control for wingman formation control:

[0091] Wingman formation control is the forward-looking distance, which is equivalent to the lateral control gain. The longer the distance, the smaller the gain. The parameter value is also related to the flight speed. The higher the speed, the better the formation assembly. The larger the value, the smaller the speed change. In this embodiment, a fixed value is taken. . is the current track angle of the lead aircraft, is the current track angle of the wingman, is the desired flight path angle of the wingman, is the wingman's expected track angular velocity, is the angular velocity conversion gain, which can be set to 1.0. is the desired roll angle, is the roll angle limit, here we take .

[0092]

[0093]

[0094]

[0095] Attitude tracking control wingman follows the lead aircraft's roll angle , ignoring the roll angle of the long aircraft For values ​​less than 1°, is the flight path angular velocity of the lead aircraft, and the ground speed of the lead aircraft and wingman ground speed At the same time, the wingman's roll angle Roll angle with the lead aircraft same, is the acceleration due to gravity.

[0096]

[0097]

[0098] The two channels are combined to form the final roll angle control formula for wingman formation control as follows:

[0099]

[0100] Roll angle for wingman formation control.

[0101] Speed ​​control for wingman formation control:

[0102] Assume that the desired velocity vector of the wingman in an ideal situation is , in the lead aircraft's track coordinate system, The expression is as follows:

[0103]

[0104] in, and For control gain, both can be set to 1; the actual track direction of the wingman is The deviation is , that is, the track angle deviation between the wingman and the leader. Therefore, the speed control formula for wingman formation control is as follows:

[0105]

[0106]

[0107] in, is the wingman speed.

[0108] Consistent with the wingman formation assembly, the altitude control formula for wingman formation control is:

[0109]

[0110] in, is the wingman altitude, is the height of the long aircraft, The number of the lead aircraft in the current formation. The number of the wingman in the current formation. It is the height difference between the lead aircraft and the wingman.

[0111] S5, determining whether the fixed-wing UAV cluster has ended the coordinated formation control.

[0112] Preferably, in this embodiment, determining whether the collaborative formation control of the fixed-wing UAV cluster has ended includes: determining whether the collaborative formation control of the fixed-wing UAV cluster in step S4 has ended based on control feedback information; if the collaborative formation control of the fixed-wing UAV cluster in step S4 has not ended, then returning to execute step S2 after a period of time; otherwise, ending the control process of the fixed-wing UAV cluster collaborative formation control method.

[0113] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. A method for controlling a fixed-wing UAV cluster coordinated formation. It is characterized in that The steps include: S1, determine the formation role of each fixed-wing UAV; S2, determine the formation parameters of the fixed-wing UAV cluster; S3, based on the formation parameters of the fixed-wing UAV cluster and the formation role of each fixed-wing UAV, determines whether the fixed-wing UAV cluster needs to be assembled in formation; S4, based on the formation parameters of the fixed-wing UAV cluster and the formation role of each fixed-wing UAV, the fixed-wing UAV cluster collaborative formation control is performed; S5, determining whether the fixed-wing UAV cluster has ended the coordinated formation control; The formation assembly includes roll angle control, speed control and altitude control; The roll angle control formula for wingman formation assembly is as follows: in: is the wingman roll angle; is the north component of the vector from the wingman’s current position to the desired position, is the east component of the vector from the wingman's current position to the desired position; The desired track angle for the wingman; is the current track angle of the wingman; is the wingman's expected track angular velocity; is the angular velocity conversion gain; Ground speed for the wingman; is the acceleration due to gravity; Sat() indicates the limited output; is the minimum roll angle of the wingman, is the maximum roll angle of the wingman; The speed control formula for wingman formation assembly is as follows: in, is the wingman speed, is the minimum speed of the wingman, is the maximum speed of the wingman; Take the absolute value of the deviation between the wingman's expected track angle and the wingman's current track angle; The altitude control formula for wingman formation assembly is: in, is the wingman altitude, is the height of the long aircraft, The number of the lead aircraft in the current formation. The number of the wingman in the current formation. The height difference between the lead aircraft and the wingman; In step S4, the fixed-wing UAV cluster coordinated formation control includes leader formation control and wingman formation control; In the lead formation control, only speed control is required; the speed control formula for the lead formation control is: in, Long machine speed, The default expected speed of the long-distance aircraft. is the minimum speed of the long machine, is the maximum speed of the long-haul aircraft, is the number of wingmen in the fixed-wing UAV cluster, For the i The formation waiting distance of wingmen, is the long machine speed gain, The wingman standby distance limit value; The wingman formation control includes roll angle control, speed control and altitude control; The roll angle control formula for wingman formation control is: in, is the roll angle of the wingman formation control, is the minimum roll angle of the wingman formation control, The maximum roll angle of the wingman formation control; The waiting distance for the wingman formation. It is the side deviation distance of the wingman formation; is the foresight distance; is the current track angle of the lead aircraft; is the current track angle of the wingman; The desired track angle for the wingman; is the wingman's expected track angular velocity; is the angular velocity conversion gain; is the desired roll angle; is the roll angle limit; is the flight path angular velocity of the lead aircraft; the ground speed of the lead aircraft and wingman ground speed The wingman's roll angle at the same time Roll angle with the lead aircraft same; is the acceleration due to gravity; The speed control formula for wingman formation control is as follows: in, is the wingman speed; is the desired velocity vector of the wingman in an ideal situation; and is the control gain; the actual track direction of the wingman and the speed of the leader The deviation is ; The altitude control formula for wingman formation control is: in, is the wingman altitude, is the height of the long aircraft, The number of the lead aircraft in the current formation. The number of the wingman in the current formation. It is the height difference between the lead aircraft and the wingman.

2. The method for controlling a cluster of fixed-wing UAVs in coordinated formation according to claim 1, It is characterized in that In step S1, the formation role of each fixed-wing UAV in the fixed-wing UAV cluster includes setting a number for each fixed-wing UAV before takeoff, and the fixed-wing UAV with the smallest number is the leader by default, and the remaining fixed-wing UAVs are wingmen.

3. The method for controlling a cluster of fixed-wing UAVs in coordinated formation according to claim 2, It is characterized in that In step S2, determining the formation parameters of the fixed-wing UAV cluster includes determining the formation of the fixed-wing UAV cluster, the horizontal spacing and height difference spacing of each wingman relative to the lead aircraft, and the real-time position of the lead aircraft.

4. The method for controlling a cluster of fixed-wing UAVs in coordinated formation according to claim 3, It is characterized in that In step S3, determining whether the fixed-wing UAV cluster needs to be assembled in formation includes: According to the formation parameters of the fixed-wing UAV cluster, the number of each fixed-wing UAV, the horizontal and height difference distance between each wingman and the lead aircraft, and the real-time position of the lead aircraft, the expected position of each wingman relative to the lead aircraft is determined; when the distance between a wingman and the expected position exceeds the distance threshold, the wingmen will assemble in formation.

5. The fixed-wing UAV cluster coordinated formation control method according to claim 1, It is characterized in that In step S5, judging whether the coordinated formation control of the fixed-wing UAV cluster has been completed includes: judging whether the coordinated formation control of the fixed-wing UAV cluster in step S4 has been completed based on the control feedback information; if the coordinated formation control of the fixed-wing UAV cluster in step S4 has not been completed, then returning to execute step S2 after a period of time; otherwise, terminating the control process of the coordinated formation control method of the fixed-wing UAV cluster.