Cooperative positioning state optimization decision-making method and device for moving target

By building a kinematic model and multi-objective optimization model of multi-drone, the problem of high-precision tracking of dynamic targets in collaborative positioning of multiple drones is solved, continuous high-precision tracking and positioning of dynamic targets is achieved, and the drone is optimized positioning state and energy consumption.

CN119087814AActive Publication Date: 2024-12-06NORTHWESTERN POLYTECHNICAL UNIV

Patent Information

Application Number
CN202411230345.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-12-06
Estimated Expiration
2044-09-04

AI Technical Summary

Technical Problem

In dynamic target aerial reconnaissance and positioning tasks, it is difficult to achieve continuous high-precision tracking and positioning in collaborative positioning of multiple drones, which is greatly affected by the target's maneuverability and diversity of motion forms, and it is difficult for the existing technology to effectively optimize the positioning status of drones. .

Method used

By building a kinematic model of multi-UAV and determining the solution space based on constraints, a multi-objective optimization model is established, including objective functions such as positioning error, flight energy consumption, safe distance and communication distance, and using optimization algorithms to solve them to obtain optimal positioning state.

Benefits of technology

Continuous high-precision tracking and positioning of dynamic targets is achieved, and factors such as positioning accuracy, energy consumption and safe distance are comprehensively considered, and the coordinated motion characteristics are improved, which are suitable for a variety of scenarios.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119087814A_ABST
    Figure CN119087814A_ABST
Patent Text Reader

Abstract

The invention discloses a moving target-oriented collaborative positioning state optimization decision method and device, and relates to the technical field of multi-unmanned aerial vehicle collaborative positioning planning decision application, and the method constructs multiple solution spaces according to unmanned aerial vehicle kinematics equations and multi-constraint conditions, accords with an actual positioning scene, has good actual application value, and can be applied to the field of multi-unmanned aerial vehicle collaborative positioning planning decision application. The expandability of the method for constructing the solution space is high, and the method can be matched with various scenes by setting different constraints; the established optimization model comprehensively considers optimization targets such as positioning precision, energy consumption, safety distance in the formation and communication distance, and can obtain a more reasonable optimization result conforming to collaborative motion characteristics. According to the invention, the optimization decision can be made according to the motion trail of the moving target, the optimal positioning state of multiple unmanned aerial vehicles in an actual cooperative positioning scene is obtained, and the continuous high-precision tracking and positioning of the moving target are realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of multi-UAV collaborative positioning planning and decision-making applications, and in particular to a collaborative positioning state optimization decision-making method and device for moving targets. Background Art

[0002] The infrared photoelectric detection system is an important target search and detection equipment. Compared with the radar system, it has unique advantages such as high angle measurement accuracy, passive stealth in working state, low power consumption, small size and light weight. However, the infrared photoelectric detection system can only obtain the azimuth information of the target, and it needs to be measured multiple times to locate the target. The multi-infrared sensor platform can collaboratively complete the task of target positioning through information sharing, and realize the accurate measurement of real-time angle and distance information. Through collaboration, the relative position relationship between the multi-infrared sensor platform and the target can be established. In addition, in the informationized, intelligent and unmanned battlefield environment, by carrying the infrared photoelectric detection system on the drone, the needs of unmanned reconnaissance and positioning can be met, which has extremely high military significance and engineering value.

[0003] When conducting aerial reconnaissance and positioning missions against dynamic targets, a group of drones can be used to form an anti-stealth detection network to collaboratively locate the target and transmit the located target status information to the lead aircraft in the rear. However, since the located targets have strong maneuverability and diverse movement forms, and the relative position relationship between multiple drones and targets will have a significant impact on the collaborative positioning performance, it is necessary to design a reasonable decision-making method to enable drones to have the ability to continuously locate moving targets. Summary of the invention

[0004] The purpose of the present invention is to provide a method and device for optimizing the collaborative positioning state of a moving target, which can make an optimization decision based on the motion trajectory of the moving target, obtain the optimal positioning state of multiple UAVs that meet the actual collaborative positioning scenario, and realize continuous high-precision tracking and positioning of the moving target.

[0005] To achieve the above object, the present invention provides the following solutions:

[0006] In a first aspect, the present invention provides a collaborative positioning state optimization decision method for a moving target, comprising:

[0007] For each drone in a multi-drone formation, a kinematic model is constructed, and a solution space is determined based on constraint conditions, wherein the constraint conditions include: a speed constraint of the drone, an acceleration constraint of the drone, a safety distance constraint between the drone and a moving target, an acceleration change constraint of the drone, and an angle change constraint of the drone; the solution space is a set of multiple discrete position points, each of which includes the motion state information of the drone corresponding to the current moment, and the motion state information includes the position, speed, and acceleration of the drone;

[0008] Establishing an optimization decision model, wherein the optimization decision model includes a first objective function for calculating a moving target positioning error, a second objective function for calculating the flight energy consumption of the UAV, a third objective function for calculating the size relationship between the distance between the UAVs and a safety distance threshold, and a fourth objective function for calculating the size relationship between the communication distance between the UAVs and the communication distance threshold;

[0009] The solution space is substituted into the optimization decision model, and the optimization algorithm is used to solve it. When the result obtained by weighted summation of the first function value, the second function value, the third function value and the fourth function value is the largest, the optimal positioning state is obtained, wherein the first function value is the value solved by the first objective function, the second function value is the value solved by the second objective function, the third function value is the value solved by the third objective function, and the fourth function value is the value solved by the fourth objective function. The optimal positioning state includes the optimal positioning position point corresponding to each of the UAVs and the overall formation of the formation.

