Method for cooperative tracking of target group by unmanned aerial vehicle group in GNSS area denial environment
Through the agglomeration hierarchical clustering algorithm and online re-planning technology, the problem of collaborative tracking of drones in GNSS interference environments in GNSS interference environments is solved, and efficient tracking of target groups by drones is achieved, improving control accuracy and rudeness Great.
Patent Information
- Application Number
- CN202411155788.3
- 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
In GNSS interference and shading environments, it is difficult for drones to obtain relative positioning information, and traditional GNSS-based flight guidance control methods are difficult to apply, resulting in a decrease in accuracy or failure in tracking missions of drones.
The targets are clustered using a condensation hierarchical clustering algorithm, and the drone is allocated to the target group. The drone trajectory convergence and relative positioning information are combined for online re-planning, and a single-machine tracking and multi-machine collaborative tracking control algorithm is constructed, and the range measurement is used. Signal and heading information design control instructions to realize coordinated tracking of drone groups in GNSS area denial environment.
It realizes efficient tracking of the target group by the drone group in the GNSS interference environment, improves task planning and control accuracy, reduces cost and structural complexity, and has the advantages of robustness and ease of online implementation.
Smart Images

Figure CN119088053A_ABST
Abstract
Description
Technical Field
[0001] The disclosed embodiments relate to the field of flight control technology, and more particularly to a method for a group of drones to collaboratively track a target group in a GNSS area denial environment. Background Art
[0002] With the development of information technology and the improvement of communication level, drone swarm systems are widely used in collaborative target detection, area search, target tracking and positioning, etc. One typical application is that drone swarms use the sensors they carry to detect the target state, and design corresponding controllers based on the drones and their own states to achieve collaborative tracking of ground targets and continuous observation of targets. Drone swarm systems have strong maneuverability, and their spatial distribution can change dynamically to adapt to changes in the environment and target movement. Therefore, drone swarms can not only accurately track specific single targets, but also track target groups. The research on drone swarm collaborative tracking of ground target groups has important application value. However, the design of such an effective tracking system still faces many challenges, and the difficulties are mainly concentrated in three aspects: (1) uncertainty of target state; (2) uncertainty of sensor observation; and (3) cooperation of multiple drones. The uncertainty of target state is mainly reflected in the maneuver and disappearance of the target (concealment, camouflage and deception) and unknown target attributes; the uncertainty of sensor observation is usually caused by measurement noise. In addition, the movement of drones will also affect sensor observations. How to reasonably and efficiently allocate drones to achieve collaborative tracking tasks of one or more targets is the focus and difficulty of current research.
[0003] As a control technology to improve the autonomy level of drones, drone-to-ground tracking control obtains the state information of the target through the sensors it carries, and then formulates corresponding control strategies to achieve hovering tracking of the target. Furthermore, it can monitor and drive away the target. In existing methods, it is usually assumed that the drone can obtain the relative positioning information of itself and the target, so as to formulate corresponding control strategies to achieve tracking and control of the target. Considering that in actual environments such as forests and canyons, there are GNSS interference and shielding, resulting in the lack of relative positioning information of the drone itself, and the traditional flight guidance and control method based on GNSS relative positioning information will be difficult to apply. Although the information provided by the inertial navigation system (INS) can be used to realize the positioning of the drone itself, the integral drift phenomenon of INS causes the positioning accuracy of the drone to decrease, which further leads to the failure of the tracking task or the decrease of tracking control accuracy. Summary of the invention
[0004] In order to avoid the shortcomings of the prior art, the present application provides a method for a group of drones to collaboratively track a target group in a GNSS area denial environment, so as to solve the problem in the prior art that in actual environments such as forests and canyons, there is GNSS interference and shielding, which causes the drones to lack their own relative positioning information, and the traditional flight guidance and control method based on GNSS relative positioning information will be difficult to apply.
[0005] According to an embodiment of the present disclosure, a method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment is provided, the method comprising: Based on the relative positioning information of each target, the targets are clustered using an agglomerative hierarchical clustering algorithm to obtain a number of target groups; According to the number and importance of each target group, the number of drones and the distance information between the center of each target group and each drone, the drones are allocated to each target group to complete the initial allocation; reallocating the target group to each of the drones according to the convergence of the drone trajectories and the relative positioning information of the target, so as to perform online replanning of the drones; According to the result of the online replanning, the relative positioning information, the speed information of the UAV and the heading information of the UAV, a single-machine tracking control algorithm and a multi-machine collaborative tracking control algorithm are respectively constructed; A control instruction group is obtained by solving the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm, and the control instruction group is input into a controller group to control the UAV to track the target group; wherein the control instruction group includes an altitude control instruction, a roll angle control instruction and a speed control instruction, and the controller group includes an altitude controller, a roll angle controller and a speed controller.
[0006] Furthermore, based on the relative positioning information of each target, the target is clustered using an agglomerative hierarchical clustering algorithm to obtain a plurality of target groups, including: Initialize and classify the m targets into one class, calculate the distance between the center positions of every two classes, and take the minimum value; If the minimum value is less than the preset distance , then the two classes are merged into one target group. If the minimum value is greater than the preset distance , then keep the original grouping; Dynamically monitor the target group. If the distance between any target in the target group and the center of the target group is greater than the preset distance , then remove the target from the target group and divide it into a single class; Repeat the above steps until the target clustering is completed.
[0007] Furthermore, according to the number and importance of each target group, the number of drones and the distance information between the center of each target group and each drone, the drones are allocated to each target group to complete the initial allocation step, including: If the number of the drones is greater than the number of the target group, the multiple drones cooperate to track the same target group; If the number of the drones is less than the number of the target groups, the order to be tracked is sorted according to the preset importance of the target groups, and the unimportant target groups are abandoned; If the number of the drones is equal to the number of the target group, an intelligent optimization algorithm is used for initial allocation.
[0008] Furthermore, according to the convergence of the drone trajectory and the relative positioning information of the target, the target group is reallocated to each drone to perform online replanning of the drone, including: If the trajectory of the drone has not converged, reassigning the target group to each drone or removing the target from the target group according to the relative positioning information; Repeat the above steps until the UAV trajectory converges to complete the line weight planning.
[0009] Further, the step of reassigning the target group to each of the drones or removing the target from the target group according to the relative positioning information includes: regrouping the targets according to the relative positioning information; If target merging occurs, the UAV tracks the new target group; If the tracking radius required by the target group is larger than the detection range of the UAV, the target farthest from the center in the target group will be removed.
[0010] Further, the steps of constructing a single-machine tracking control algorithm and a multi-machine collaborative tracking control algorithm respectively according to the result of the online replanning, the relative positioning information, the speed information of the UAV and the heading information of the UAV include: Constructing a relative motion equation of a system for cooperatively tracking the center of a target group by a group of drones according to the relative positioning information, the speed information and the heading information; Based on the distance information of the UAV relative to the target, a finite-time sliding mode estimator is constructed; According to the relative motion equation, the result of the online replanning and the finite time sliding mode estimator, the single machine tracking control algorithm and the multi-machine collaborative tracking control algorithm are constructed respectively.
[0011] Furthermore, the expression of the finite time sliding mode estimator is:
[0012] in, For ranging signal The estimated value of is the ranging rate signal The estimated value of is the absolute value symbol, is a symbolic function, expressed as ,variable are the parameters to be designed.
[0013] Furthermore, the relative motion equation of the system in which the drone group cooperates to track the center of the target group is expressed as:
[0014] in, is the longitudinal component of the UAV velocity vector along the UAV-target line, is the speed of the drone, is the lateral angle, for The differential of For the i The angle between the drone-target line and the geographic east direction, For the i+ The angle between the drone-target line and the geographic east direction, is the angle between the first UAV-target line and the geographic east direction, is the angle between the N1th UAV-target line and the geographic east direction, is the number of drones, The first phase separation angle The differential of The second phase separation angle The differential of for The differential of for The differential of for The differential of for The differential of for The differential of , and there is the following relationship ; The expression of the single-machine tracking control algorithm is:
[0015] in, is the preset tracking radius, For damping, is the first control gain to be designed, is the ranging rate signal An estimated value of The expression estimated by the multi-machine cooperative tracking control algorithm is:
[0016] in, is the second control gain to be designed, is the speed control command, is the desired speed command, Represents the phase separation angle The estimated value of Represents the phase separation angle The estimated value of .
[0017] Furthermore, the method further comprises: The relative position of the target is estimated by using the phase separation angle estimation value, the relative positioning information, the speed information and the heading angle information to determine the state of the target; wherein, The phase separation angle estimate is obtained according to the estimation algorithm:
[0018] in, is the derivative of the drone position vector with respect to time, and , for The transpose of is the position vector of the drone relative to the target The estimated value of for Regarding the time derivative, is the control gain to be designed, and Estimate the relative position The easting and northing components of .
[0019] Further, the step of obtaining a control instruction group by solving the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm, and inputting the control instruction group into a controller group to control the UAV to track the target group includes: The relative positioning information, the speed information and the heading information are solved by using the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm to obtain the altitude control instruction, the roll angle control instruction and the speed control instruction; The altitude control instruction, the roll angle control instruction and the speed control instruction are respectively input into the altitude controller, the roll angle controller and the speed controller to control the UAV to track the target group, thereby achieving response to the guidance instruction and maintaining the aircraft attitude.
[0020] The technical solution provided by the embodiments of the present disclosure may have the following beneficial effects: In an embodiment of the present disclosure, through the above-mentioned method of cooperatively tracking a target group by a swarm of drones in a GNSS area denial environment, on the one hand, at the task planning layer, first, the distance between different target groups is calculated, and the merging and separation of different target groups are realized through a top-down agglomerative hierarchical clustering algorithm, and the type of target group that needs to be surrounded and tracked is determined according to the detection range of the drone; the distance between the drone and the center of the target group is used to realize the scheduling of the drone, and different drone groups are assigned to different target groups; while the drone group continues to track the assigned target group, according to the sensor perception range or the convergence of the drone trajectory, the target is reassigned to the drone group or the target is removed from the group to realize online replanning of the number of drones; at the guidance layer control, the distance information between the drone and the center of the target group and the status information of the drone are used to design corresponding single-machine encirclement tracking control and cooperative encirclement control algorithms to realize collaborative positioning of the target; at the bottom layer control, a mature PID control algorithm is used to realize stable control of the drone attitude. On the other hand, this application only requires ranging sensor information, which can realize online planning and control of drone swarms. It has the advantages of low cost, simple structure, strong robustness, and easy online implementation. It can realize the coordinated tracking of drone swarms to target groups in GNSS regional environments. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] 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.
[0022] Figure 1 A step diagram showing a method for cooperative tracking of a target group by a group of drones in a GNSS area denial environment in an exemplary embodiment of the present disclosure; Figure 2 A schematic diagram of an algorithm structure for cooperatively tracking an unknown target group by a group of drones in an exemplary embodiment of the present disclosure is shown; Figure 3 A schematic diagram showing the geometric relationship of UAVs cooperatively tracking ground targets in an exemplary embodiment of the present disclosure; Figure 4 A schematic diagram of a topological structure of communication connection between drones in an exemplary embodiment of the present disclosure is shown; Figure 5 A trajectory diagram of three drones in an exemplary embodiment of the present disclosure is shown; Figure 6 The distance between drones and the distance between drones and targets in an exemplary embodiment of the present disclosure are shown; Figure 7 The tracking control command output and rolling angle response of three UAVs in an exemplary embodiment of the present disclosure are shown; Figure 8 The figure shows the rudder output of the aileron and the embedded control surface in the exemplary embodiment of the present disclosure; Fig. 9 The speed change of the drone in the exemplary embodiment of the present disclosure is shown; Fig.10 shows the change of phase separation angle in the exemplary embodiment of the present disclosure; Fig.11 The estimated value and the true value of the phase angle in the exemplary embodiment of the present disclosure are shown; Fig.12 The estimated ranging rate and the actual ranging rate change in the exemplary embodiment of the present disclosure are shown; Fig.13 The full-process simulation results of the drone group cooperating with the unknown moving target group in the exemplary embodiment of the present disclosure are shown; Fig.14 The tracking results of the drone group cooperating with the unknown moving target group during 0-200s in the exemplary embodiment of the present disclosure are shown; Fig.15 The tracking results of the drone group cooperating with the unknown moving target group for 200-400s in the exemplary embodiment of the present disclosure are shown; Fig.16 The tracking results of the drone group cooperating with the unknown moving target group for 400-600s in the exemplary embodiment of the present disclosure are shown; Fig.17 The tracking results of the drone group cooperating with the unknown moving target group for 600-800s in the exemplary embodiment of the present disclosure are shown. DETAILED DESCRIPTION
[0023] 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.
[0024] 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.
[0025] This example embodiment provides a method for a group of drones to collaboratively track a target group in a GNSS area denial environment. Figure 1 As shown in , the method for cooperative tracking of a target group by a group of drones in a GNSS area denial environment may include: steps S101 to S105.
[0026] Step S101: Based on the relative positioning information of each target, the targets are clustered using an agglomerative hierarchical clustering algorithm to obtain a number of target groups; Step S102: allocating the drones to the target groups according to the number, importance, number of drones and distance information between the center of the target groups and the drones, so as to complete the initial allocation; Step S103: reallocating the target group to each drone according to the convergence of the drone trajectory and the relative positioning information of the target, so as to perform online replanning of the drone; Step S104: constructing a single-machine tracking control algorithm and a multi-machine collaborative tracking control algorithm respectively according to the online replanning result, the relative positioning information, the speed information of the UAV and the heading information of the UAV; Step S105: A control instruction group is obtained by using the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm, and the control instruction group is input into a controller group to control the UAV to track the target group; wherein the control instruction group includes an altitude control instruction, a roll angle control instruction and a speed control instruction, and the controller group includes an altitude controller, a roll angle controller and a speed controller.
[0027] Through the above-mentioned method of cooperative tracking of target groups by drone groups in a GNSS area denial environment, on the one hand, at the task planning layer, first, the distance between different target groups is calculated, and the merging and separation of different target groups are realized through a top-down agglomerative hierarchical clustering algorithm, and the type of target group that needs to be surrounded and tracked is determined according to the detection range of the drone; the distance between the drone and the center of the target group is used to realize the scheduling of the drone, and different drone groups are assigned to different target groups; while the drone group continues to track and assign the target group, according to the sensor perception range or the convergence of the drone trajectory, the target is reassigned to the drone group or the target is removed from the group to realize the online replanning of the number of drones; at the guidance layer control, the distance information between the drone and the center of the target group and the state information of the drone are used to design the corresponding single-machine encirclement tracking control and cooperative encirclement control algorithms to realize the cooperative positioning of the target; at the bottom control, a mature PID control algorithm is used to realize the stable control of the drone attitude. On the other hand, this application only requires ranging sensor information, can realize the online planning and control of drone groups, has the advantages of low cost, simple structure, strong robustness, easy online implementation, etc., can realize the cooperative tracking of drone groups to target groups in a GNSS area environment.
[0028] Next, we will refer to Figures 1 to 17 The various steps of the method for collaborative tracking of a target group by a swarm of drones in a GNSS area denial environment in this example implementation are described in more detail.
[0029] In step S101, Figure 2 As shown in the figure, target clustering: according to the distance between different targets, the agglomerative hierarchical clustering algorithm is used to merge and separate the target groups to determine the target group that needs to complete the tracking task. Its implementation is divided into the following steps: Step 1: Assume that there are m targets, initialize each target into a class, calculate the distance between the center positions of every two classes, and take the minimum value.
[0030] Step 2: If the minimum distance is less than (specify the target group radius), the two categories will be merged into one category. If the minimum distance is greater than , the grouping remains unchanged.
[0031] Step 3: If the location of the target changes dynamically, the radius of each class needs to be recalculated. , the target farthest from the center of the circle is removed and divided into a single category. , the original grouping is retained.
[0032] Step 4: Repeat Step 2 and Step 3 until there is no need to merge and separate target groups.
[0033] In step S102, Figure 2 As shown in the figure, drone swarm scheduling: after target clustering is completed, drones need to be assigned to the corresponding target group. The distance between the drone swarm and the target group is used as the optimization indicator. The drone swarm is assigned so that the drone can track the designated target in the shortest time and use as few drones as possible to observe as many targets as possible.
[0034] After completing the initial grouping of the target groups, the drone groups need to be assigned to the corresponding target groups. The assignment task is a drone group scheduling problem, the goal is to make the drones track the designated targets in the shortest time and use as few drones as possible to observe as many targets as possible. In addition, the maximum coverage of the drones must be guaranteed so that the drones can react quickly when the targets are separated or new targets appear. The optimization objectives of drone group scheduling are as follows: (1) In the formula Indicates drone, Indicates target group, represents the unit step function, , and As parameters, For the The first drone The distance between the drones, For the The tracking radius required by the group, Indicates The number of targets in the group.
[0035] In addition, the requirement that each drone can only track one target group must be met: (2) In the formula Indicates the number of drones. There may be three situations during drone dispatching: 1) The number of drones is greater than the number of target groups. In this case, multiple drones need to meet the following constraints to track the same target collaboratively: .
[0036] 2) The number of drones is less than the number of target groups. Drones cannot guarantee to track all targets, so unimportant target groups need to be discarded according to their importance. The importance of target groups can be specified by ground personnel or in advance.
[0037] 3) The number of drones is equal to the number of target groups. In this case, it is only necessary to schedule according to the distance between the drone and the target. In the initial allocation of the drone group, intelligent optimization algorithms such as ant colony optimization algorithm, genetic algorithm, simulated annealing algorithm, etc. can be used to use formula (1) as the optimization index to achieve the initial allocation of the number of drones.
[0038] In step S103, Figure 2 As shown in the figure, online replanning: while the drone swarm continues to track the assigned target group, it reassigns targets to the drone swarm or removes targets from the group based on the sensor perception range or the convergence of the drone trajectory, thereby realizing online replanning of the number of drones.
[0039] After completing the initial assignment of the drone swarm to the target group, online local replanning can be performed, that is, while the drones continue to track the corresponding group, they can reassign targets to the drone swarm or remove targets from the group according to the sensor perception range or the convergence of the drone trajectory.
[0040] 1) Target merging: By recursively running the hierarchical clustering algorithm, targets can be redistributed between drone groups, and targets can be regrouped according to their proximity to the target group and drones. When target merging occurs, the tracking radius required for the new target group will become larger, and the drone group will first expand the tracking radius. When the tracking distance reaches the requirements of the new target group, the drone group will track the new target group.
[0041] 2) Target discard: If the required tracking radius of a target group is larger than the detection range of the sensor, the target farthest from the center of the target group will be removed.
[0042] In step S104, Figure 2 As shown in the figure, the collaborative tracking control method in a denied environment is designed: a pure distance estimator is designed using the distance between the UAV and the target and a finite-time sliding mode estimator to achieve tracking control of a single UAV over a target; the target is positioned using distance information, rate information estimated by the sliding mode estimator, and the heading angle information of the UAV, and a speed collaborative control algorithm is designed with the help of a directed graph to achieve collaborative tracking control of multiple UAVs over targets.
[0043] After determining the tracking control task, it is necessary to design a tracking control algorithm in a denial environment. According to the number of assigned drones, a single-machine tracking control algorithm and a multi-machine collaborative tracking control algorithm are designed respectively. The single-machine tracking control is the basis for realizing collaborative tracking control. The algorithm design is divided into the following three parts: Step 1: Establish the relative motion equation of the system for the drone swarm to collaboratively track the center of the target group.
[0044] In order to facilitate the derivation of the formula, it is assumed that all drones are equipped with altitude controllers, speed controllers, and attitude controllers, which can respond to altitude commands, speed commands, and roll angle commands, and the altitudes of the drone group and the target remain unchanged. Figure 3 As shown, considering A collaborative tracking system consisting of 2 drones. It represents the distance of the i-th UAV in the current UAV group relative to the center of the current tracking target. is the preset tracking radius, is the heading angle of the UAV, is the speed of the drone, is the angle between the drone-target line and the geographic north direction, the phase angle is the angle between the UAV-target line and the geographic east direction, and the phase separation angle is The longitudinal component of the UAV velocity vector along the UAV-target line is , the lateral component is , is the lateral angle. According to the relationship between the various angles, there is an angle relationship , ,but , and the counterclockwise motion is defined as the positive direction. The relative kinematic equation of the center of the target group for the drone group to track cooperatively is: (1) Purpose Design Control Algorithm and , so that each UAV converges to the desired circular orbit under the control algorithm, that is, , and all UAVs are evenly distributed on the tracking circle, that is, .
[0045] Step 2: Single-machine tracking control algorithm and target relative position estimation.
[0046] Assuming that the UAV can obtain ranging information and ranging rate information relative to the target, this application will propose the following tracking control algorithm: (2) In the formula is the control gain to be designed, which is preferably 2 here, is damping, preferably 0.8 here. For drones equipped only with ranging sensors, the ranging rate signal can be obtained by numerical differentiation or differential filtering, but both methods have large errors. Therefore, this application proposes the following finite time sliding mode estimation algorithm that only uses ranging signals to achieve rapid estimation and recovery of ranging rate. The finite time sliding mode estimator is designed as follows: (3) In the formula For ranging signal The estimated value of is the ranging rate signal The estimated value of is the absolute value symbol, is a symbolic function, expressed as ,variable To optimize the design parameters, we set the parameters to , , Under the action of the above estimator (3), the estimated rate value Will be within a limited time with the ranging rate signal Therefore, using the estimated rate To replace the ranging rate signal in the controller (2), this application will propose the following pure distance control algorithm: (4) A single UAV i will realize fixed-distance hovering tracking of the center of the target group under the control of the control algorithm (4).
[0047] Since the drone can only obtain the distance information of the target and cannot distinguish the identity characteristics of the target, in addition, the drone may not know the kinematic and dynamic characteristics of the target, as well as the total number and density of the target, which makes the above drone scheduling algorithm invalid. Therefore, this application intends to use the distance measurement information, estimated speed information and heading angle information to realize the drone's estimation of the relative position of the target, determine the state information of the target group, and thus realize the online allocation of the drone to the target group. The relative position estimator is designed as follows: (5) In the formula The derivative of the drone position vector with respect to time can be expressed as , Transpose it, is the position vector of the drone relative to the target The estimated value of for Taking the derivative with respect to time, we get is the control gain to be designed, which is preferably 0.02.
[0048] Step 3: Estimation of multi-machine collaborative tracking control algorithm.
[0049] To achieve The present application proposes the following distributed speed coordination controller for the uniform hovering tracking control of an unknown target by a UAV: (6) In the formula is the control gain to be designed, is the speed control command, is the desired speed command, Represents the phase separation angle The estimated value of Represents the phase separation angle The estimated value of . The optimal control gain is for . Note , is the phase angle signal The estimated value of , For relative position The estimated value of is obtained by formula (5), , Estimate the relative position The communication method between drones is as follows: Figure 4 shown. Figure 4 Equation (6) shows that the control algorithm only needs to exchange the relative position information estimated by adjacent UAVs. , and the control method is completely distributed, which can realize the formation control of any number of drones.
[0050] Combining the hovering tracking control algorithm (4) and the distributed speed control algorithm (6), the distributed cooperative tracking control algorithm of the UAV proposed in this application is as follows: (7) Heading angle control command It is not possible to directly input the roll angle controller. The coordinated turning equation is used to convert the control command into a roll angle input command. The final coordinated control algorithm is as follows: (8) In the formula is the roll angle control command, is the speed control command, is the acceleration due to gravity.
[0051] In step S105, Figure 2 As shown in the figure, the underlying flight control method is designed: the control instructions of the flight guidance layer are converted into control input instructions, and the altitude control law, roll angle control law, and speed control law are designed with the help of mature PID control algorithms to achieve the response to the guidance instructions and the control of the aircraft attitude.
[0052] After completing the design of the tracking control algorithm, the required altitude control command, roll angle control command, and speed control command are input into the altitude controller, roll angle controller, heading stabilization controller, and speed controller designed based on the PID method to achieve the response to the guidance command and the maintenance of the aircraft attitude. The altitude controller is used to achieve the altitude maintenance and control of the UAV, the roll angle controller is used to track the roll angle control command in formula (6), the heading stabilization controller is used to improve the Dutch roll mode of the aircraft and eliminate the sideslip angle, and the speed controller is used to track the speed control command of formula (7). Combined with the above steps S101 to S105, the fixed-distance hovering tracking control of the UAV group to the target group in the GNSS area denial environment can be finally achieved.
[0053] In a specific embodiment, Figures 5 to 12 The simulation results of three UAVs tracking a stationary target using the cooperative tracking control algorithm (6) proposed in this application are shown. When three UAVs are used to circle a target fixed at (0,0) m, the tracking radius is set to 300 m, and the initial positions of the three UAVs are set to , , , the initial heading angle is , , The sliding mode estimators are initialized as , the relative position estimator (5) is initialized as , , , the control gain parameters are the same as those in step S104-step S105, Figure 5 and Figure 6 The global asymptotic convergence of the single-machine pure distance control algorithm (4) is demonstrated, and the UAV can track the target with any heading angle and any position configuration. Figure 7 and Figure 8 It demonstrates that the deflection of the drone's rudder surfaces is within a reasonable range, enabling rapid tracking and response to guidance commands. Fig. 9 and Fig.10 It is shown that by adjusting the speed of the UAV, uniform tracking of the target can be achieved, the phase separation angle of the UAV converges to the desired phase separation angle, and even if the speed of the UAV fluctuates greatly, the distributed speed coordination algorithm (6) still converges. Fig.11 It shows that the rate estimated by the sliding mode estimator (3) can achieve fast tracking of the actual ranging rate. Fig.12 It shows that under the action of the relative position estimator (5), the phase angle estimated under different initialization positions is consistent with the real phase angle for a period of time. In summary, the coordinated tracking control algorithm (8) proposed in this application is effective.
[0054] Figures 13 to 17 The simulation results of the method of cooperative tracking of group targets by drone swarm proposed in this application are shown. In the simulation, 4 drones are used to track 7 targets, and 3 typical situations that may occur are comprehensively tested, including target group merging, target group separation and target abandonment. The initial positions of the 7 targets are set as m, m, m, m, m, m, m, the initial positions of the four drones are set to m, m, m, m, the tracking radius is set to 200m, and the target group radius is set to 100m. Under the preset information, the targets are first grouped, and then drones are assigned to track the targets. The basis for drone scheduling is mainly based on the status of the target group and the location of the drone. Fig.14 As shown in the figure, the hierarchical clustering algorithm is used to divide the targets into three groups, and the number of targets in the groups is 3, 2, and 2 respectively. Four drones are assigned to track the three target groups, among which Group 2 is tracked by two drones and the other two groups are tracked by one drone each. In the initial stage, since Group 2 is tracked by two drones, the two drones use a distributed tracking algorithm to track the targets. When the simulation reaches 100 s, one target in Group 1 is separated. At the initial separation, the drone will expand the tracking range, but the separated target continues to move away from Group 1, and there are no other drones nearby, so the tracking of the target is abandoned. Fig.15 In the example, there are two targets left in group 1, which are tracked by drone 1. Group 2 contains two targets, which are tracked by drone 3 and drone 4. Group 3 contains two targets, which are tracked by drone 2. Fig.16 In the simulation, when the simulation reaches 500s, the two targets in group 2 separate, and the two drones responsible for tracking group 2 are assigned to track the two separated targets. Fig.17 When the simulation reaches 700 s, the target separated from group 1 is merged into one target group and tracked by drone 1, while the two targets separated from group 2 are tracked by drone 3 and drone 4 respectively. The simulation results show the feasibility and effectiveness of the method proposed in this application for multi-target tracking in a GNSS-denied environment.
[0055] Through the above-mentioned method of cooperative tracking of target groups by drone groups in a GNSS area denial environment, on the one hand, at the task planning layer, first, the distance between different target groups is calculated, and the merging and separation of different target groups are realized through a top-down agglomerative hierarchical clustering algorithm, and the type of target group that needs to be surrounded and tracked is determined according to the detection range of the drone; the distance between the drone and the center of the target group is used to realize the scheduling of the drone, and different drone groups are assigned to different target groups; while the drone group continues to track and assign the target group, according to the sensor perception range or the convergence of the drone trajectory, the target is reassigned to the drone group or the target is removed from the group to realize the online replanning of the number of drones; at the guidance layer control, the distance information between the drone and the center of the target group and the state information of the drone are used to design the corresponding single-machine encirclement tracking control and cooperative encirclement control algorithms to realize the cooperative positioning of the target; at the bottom control, a mature PID control algorithm is used to realize the stable control of the drone attitude. On the other hand, this application only requires ranging sensor information, can realize the online planning and control of drone groups, has the advantages of low cost, simple structure, strong robustness, easy online implementation, etc., can realize the cooperative tracking of drone groups to target groups in a GNSS area environment.
[0056] 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.
[0057] 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 method for cooperative tracking of a target group by a group of drones in a GNSS area denial environment, characterized in that: The method includes: Based on the relative positioning information of each target, the targets are clustered using an agglomerative hierarchical clustering algorithm to obtain a number of target groups; According to the number and importance of each target group, the number of drones and the distance information between the center of each target group and each drone, the drones are allocated to each target group to complete the initial allocation; reallocating the target group to each of the drones according to the convergence of the drone trajectories and the relative positioning information of the target, so as to perform online replanning of the drones; According to the result of the online replanning, the relative positioning information, the speed information of the UAV and the heading information of the UAV, a single-machine tracking control algorithm and a multi-machine collaborative tracking control algorithm are respectively constructed; A control instruction group is obtained by solving the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm, and the control instruction group is input into a controller group to control the UAV to track the target group; wherein the control instruction group includes an altitude control instruction, a roll angle control instruction and a speed control instruction, and the controller group includes an altitude controller, a roll angle controller and a speed controller.
2. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 1, characterized in that: Based on the relative positioning information of each target, the target is clustered by using an agglomerative hierarchical clustering algorithm to obtain a plurality of target groups, including: Initialize and classify the m targets into one class, calculate the distance between the center positions of every two classes, and take the minimum value; If the minimum value is less than the preset distance , then the two classes are merged into one target group. If the minimum value is greater than the preset distance , then keep the original grouping; Dynamically monitor the target group. If the distance between any target in the target group and the center of the target group is greater than the preset distance , then remove the target from the target group and divide it into a single class; Repeat the above steps until the target clustering is completed.
3. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 2, characterized in that: According to the number and importance of each target group, the number of drones and the distance information between the center of each target group and each drone, the drones are allocated to each target group to complete the initial allocation step, including: If the number of the drones is greater than the number of the target group, the multiple drones cooperate to track the same target group; If the number of the drones is less than the number of the target groups, the order to be tracked is sorted according to the preset importance of the target groups, and the unimportant target groups are abandoned; If the number of the drones is equal to the number of the target group, an intelligent optimization algorithm is used for initial allocation.
4. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 3, characterized in that: The step of reallocating the target group to each of the drones according to the convergence of the drone trajectory and the relative positioning information of the target to perform online replanning of the drones includes: If the trajectory of the drone has not converged, reassigning the target group to each drone or removing the target from the target group according to the relative positioning information; Repeat the above steps until the UAV trajectory converges to complete the line weight planning.
5. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 4, characterized in that: The step of reassigning the target group to each of the drones or removing the target from the target group according to the relative positioning information includes: regrouping the targets according to the relative positioning information; If target merging occurs, the UAV tracks the new target group; If the tracking radius required by the target group is larger than the detection range of the UAV, the target farthest from the center in the target group will be removed.
6. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 5, characterized in that: The steps of constructing a single-machine tracking control algorithm and a multi-machine collaborative tracking control algorithm respectively according to the result of the online replanning, the relative positioning information, the speed information of the UAV and the heading information of the UAV include: Constructing a relative motion equation of a system for cooperatively tracking the center of a target group by a group of drones according to the relative positioning information, the speed information and the heading information; Based on the distance information of the UAV relative to the target, a finite-time sliding mode estimator is constructed; According to the relative motion equation, the result of the online replanning and the finite time sliding mode estimator, the single machine tracking control algorithm and the multi-machine collaborative tracking control algorithm are constructed respectively.
7. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 6, characterized in that: The expression of the finite time sliding mode estimator is: in, For ranging signal The estimated value of is the ranging rate signal The estimated value of is the absolute value symbol, is a symbolic function, expressed as ,variable are the parameters to be designed.
8. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 7, characterized in that: The relative motion equation of the system where the drone group cooperates to track the center of the target group is expressed as: in, is the longitudinal component of the UAV velocity vector along the UAV-target line, is the speed of the drone, is the lateral angle, for The differential of For the i The angle between the drone-target line and the geographic east direction, For the i+ The angle between the drone-target line and the geographic east direction, is the angle between the first UAV-target line and the geographic east direction, is the angle between the N1th UAV-target line and the geographic east direction, is the number of drones, The first phase separation angle The differential of The second phase separation angle The differential of for The differential of for The differential of for The differential of for The differential of , and there is the following relationship ; The expression of the single-machine tracking control algorithm is: in, is the preset tracking radius, For damping, is the first control gain to be designed, is the ranging rate signal An estimated value of The expression estimated by the multi-machine cooperative tracking control algorithm is: in, is the second control gain to be designed, is the speed control command, is the desired speed command, Represents the phase separation angle The estimated value of Represents the phase separation angle The estimated value of .
9. The method for cooperatively tracking a target group by a group of drones in a GNSS area denial environment according to claim 8, characterized in that: The method further includes: The relative position of the target is estimated by using the phase separation angle estimation value, the relative positioning information, the speed information and the heading angle information to determine the state of the target; wherein, The phase separation angle estimate is obtained according to the estimation algorithm: in, is the derivative of the drone position vector with respect to time, and , for The transpose of is the position vector of the drone relative to the target The estimated value of for Regarding the time derivative, is the control gain to be designed, and Estimate the relative position The easting and northing components of .
10. The method for cooperative tracking of a target group by a group of drones in a GNSS area denial environment according to claim 9, characterized in that: The step of obtaining a control instruction group by using the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm, and inputting the control instruction group into a controller group to control the UAV to track the target group includes: The relative positioning information, the speed information and the heading information are solved by using the single-machine tracking control algorithm and the multi-machine collaborative tracking control algorithm to obtain the altitude control instruction, the roll angle control instruction and the speed control instruction; The altitude control instruction, the roll angle control instruction and the speed control instruction are respectively input into the altitude controller, the roll angle controller and the speed controller to control the UAV to track the target group, thereby achieving response to the guidance instruction and maintaining the aircraft attitude.