[0010] In a second aspect, the present invention provides a computer device comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the computer program to implement a collaborative positioning state optimization decision method for moving targets as described in the first aspect.

[0011] In a third aspect, the present invention provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the method for optimizing decision-making in collaborative positioning states for moving targets as described in the first aspect.

[0012] In a fourth aspect, the present invention provides a computer program product, comprising a computer program, which, when executed by a processor, implements the method for optimizing decision-making in collaborative positioning state for moving targets described in the first aspect.

[0013] According to the specific embodiments provided by the present invention, the present invention discloses the following technical effects:

[0014] The present invention provides a collaborative positioning state optimization decision method and device for moving targets. The method constructs multiple solution spaces based on the kinematic equations of unmanned aerial vehicles and multiple constraints, which conform to the actual positioning scenario and have good practical application value. The method for constructing the solution space has strong scalability and can fit a variety of scenarios by setting different constraints. A multi-objective optimization model is established, which comprehensively considers optimization goals such as positioning accuracy, energy consumption, safety distance within the formation, and communication distance, so as to obtain a more reasonable optimization result that conforms to the characteristics of collaborative motion. The present invention models the problem of solving the optimal positioning state of collaborative positioning as an optimization search problem within multiple finite sets, and comprehensively considers multiple constraints and multiple optimization goals to obtain the optimal positioning state that meets the actual collaborative positioning scenario. The optimization decision is made according to the target motion position, so as to achieve continuous high-precision tracking and positioning of moving targets. BRIEF DESCRIPTION OF THE DRAWINGS

[0015] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0016] Figure 1 A schematic flow chart of a collaborative positioning state optimization decision method for a moving target provided in Example 1 of the present invention;

[0017] Figure 2 A detailed flow chart of a collaborative positioning state optimization decision method for a moving target provided in Example 1 of the present invention;

[0018] Figure 3 Schematic diagram of the initial solution space in Example 1 of the present invention;

[0019] Figure 4 This is a schematic diagram of the safety distance constraint in Example 1 of the present invention;

[0020] Figure 5 Schematic diagram of the heading angle in Embodiment 1 of the present invention;

[0021] Figure 6 Schematic diagram of the climbing angle in Embodiment 1 of the present invention;

[0022] Figure 7 Schematic diagram of the multi-machine AOA positioning principle in Embodiment 1 of the present invention;

[0023] Figure 8 Schematic diagram of the motion trajectory of a moving target in Example 1 of the present invention;

[0024] Fig. 9Schematic diagram of the speed change of a moving target in Example 1 of the present invention;

[0025] Fig.10 This is a schematic diagram of simulation results of scenario 1 in embodiment 1 of the present invention;

[0026] Fig.11 This is a schematic diagram of relative positioning error of scene 1 in embodiment 1 of the present invention;

[0027] Fig.12 This is a schematic diagram of the simulation results of scenario 2 in embodiment 1 of the present invention, wherein: Fig.12 (a) is the standard view of the simulation results of scenario 2. Fig.12 (b) is a top view of the simulation results of scenario 2;

[0028] Fig.13 This is a schematic diagram of relative positioning error in scene 2 in embodiment 1 of the present invention;

[0029] Fig.14 This is a schematic diagram of the simulation results of scenario 3 in embodiment 1 of the present invention, wherein: Fig.14 (a) is the standard view of the simulation results of scenario 3. Fig.14 (b) is a top view of the simulation results of scenario 3;

[0030] Fig.15 This is a schematic diagram of relative positioning error in scene 3 in embodiment 1 of the present invention;

[0031] Fig.16 This is a diagram of the internal structure of a computer device. DETAILED DESCRIPTION

[0032] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0033] The purpose of the present invention is to provide a method and device for optimizing the collaborative positioning state of a moving target, aiming to make an optimization decision based on the motion trajectory of the moving target, obtain the optimal positioning state of multiple UAVs that meet the actual collaborative positioning scenario, and realize continuous high-precision tracking and positioning of the moving target.

[0034] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the present invention is further described in detail below with reference to the accompanying drawings and specific embodiments.

[0035] Example 1

[0036] This embodiment mainly solves two technical problems: modeling the problem of solving the optimal positioning state of collaborative positioning as an optimization search problem in multiple finite sets, and designing an optimization decision method for the collaborative positioning state. Figure 1 As shown, a collaborative positioning state optimization decision method for a moving target in this embodiment includes:

[0037] S1: For each UAV in a multi-UAV formation, a kinematic model is constructed, and a solution space is determined based on constraint conditions, wherein the constraint conditions include: a speed constraint of the UAV, an acceleration constraint of the UAV, a safety distance constraint between the UAV and a moving target, an acceleration change constraint of the UAV, and an angle change constraint of the UAV; the solution space is a set of multiple discrete position points, each of which includes the motion state information of the UAV corresponding to the current moment, and the motion state information includes the position, speed, and acceleration of the UAV.

[0038] S1 specifically includes:

[0039] S11: For each of the UAVs, a kinematic model is constructed, and based on a limited maneuverability constraint, a reachable area of ​​each of the UAVs is determined, wherein the limited maneuverability constraint includes a speed constraint of the UAV and an acceleration constraint of the UAV.

[0040] S12: Determine an initial solution space according to possible positions of all the UAVs in the reachable area.

[0041] S13: Based on specific constraints, the position points in the initial solution space that do not meet the specific constraints are eliminated to obtain an optimal search solution space, wherein the specific constraints include a safety distance constraint between the UAV and a moving target, an acceleration change constraint of the UAV, and an angle change constraint of the UAV.

[0042] S14: taking the optimal search solution space as the final solution space.

[0043] S2: Establish an optimization decision model, wherein the optimization decision model includes a first objective function for calculating the moving target positioning error, a second objective function for calculating the flight energy consumption of the UAV, a third objective function for calculating the relationship between the distance between the UAVs and the safety distance threshold, and a fourth objective function for calculating the relationship between the communication distance between the UAVs and the communication distance threshold.

[0044] S3: Substitute the solution space into the optimization decision model, and use the optimization algorithm to solve it, and when the result obtained by weighted summation between the first function value, the second function value, the third function value and the fourth function value is the largest, the optimal positioning state is obtained, wherein the first function value is the value solved by the first objective function, the second function value is the value solved by the second objective function, the third function value is the value solved by the third objective function, and the fourth function value is the value solved by the fourth objective function, and the optimal positioning state includes the optimal positioning position point corresponding to each of the UAVs and the overall formation of the formation.

[0045] This embodiment models the problem of solving the optimal positioning state of collaborative positioning as an optimization search problem within multiple finite sets, and comprehensively considers multiple constraints and multiple optimization goals to obtain the optimal positioning state that meets the actual collaborative positioning scenario, thereby achieving continuous high-precision tracking and positioning of moving targets.

[0046] In order to make the specific execution process of S1-S3 more clear to those skilled in the art, Figure 2 Give a detailed explanation.

[0047] (1) Establish a UAV kinematic model and design the initial solution space based on the constraints of limited maneuverability.

[0048] High-precision positioning places requirements on the position relationship of the UAV. In actual scenarios, it is difficult to achieve the most ideal positioning state due to dynamic constraints. Therefore, the reachable area of ​​the UAV is first constructed, corresponding to the solution space of the optimization problem. Reasonable design of the solution space can effectively improve the optimization efficiency and ensure the accuracy of the optimization results.

[0049] In order to obtain the multi-machine solution space, first, the kinematic model of the UAV is constructed. This embodiment focuses on the optimal positioning position and formation relationship, so a 3-DOF particle motion model is used to establish the kinematic model of the UAV, without considering the influence of ambient wind and air density at different heights. In addition, the influence of the earth's rotation is not considered, and the gravitational acceleration is regarded as a constant value. Based on the above assumptions, the three-dimensional center of mass kinematic equation is established according to the ground inertial coordinate system:

[0050]

[0051] Among them, (x, y, z) is the position coordinate of the UAV; v is the speed; ψ is the track deviation angle, that is, the heading angle, which represents the angle between the projection of the speed direction on the horizontal plane and the x-axis direction; is the derivative of (x,y,z), are the speeds in the x, y, and z directions respectively; η is the track inclination, i.e. the climb angle, which represents the angle between the speed direction and the horizontal plane. Integrating both sides of equation (1) and discretizing based on time, we can get:

[0052]

[0053]

[0054] Among them, t 1 The position coordinates of the drone at the moment are t 2 The position coordinates of the drone at the moment are v n t 1 The speed of the moment; t 1 and t 2 Climb angle at the moment; t 1 and t 2 The heading angle at the moment; v max and a max are the maximum speed and maximum acceleration respectively; is the derivative of v, i.e. acceleration; Δη max and Δψ max They are Δt=t 2 -t 1 Maximum change in inside climb angle and heading angle.

[0055] In summary, the solution space is constructed according to the kinematic equation of formula (1). Figure 3 As shown in the figure, taking the three-drone scenario as an example, the quadrilateral envelope is the reachable area of ​​the two drones under the limited maneuverability constraints (i.e., speed and acceleration constraints), that is, the area that can be reached by using different accelerations under speed constraints after Δt, (V i ,a i ) represents the speed and acceleration of the drone at the current position, as shown in the following formula. The range of the reachable area is related to the maximum value of the aircraft acceleration, speed and time.

[0056] S i =f(a max ,V max ,Δt) (4);

[0057] Among them, S i Respectively represent the reachable area of ​​the i-th UAV; a max ,V max are the maximum acceleration and speed of the ith UAV, respectively. In the decision problem proposed in this embodiment, the multi-machine reachable domain corresponds to the multiple solution space of the optimization problem. Therefore, after determining the initial t 1 After knowing the UAV motion state (position, velocity and acceleration) at each moment, an irregular initial solution space consisting of multiple discrete position points can be constructed.

[0058] (2) Reconstruct the solution space based on multiple constraints (i.e., the specific constraints mentioned above) to obtain a more reasonable optimal search solution space.

[0059] The initial solution space is obtained by calculating the flight reachable domain. The initial solution space is established based on speed and acceleration constraints. However, in actual scenarios, there are three more constraints: safety distance constraint from moving targets, acceleration change constraint, and angle change constraint (including climb angle and heading angle change constraint). Before the optimization problem is designed, directly using the initial solution space cannot meet specific constraints. Therefore, it is very important to reconstruct the initial solution space. By eliminating solutions that do not meet the constraints, the scale of the solution space can be effectively compressed, the efficiency of the optimization algorithm can be improved, and it is more in line with the research scenario and research problem.

[0060] 1) Safe distance from moving targets.

[0061] During the positioning process, if the distance to the positioning target is too close, there will be a security risk of being detected and attacked. Therefore, it is necessary to screen the positions of drones that do not meet the safety distance to improve the safety of collaborative flight. Figure 4 As shown, with the moving target as the center of the sphere, the safety distance d safe Create a sphere for the radius and remove the points inside the sphere.

[0062] Construct a constraint expression and use Euclidean distance to describe the position relationship between the drone and the positioning target:

[0063]

[0064] in, t 1 The position of the i-th drone at the moment, (i=1,2,....N); t 1 Keep track of the target's location.

[0065] 2) Acceleration change constraint.

[0066] Usually when considering dynamic constraints, only the boundary constraints of velocity and acceleration are considered, and the change of acceleration, that is, the effect of Jerk, is often ignored. Jerk represents the rate of change of acceleration. A smaller Jerk means that the acceleration changes more smoothly, which helps to avoid sudden changes or discontinuities in motion and also provides a more reasonable initial trajectory point for subsequent planning. When constructing the solution space, each potential solution position has time and acceleration information, and the following constraint expression can be established:

[0067]

[0068] in, The i-th UAV is at t 2 and t 1 The acceleration at two moments; Je max is the maximum rate of change of acceleration.

[0069] 3) Angle variation constraint.

[0070] Although the kinematic model does not consider the UAV's own posture, it still needs to consider the change constraints of the heading angle and the climb angle. Among them, the heading angle is the track deviation angle, which is the angle between the projection of the velocity direction on the horizontal plane xOy and the Ox axis. UAVs usually change their heading by adjusting the rudder and aileron control angles. Due to inertia and maneuverability limitations, it is impossible to achieve a large heading angle change within a certain period of time. Therefore, it is necessary to construct a heading angle change constraint. The heading angle model is as follows: Figure 5 As shown, the constraints can be expressed as:

[0071]

[0072] in, are the velocities at different times, Δψ max is the maximum heading angle change.

[0073] In addition to the heading angle, the climb angle also needs to be considered. The climb angle is the track inclination, which is the angle between the velocity direction and the horizontal plane xOy. The climb of the UAV is limited by engine performance, airfoil, weather and other conditions. The climb angle cannot change too much, otherwise the climb rate will be lost and the UAV will stall. Figure 6 As shown, the constraints can be expressed as:

[0074]

[0075] By using angle constraints, we can obtain a solution space that is more in line with the UAV's motion characteristics and avoid drastic changes in heading angle and climb angle. By constructing the above three constraints, we can achieve the reconstruction and optimization process of the solution space, filter out the multi-machine position points that do not meet the constraints, improve the optimization efficiency, and better fit the collaborative positioning scenario.

[0076] (3) Establish an optimization decision-making model.

[0077] The expression of the optimization decision model is:

[0078] J fit =[J CR ,J d ,J s ,J con ]·λ(9);

[0079] Among them, J fit is the value of the optimization decision model; JCR is the first function value, which is used to describe the positioning accuracy of the moving target; J d is the second function value, which is used to describe the energy consumption of the UAV; J s is the third function value, which is used to determine whether the distance between the UAVs meets the formation internal safety distance threshold; J con is the fourth function value, which is used to describe whether the communication distance between drones meets the communication distance threshold; λ is the weight coefficient, λ=[λ CR ,λ d ,λ s ,λ con ] T ,λ CR is the weight coefficient of the first function value; d is the weight coefficient of the second function value; s is the weight coefficient of the third function value; con is the weight coefficient of the fourth function value.

[0080] In addition, the fitness function value in the optimization process is also calculated according to the above formula.

[0081] 1) Positioning accuracy calculation index J CR (Also the first function value).

[0082] In this embodiment, an infrared photoelectric detection system is used as a positioning device for collaborative positioning. The system can detect and position a single positioning target at any angle. The infrared photoelectric detection system can only obtain the angle information of the target. First, the angle relationship between the target and the UAV is obtained through multiple infrared sensor platforms, and then the target position is calculated based on the relative position relationship between the UAVs, which constitutes the collaborative positioning problem of the angle of arrival (AOA).

[0083] like Figure 7 As shown in Figure 1, in a three-dimensional scene, the basic principle of the AOA positioning method is to estimate the position of the target by combining the azimuths measured by multiple drones. Assuming that there are N drones involved in positioning, the horizontal and vertical azimuths of the target measured by the N drones relative to the drones are θ i and φ i From a geometric point of view, starting from each drone, the N rays formed by the estimated angle will intersect at one point in space, which is the position of the target. The position coordinates of the N drones in three-dimensional space are u i =[x i ,y i ,z i ] T ,i=1,2,...,N, the coordinates of the target are T=[x T ,yT ,z T ] T According to the geometric relationship, the horizontal azimuth and vertical azimuth measured by each UAV are:

[0084]

[0085] Consider the measurement noise in the measurement process, that is:

[0086]

[0087] in, Indicates the horizontal azimuth measurement value; θ i,r represents the true value of the horizontal azimuth, Indicates the vertical azimuth measurement value; φ i,r Indicates the true value of the vertical azimuth, n i and w i Represents the angle measurement error. According to existing research, the angle measurement error mostly obeys Gaussian distribution.

[0088] In order to measure the positioning accuracy of the current positioning state when using AOA positioning, the Cramer-Rao Lower Bound (CRLB) is introduced as an indicator to measure the positioning accuracy of the current situation. The Cramer-Rao bound (CRB) determines a lower limit for the variance of any unbiased estimator. The variance of the unbiased estimator can only approach the CRB without restriction and will not be lower than the CRB. Therefore, this bound can also be called CRLB, that is, the Cramer-Rao lower bound. CRLB can be used to calculate the best estimation accuracy that can be obtained in unbiased estimation, so it is often used to calculate the best estimation accuracy that can be achieved in theory and to evaluate the performance of parameter estimation methods. The covariance matrix expression based on CRLB is as follows:

[0089]

[0090] Wherein, t represents the vector to be estimated, that is, the target position information in three-dimensional space; is the estimated value of t; P represents the covariance matrix of the estimation error; C is CRLB. F is the Fisher Information Matrix (FIM), which is used to measure the amount of information a random variable contains about the unknown parameters of its own random distribution function.

[0091] Next, based on the AOA positioning principle and the Cramer-Rao lower bound, the detailed expression of positioning accuracy is derived and the optimal positioning state is analyzed.

[0092] The target information observed by the UAV is determined by formula (10). The Jacobian matrix of the observation function corresponding to the i-th UAV can be expressed as:

[0093]

[0094] in, is the relative position vector of the ith UAV and the moving target, and the observation error matrix of the ith UAV is:

[0095]

[0096] Assume that the motion state equation and observation equation of the moving target are as follows:

[0097]

[0098] Where F is the state transfer matrix; h is the observation matrix. Based on this, the FIM of the positioning observation system can be expressed as:

[0099]

[0100] Among them, Φ k,k-1 Represents the Jacobian matrix of the target state transfer function, and k represents the kth moment.

[0101] In the study of the optimal positioning state of multiple drones, only the current position of the target is considered. Assuming that the current position of the target is fixed, when N drones observe a single target, the FIM can be expressed as:

[0102]

[0103] Among them, i represents the i-th drone, H i Represents the Jacobian matrix of the observation function of the i-th UAV.

[0104] Substituting equation (10) and equation (13) into the above equation, FIM can be expressed as:

[0105]

[0106]

[0107] according to Figure 7 The geometric relationship between the horizontal azimuth and the vertical azimuth is as follows:

[0108]

[0109] to FIM and angle-dependent representations:

[0110]

[0111]

[0112] Given the known position relationship between the drone and the target i and Di , and the measured standard deviation of the azimuth angle σ θ and σ φ After that, the value of FIM is only related to the horizontal and vertical azimuth angles. Therefore, it is necessary to find a suitable azimuth angle to maximize FIM and obtain the highest positioning accuracy. However, for F N There is more than one criterion for maximizing the value of the matrix, so a real-valued scalar function needs to be found as the objective function. The Class A optimal standard is the most commonly used standard in three-dimensional AOA positioning scenarios. Its physical meaning is to minimize the variance of the average estimate, which is defined as minimizing the trace of CRLB. Therefore, this embodiment uses the Class A optimal standard to measure positioning accuracy. In the collaborative positioning scenario corresponding to this embodiment, the positioning error is expressed based on the Class A optimal standard to measure positioning accuracy:

[0113]

[0114] Among them, J CR is the absolute positioning error, i.e., the first function value, indicating the size of the current positioning error, in m. The smaller the positioning error, the higher the accuracy. In addition, it can be seen from equations (22) and (23) that the factors affecting the positioning accuracy are mainly the distance between the UAV and the target and the azimuth formed with the target, and the azimuth can be reflected in the formation relationship. Therefore, higher positioning accuracy can be obtained by adjusting the distance between the UAV and the target and the multi-machine formation.

[0115] (2) Flight energy consumption.

[0116] In the process of making the optimal positioning state decision, not only the positioning accuracy but also the energy consumption of the UAV flight should be considered. When making the optimal decision, the solution space at each moment can be obtained, corresponding to multiple feasible positions of the UAV. Therefore, based on the position information, the Euclidean distance between two adjacent moments of the UAV is used as the measure of flight energy consumption. The expression of the second objective function is:

[0117]

[0118] in, is the number of drones at t 2 The coordinates of the moment, is the number of drones at t 1 The coordinates at the moment, N is the number of drones.

[0119] (3) Safety distance within the formation.

[0120] In the process of coordinated flight, it is necessary to consider the safety distance within the formation, on the one hand to avoid collisions, and on the other hand to provide more reasonable input for the subsequent planning process. The objective function of the formation safety distance (i.e., the third objective function) is constructed as follows:

[0121]

[0122] Among them, ΔP t,i =X t,i+1 -X t,i represents the relative position vector between the UAVs at time t, L safe is the formation safety distance threshold, and formula (26) determines whether the current formation meets the safety distance constraint, and calculates J according to the value exceeding the safety distance. s .

[0123] (4) Communication distance.

[0124] In the process of cooperative flight, it is necessary to consider the effective communication distance between drones, so a cost function describing the communication distance (i.e., the fourth objective function) is established:

[0125]

[0126] Among them, ΔP t,i =X t,i+1 -X t,i , is the relative position vector between the UAVs at time t, L con is the maximum communication distance. Formula (27) determines whether the current distance between UAVs meets the communication distance requirement, and calculates J according to the value exceeding the communication distance. con .

[0127] (4) The particle swarm algorithm is used to solve the optimization decision problem of finite discrete sets.

[0128] The particle swarm algorithm simulates group behavior, where individuals represent points in a D-dimensional search space. A particle represents a potential solution. The basic process of the particle swarm algorithm is as follows:

[0129] The initial setting is that N particles search in the D-dimensional space, and the initial values ​​of the position vector and velocity vector are randomly generated. The position of the nth particle (1≤n≤N) represents a potential solution to the problem, so each particle can be represented as a D-dimensional vector:

[0130]

[0131] In addition to position information, each particle also has velocity information v n , based on the speed information, the position is continuously updated to achieve the optimization process:

[0132]

[0133] The optimal position currently searched by the nth particle is called the individual optimal position:

[0134]

[0135] The optimal position currently searched by the entire group is the global optimal position, which is expressed as:

[0136]

[0137] The position coordinates of the particle represent the current solution of the algorithm, and the particle position is updated through the velocity vector. The velocity vector of the particle determines the direction of the particle, that is, the optimal search direction. The position and velocity update strategy of the traditional particle swarm algorithm is:

[0138]

[0139] Among them, ω is the inertia weight factor, which indicates the influence of the particle's previous generation velocity vector on the current velocity vector, r 1 ,r 2 is a random number between (0,1), c 1 ,c 2 are learning factors, which represent the influence of the historical individual optimal position and global optimal position of the particle on the particle position update.

[0140] In order to use the PSO algorithm to solve the decision model, it is necessary to combine the position information of multiple drones at different times with the encoding of each particle in the algorithm. Each drone has a corresponding reachable area at the current moment, that is, a solution space composed of discrete three-dimensional coordinate information. After the solution space is reconstructed, the position information in the solution space is not continuous, so based on the encoding method of the discrete particle swarm algorithm, on the basis of the known solution space and target information, the position coordinates in the solution space are arranged from near to far according to the distance to the target, and the serial number corresponding to the coordinate value is used as the particle encoding. The dimension of the particle corresponds to the number of drones, and the particle information of the particle swarm can be expressed as:

[0141]

[0142] Among them, P all represents all particle information, N is the total number of particles in the population, P i is the information of the ith particle, X d is the position information of the dth drone, D is the number of drones, and also corresponds to the dimension information of each particle.

[0143] This embodiment proposes a collaborative positioning state optimization decision method for moving targets, which models the problem of solving the optimal positioning state of collaborative positioning as an optimization search problem in multiple finite sets, and comprehensively considers multiple constraints and multiple optimization goals to obtain the optimal positioning state that meets the actual collaborative positioning scenario:

[0144] (1) Based on the kinematic equations of the UAV and multiple constraints, multiple solution spaces are constructed, which conform to the actual positioning scenarios and have good practical application value. In addition, the method of constructing the solution space has strong scalability and can fit a variety of scenarios by setting different constraints.

[0145] (2) A multi-objective optimization model was established, which comprehensively considered optimization objectives such as positioning accuracy, energy consumption, and safe distance within the formation, and thus a more reasonable optimization result that conforms to the characteristics of collaborative motion can be obtained.

[0146] (3) By making optimal decisions based on the target's moving position, the continuous tracking and positioning process of the moving target can be achieved.

[0147] In order to verify the effectiveness of the collaborative positioning decision method for moving targets constructed in this embodiment, multiple sets of scenarios are designed for simulation experiments. First, it is necessary to construct a mobile target, such as Figure 8 As shown in the figure, the target takes off from the horizontal plane, reaches an altitude of 3000m, and then flies horizontally and climbs. In order to better reflect the maneuvering characteristics of the target, only the climbing part is selected as the target motion trajectory in the simulation experiment. Fig. 9 As shown, the target speed is 400m / s. Set the maximum speed of the drone V max =300m / s, maximum acceleration a max =15m / s 2 , the safe distance from the positioning target is set to 500m, and the communication distance is set to 10km. Let the angle measurement error of the infrared sensor obey the mean value of 0 and the standard deviation σ θ =σ φ =0.1° Gaussian distribution, and can achieve detection and positioning of any angle direction for a single positioning target. In addition, in order to measure the positioning performance of the multi-machine system at different times, the relative positioning error is defined as:

[0148]

[0149] Where J is the Cramer-Rao lower bound of the positioning error, in m, and J r is the relative positioning error. The smaller the relative positioning error is, the higher the positioning accuracy is. L is the distance between the center of the formation composed of multiple machines and the target.

[0150] (1) Scenario 1

[0151] In the three-machine positioning scenario, a target motion trajectory with a time length of 20 seconds is selected, and the optimal position decision is made every 2 seconds. The simulation parameters are shown in Table 1.

[0152] Table 1 Initial conditions of drone in scenario 1

[0153] Drones Initial position (m) Initial speed (m / s) Initial velocity direction 1 (21000,3200,3000) 250 Point to the target 2 (20500,3000,3200) 250 Point to the target 3 (20000,2800,3000) 250 Point to the target

[0154] The initial formation of the three drones is a regular triangle. The simulation results are as follows: Fig.10 and Fig.11 As shown in the figure, the positions of multiple drones at 10 moments are given, and the formation relationship at different moments and the movement trend of multiple drones are shown. From the simulation results, it can be seen that the proposed decision-making method can also stably converge to the optimal positioning state of the current solution space in the three-drone positioning scenario, thereby maintaining the positioning accuracy during the flight. The relative positioning error shows a trend of first decreasing and then increasing. This is because the target was still in the level flight stage before 10 seconds. The four drones effectively improved the positioning accuracy by adjusting the distance and formation relationship between them and the target; but after 10 seconds, the target began to climb and maneuver. Since the target flew at a speed exceeding the movement capacity of the drone, it was difficult for multiple drones to quickly adjust the flight state within a limited time, so the positioning error increased. In addition, in AOA positioning, the positioning accuracy is closely related to the horizontal azimuth, vertical azimuth, and the distance between the drone and the target, and the angle relationship is reflected in the multi-drone formation. Therefore, based on the simulation results of scenario 1, it is necessary to further verify the adjustment ability of the proposed decision-making method for the formation and distance.

[0155] (2) Scenario 2

[0156] In order to verify whether the decision method is based on the positioning principle and has the ability to adjust the distance between the UAV and the target, a three-drone positioning scenario is set. The initial velocity directions of the three UAVs point to the X-axis direction, and the initial conditions of the UAVs are shown in Table 2:

[0157] Table 2 Initial conditions of drone in scenario 2

[0158] Drones Initial position (m) Initial speed (m / s) Initial velocity direction 1 (21000,3200,3000) 250 X-axis direction 2 (20500,3000,3200) 250 X-axis direction 3 (20000,2800,3000) 250 X-axis direction

[0159] The simulation results are as follows Fig.12 and Fig.13 As shown in the figure, the decision method makes a significant adjustment to the speed direction of the three drones, allowing them to eventually fly towards the target, thereby reducing the distance between the drone and the target and effectively improving the positioning accuracy. Therefore, it can be verified that the decision method can effectively adjust the distance between the target and the drone, and as the distance to the target decreases, the positioning accuracy gradually improves, which is in line with the AOA positioning principle.

[0160] (3) Scenario 3

[0161] According to the simulation analysis in scenario 2, the proposed decision method has good adjustment capabilities for the speed direction of the drone and the distance between the drone and the target. On this basis, it is also necessary to verify the adjustment effect of the decision method on the formation. Therefore, in scenario 3, the initial positions of the three drones and the target distance are set to be small to highlight the adjustment capability of the formation. The initial conditions of the drones are set as shown in Table 3:

[0162] Table 3 Initial conditions of drone in scenario 3

[0163] Drones Initial position (m) Initial speed (m / s) Initial velocity direction 1 (20000,500,2500) 250 X-axis direction 2 (20000,0,4000) 250 X-axis direction 3 (20000,-500,2500) 250 X-axis direction

[0164] The simulation results are as follows Fig.14 and Fig.15 As shown in the figure, the relative positioning error of the whole process is kept below 0.3%. The positioning error shows a trend of first rising and then falling. This is because the maneuverability of the target is stronger than that of the UAV. In the early stage of decision-making, the distance between the UAV and the target gradually increases, and the formation adjustment is not completed, so the positioning accuracy decreases first. After 12 seconds, the positioning formation adjustment is completed, the positioning error gradually decreases, and the positioning accuracy is improved. In addition, due to the constraints of the safety distance, the decision-making method can only improve the positioning accuracy by adjusting the formation. Therefore, this simulation experiment can verify that the proposed decision-making method has the ability to adjust the formation to improve the positioning accuracy.

[0165] Based on the experimental simulation results of the above three scenarios, it can be verified that the decision-making method constructed in this embodiment can obtain the optimal positioning position and formation relationship of multiple aircraft for target maneuvers, thereby realizing a continuous tracking and positioning process.

[0166] Example 2

[0167] A computer device includes: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the computer program to implement a collaborative positioning state optimization decision method for a moving target in Example 1.

[0168] Example 3

[0169] A computer-readable storage medium stores a computer program, which, when executed by a processor, implements a collaborative positioning state optimization decision method for a moving target in Example 1.

[0170] Example 4

[0171] A computer program product includes a computer program, which, when executed by a processor, implements a collaborative positioning state optimization decision method for a moving target in Example 1.

[0172] Example 5

[0173] A computer device, which may be a database, may have an internal structure as shown in Fig.16As shown. The computer device includes a processor, a memory, an input / output interface (Input / Output, referred to as I / O) and a communication interface. Among them, the processor, the memory and the input / output interface are connected through a system bus, and the communication interface is connected to the system bus through the input / output interface. Among them, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system, a computer program and a database. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The database of the computer device is used to store pending transactions. The input / output interface of the computer device is used to exchange information between the processor and an external device. The communication interface of the computer device is used to communicate with an external terminal through a network connection. When the computer program is executed by the processor, a collaborative positioning state optimization decision method for a moving target in Example 1 is implemented.

[0174] It should be noted that the object information (including but not limited to object device information, object personal information, etc.) and data (including but not limited to data used for analysis, stored data, displayed data, etc.) involved in the present invention are all information and data authorized by the object or fully authorized by all parties, and the collection, use and processing of relevant data need to comply with relevant laws, regulations and standards of relevant countries and regions.

[0175] Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be completed by guiding the relevant hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to the memory, database or other medium used in the embodiments provided by the present invention can include at least one of non-volatile and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive random access memory (ReRAM), magnetoresistive random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory can include random access memory (RAM) or external cache memory, etc. As an illustration and not limitation, RAM can be in various forms, such as static random access memory (SRAM) or dynamic random access memory (DRAM). The database involved in each embodiment provided by the present invention may include at least one of a relational database and a non-relational database. Non-relational databases may include distributed databases based on blockchains, etc., but are not limited thereto. The processor involved in each embodiment provided by the present invention may be a general-purpose processor, a central processing unit, a graphics processor, a digital signal processor, a programmable logic device, a data processing logic device based on quantum computing, etc., but are not limited thereto.

[0176] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0177] The principles and implementation methods of the present invention are described in this article using specific examples. The description of the above embodiments is only used to help understand the method and core idea of ​​the present invention. At the same time, for those skilled in the art, according to the idea of ​​the present invention, there will be changes in the specific implementation methods and application scope. In summary, the content of this specification should not be understood as limiting the present invention.

Claims

1. A collaborative positioning state optimization decision method for moving targets, characterized in that: The method comprises: For each drone in a multi-drone formation, a kinematic model is constructed, and a solution space is determined based on constraint conditions, wherein the constraint conditions include: a speed constraint of the drone, an acceleration constraint of the drone, a safety distance constraint between the drone and a moving target, an acceleration change constraint of the drone, and an angle change constraint of the drone; the solution space is a set of multiple discrete position points, each of which includes the motion state information of the drone corresponding to the current moment, and the motion state information includes the position, speed, and acceleration of the drone; Establishing an optimization decision model, wherein the optimization decision model includes a first objective function for calculating a moving target positioning error, a second objective function for calculating the flight energy consumption of the UAV, a third objective function for calculating the size relationship between the distance between the UAVs and a safety distance threshold, and a fourth objective function for calculating the size relationship between the communication distance between the UAVs and the communication distance threshold; The solution space is substituted into the optimization decision model, and the optimization algorithm is used to solve it. When the result obtained by weighted summation of the first function value, the second function value, the third function value and the fourth function value is the largest, the optimal positioning state is obtained, wherein the first function value is the value solved by the first objective function, the second function value is the value solved by the second objective function, the third function value is the value solved by the third objective function, and the fourth function value is the value solved by the fourth objective function. The optimal positioning state includes the optimal positioning position point corresponding to each of the UAVs and the overall formation of the formation.

2. The method for optimizing the collaborative positioning state of a moving target according to claim 1, characterized in that: For each UAV in the multi-UAV formation, a kinematic model is constructed, and the solution space is determined based on the constraints, including: For each of the drones, a kinematic model is constructed, and based on a limited maneuverability constraint, a reachable area of ​​each of the drones is determined, wherein the limited maneuverability constraint includes a speed constraint of the drone and an acceleration constraint of the drone; Determine an initial solution space according to possible positions of all the drones in the reachable area; Based on specific constraints, the position points in the initial solution space that do not meet the specific constraints are eliminated to obtain an optimal search solution space, wherein the specific constraints include a safety distance constraint between the UAV and a moving target, an acceleration change constraint of the UAV, and an angle change constraint of the UAV; The optimal search solution space is used as the final solution space.

3. The method for optimizing the collaborative positioning state of a moving target according to claim 1, characterized in that: The expression of the optimization decision model is: I fit =[J CR ,J d ,J s ,J con ]·λ; Among them, J fit is the value of the optimization decision model; J CR is the first function value; J d is the second function value; J s is the third function value; J con is the fourth function value; λ is the weight coefficient, λ=[λ CR ,λ d ,λ s ,λ con ] T ,λ CR is the weight coefficient of the first function value; d is the weight coefficient of the second function value; s is the weight coefficient of the third function value; con is the weight coefficient of the fourth function value.

4. The method for optimizing the collaborative positioning state of a moving target according to claim 1, characterized in that: The calculation process of the first function value specifically includes: According to the azimuth between the possible position point of each UAV at the current moment and the moving target, the moving target is positioned using the AOA positioning method; The positioning error of the moving target is calculated according to the Cramer-Rao lower bound to obtain the first function value.

5. The method for optimizing the collaborative positioning state of a moving target according to claim 4, characterized in that: The expression of the first objective function is: Among them, J CR is the first function value; tr() is the trace of the matrix; F N is the information matrix; CRLB is the Cramer-Rao lower bound; N is the total number of drones; i is the i-th drone; θ i is the horizontal azimuth angle measured by the i-th UAV to the moving target; φ i is the vertical azimuth angle measured by the i-th UAV to the moving target; d i is the relative position relationship between the i-th UAV and the moving target in the OXY plane; D i is the relative position relationship between the i-th UAV and the moving target in three-dimensional space; is the standard deviation of the horizontal azimuth angle measured by the i-th UAV to the moving target; is the standard deviation of the vertical azimuth angle measured by the i-th UAV to the moving target.

6. The method for optimizing the collaborative positioning state of a moving target according to claim 1, characterized in that: The calculation process of the second function value specifically includes: Calculating the Euclidean distance according to the position points of the drone at adjacent moments; The Euclidean distance is used as the second function value.

7. The method for optimizing the collaborative positioning state of a moving target according to claim 1, characterized in that: The optimization algorithm is a particle swarm optimization algorithm.

8. A computer device comprising: A memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that the processor executes the computer program to implement a collaborative positioning state optimization decision method for moving targets as described in any one of claims 1-7.

9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, it implements the collaborative positioning state optimization decision method for moving targets as described in any one of claims 1-7.

10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, it implements the collaborative positioning state optimization decision method for moving targets as described in any one of claims 1-7.

Citation Information

Patent Citations

  • Multi-unmanned aerial vehicle autonomous collaborative search method under limited communication link

    CN113552899A

  • Unmanned aerial vehicle formation trajectory optimization method based on reconnaissance positioning task

    CN116069058A

  • Fusion optimization method for multi-unmanned aerial vehicle cooperative flight path planning

    CN116382334A

  • Multi-unmanned aerial vehicle cooperative hunting trajectory planning method and system based on three-dimensional Voronoi diagram

    CN117724531A

  • Observation optimization-oriented collaborative multi-target tracking method using multi-vehicle heterogeneous sensors

    WO2022057107A1

Cited By

  • Same-route double-aircraft cooperative flight distance calculation method for improving double-aircraft search and rescue efficiency

    CN120561424A

  • A method for calculating the same-course dual-aircraft cooperative flight interval for improving dual-aircraft search and rescue efficiency

    CN120561424B

  • Time-sharing modulation positioning method and device for multi-target optical imaging and electronic equipment

    CN120668022A