A method, system and device for optimizing AOA positioning trajectory of unmanned aerial vehicle clusters
By using the FIM of AOA measured value in the drone cluster to optimize the track point of the drone, the problem of decreasing positioning accuracy in the coordinated track planning of multiple drones is solved, and high accuracy is achieved and stable ground radiation source target positioning.
Patent Information
- Application Number
- CN202211317311.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-10-26
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2042-10-26
AI Technical Summary
In the coordinated track planning of multiple drones, due to the unreasonable dynamic station layout configuration, the positioning accuracy is reduced, and it is impossible to effectively adapt to complex environments and multi-task and multi-objective positioning and tracking needs.
By using FIM based on AOA measurement value as the objective function, the maximum value optimization calculation is performed to obtain the azimuth control amount of the drone, optimize the track point of the drone, and calculate the next moment's aviation using the drone control model Trace points, combined with constraints such as heading angle, distance and anti-collision constraints, optimize the station layout configuration of the drone cluster.
Rapidly improve the positioning accuracy and stability of the drone, provide the optimal station configuration and track, and improve the positioning accuracy of the ground radiation source target.
Smart Images

Figure CN115599120B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of multi-UAV collaborative trajectory planning, and in particular to a method, system and device for optimizing AOA positioning trajectory of a UAV cluster. Background Art
[0002] The positioning and tracking system can be divided into active positioning and passive positioning according to whether it emits electromagnetic waves. Passive positioning can be divided into passive positioning based on target radiation and passive positioning based on external radiation sources according to the different sources of radiation. Because the passive positioning signal based on target radiation will not be affected by the target reflection cross-sectional area, it has become the main means of positioning and tracking ground radiation source targets.
[0003] Passive positioning can be further divided into the following types according to the positioning system: Angle of arrival (AOA), received signal strength (RSS), time difference of arrival (TDOA), frequency difference of arrival (FDOA), etc. Among them, AOA positioning has the characteristics of low synchronization requirements and simple target solution, and has been widely used in practice.
[0004] With the development of technology, drones have shown an increasingly important role in many fields such as exploration and rescue. However, in many scenarios, a single drone alone can no longer adapt to the positioning and tracking needs of complex environments, multiple tasks and multiple targets. Therefore, using multiple drones for collaborative operations has become a development trend. However, due to the unreasonable configuration of multiple drones' dynamic deployment, the problem of reduced positioning accuracy has become increasingly prominent. How to optimize the dynamic deployment configuration of drones and drone trajectories has become the key to solving the problem. Summary of the invention
[0005] The object of the present invention is to provide a method, system and device for optimizing the AOA positioning trajectory of a drone cluster to solve at least one of the above-mentioned technical problems existing in the prior art.
[0006] In the first aspect, in order to solve the above-mentioned technical problems, the present invention provides an AOA positioning track optimization method for a UAV cluster, comprising: based on the system status, AOA measurement values and constraints of several UAVs at the current moment, obtaining a ground radiation source target positioning estimate through a pre-estimated calculation, and using the FIM based on the AOA measurement value as the objective function, performing an optimal calculation by solving the maximum value, and obtaining the UAV flight azimuth control value; based on the UAV flight azimuth control value, calculating through a UAV control model, obtaining the track point of each UAV at the next moment.
[0007] In a possible implementation, the UAV flight azimuth control amount refers to the deviation between the azimuth at the next moment and the azimuth at the current moment.
[0008] In a possible implementation manner, the AOA measurement value is obtained by measuring after an airborne AOA sensor receives a ground radiation source signal at the current moment.
[0009] In a possible implementation, the system state of the drone at the current moment includes the drone position, flight direction, and flight speed.
[0010] In a possible implementation, the constraints include: the UAV's own heading angle constraint, the upper limit constraint of the distance between the UAV and the ground radiation source target, the lower limit constraint of the distance between the UAV and the ground radiation source target, the anti-collision constraint between UAVs, and the communication constraint between UAVs.
[0011] In a possible implementation, the estimation calculation method may be a least square method, and a ground radiation source target positioning estimation value is obtained based on the AOA measurement values of a plurality of UAVs on the ground radiation source target.
[0012] In a possible implementation manner, the FIM based on the AOA measurement value refers to a Fisher information matrix based on the AOA measurement value, and the specific construction process includes:
[0013] First, we build a multi-UAV AOA positioning measurement model. Assume that M UAVs are used to locate the ground radiation source target. The motion state of each UAV is: i=1,2,…M
[0014] in,(·) T Represents matrix transpose;
[0015] x i (k)=(x i (k), y i (k)) T
[0016] represents the position vector of the i-th UAV;
[0017]
[0018] represents the flight speed vector of the i-th UAV;
[0019] The location of the ground radiation source target is:
[0020] At this time, the AOA measurement value of the drone is: φ i (x t) = arc tan 2(x t -x i ,y t -y i )+e i ;
[0021] Among them, arctan2 represents the inverse tangent function, whose range is [0, 2π), e i Indicates measurement error;
[0022] Assuming that the AOA positioning measurement value obeys the additive Gaussian distribution, the corresponding measurement vector for M drones can be expressed as:
[0023] Among them, Φ(x t )=[φ1(x t ),L,φ M (x t )] T Represents a vector set of measurement values, e = [e1,L,e M ] T A set of vectors representing measurement errors;
[0024] Assuming that the measurement errors between different drones are independent of each other, their covariance Among them I M is the M-dimensional identity matrix; thus, It can be expressed as: That is, obey Φ(x t ) is the expectation, with R φ is a normal distribution with a variance of .
[0025] Then, a model of error variance varying with distance is constructed. Assuming that the bandwidth of the AOA sensor receiving signal is a constant, the measurement error is related to the signal-to-noise ratio of the received signal. When the power and frequency of the ground radiation source are constant, the signal-to-noise ratio is determined by the distance r between the sensor and the target. i Therefore, the relationship between the error variance of the i-th AOA sensor and the distance can be expressed as:
[0026]
[0027] Among them, a is the path loss factor, r0 is the critical value of the positioning error that just does not change with distance, and SNR0 is the signal-to-noise ratio of the current drone received signal.
[0028] Since the relative configuration between the UAV and the ground radiation source target is closely related to the positioning accuracy during the UAV AOA positioning process, FIM can reflect the positioning accuracy of the UAV to the ground radiation source target under different configuration conditions, and the configuration corresponding to the smallest Cramer-Rao bound (CRLB) is the optimal positioning configuration.
[0029] For an unbiased estimator Its Cramer-Rao bound can be expressed as:
[0030]
[0031] Among them, J represents FIM.
[0032] Assuming that the M measurements are independent of each other and follow an additive Gaussian distribution, the (i, j)th value of J can be expressed as:
[0033]
[0034] in, express The probability density function of is:
[0035]
[0036] Substituting AOA measurements into J i,j , we can get:
[0037]
[0038] It can be seen that J (i,j) It can be regarded as the preceding term J 1,(i,j) and the latter term J 2,(i,j) sum;
[0039] Among them, the previous
[0040] Previous Item J 1,(i,j) is the FIM of the AOA measurement value, the analytical expression can be expressed as:
[0041]
[0042] To simplify the formula, let Then we can get:
[0043]
[0044] For the latter
[0045] By simple deduction, we can get
[0046] So, Can be expressed as:
[0047]
[0048]
[0049] Combination matrix J 1,(i,j) and J 2,(i,j) , we get the matrix J, that is, the expanded expression of FIM based on AOA measurement value is as follows:
[0050]
[0051] It can be seen from the expression that the positioning error in the FIM based on the AOA measurement value varies with the distance. The size of the matrix is related to the distance and angle between each UAV and the ground radiation source. By solving the station configuration corresponding to the maximum value of the FIM determinant based on the AOA measurement value, high-precision positioning can be quickly achieved.
[0052] In a possible implementation, the objective function can be expressed as: argmaxf(u k+1 )=det(J k+1 (r i ,φ i ));
[0053] Among them, u k+1 represents the control value of the flight azimuth of each UAV at the next moment under the condition of minimum measurement error; J k+1 represents the FIM of each drone at the next moment; r i represents the distance between UAV i and the ground radiation source target; φ i Represents the AOA measurement value of drone i.
[0054] Furthermore, assuming that multiple drones adopt an angle control method, the drone control model can be expressed as:
[0055] X k+1 =f(X k ,u k ),k=1,2,L,M;
[0056] Among them, X k Represents the position vector X of each drone at time k k =[x1(k),L,x M (k)] T ,u k Represents the control amount of each UAV's flight azimuth at time k: u k =[u1(k),u2(k),L u M (k)].
[0057] Preferably, the equation of motion of the drone can be:
[0058]
[0059] Among them, v0 represents the flight speed and T0 represents the time interval of motion control.
[0060] In each T0 range, the control value u of the flight azimuth of each UAV at the next moment under the condition of minimum measurement error is calculated through the ground radiation source target positioning estimation value and the FIM based on the AOA measurement value through an optimization algorithm, such as a differential evolution algorithm with constraint solving. k+1 .
[0061] The constrained differential evolution algorithm belongs to the prior art and has the characteristics of high calculation accuracy and small calculation amount, and can ensure the effectiveness and validity of the calculation.
[0062] In a possible implementation, the formula for the heading angle constraint of the drone itself may specifically be:
[0063] ||u i (k+1)-u i (k)||≤u max ;
[0064] Among them, u i (k) represents the heading angle of UAV i at time k, u i (k+1) represents the heading angle of UAV i at time k+1), u max Indicates the UAV's own heading angle constraint threshold.
[0065] In a possible implementation manner, the formula for the upper limit constraint of the distance between the UAV and the ground radiation source target may specifically be:
[0066] in, represents the estimated value of the ground radiation source target positioning at time k; x i (k+1) represents the position vector of UAV i at time k+1; R h Indicates the upper range threshold, which is mainly determined by the signal-to-noise ratio of the airborne AOA sensor.
[0067] In a possible implementation manner, the formula for the lower limit constraint of the distance between the UAV and the ground radiation source target may specifically be:
[0068] in, represents the estimated value of the ground radiation source target positioning at time k; x i (k+1) represents the position vector of UAV i at time k+1; R l Indicates the lower distance threshold.
[0069] In a possible implementation, the formula for the anti-collision constraint between the drones may specifically be:
[0070] ||x i (k+1)-x j (k+1)||≥c l ;
[0071] Among them, x i (k+1) represents the position vector of UAV i at time k+1); x j (k+1) represents the position vector of drone j at time k+1); c l Represents the collision avoidance constraint threshold between UAVs.
[0072] In a possible implementation, the formula for the communication constraint between the drones may specifically be:
[0073] ||x i (k+1)-x j (k+1)||≤c h ;
[0074] Among them, x i (k+1) represents the position vector of UAV i at time k+1); x j (k+1) represents the position vector of drone j at time k+1); c h Represents the communication constraint threshold between UAVs.
[0075] In a possible implementation, the UAV cluster AOA positioning track optimization method further includes an end condition, and when the end condition is reached, the track optimization is stopped.
[0076] Furthermore, the end condition may specifically be determining the target position of the ground radiation source, or reaching a preset time, etc.
[0077] In a second aspect, the present invention also provides a UAV cluster AOA positioning track optimization system, including: a data receiving module, a data processing module and a data generating module:
[0078] The data receiving module is used to receive the current system status data, AOA measurement value data and ground radiation source signal of the UAV;
[0079] The data processing module includes an estimation unit, a FIM unit and a control unit:
[0080] The estimation unit is used to receive the ground radiation source signal and obtain the ground radiation source target positioning estimation value after estimation calculation;
[0081] The FIM unit is used to receive the current system status data and AOA measurement value data of the UAV, and use the FIM based on the AOA measurement value as the objective function to perform optimal calculation to solve the maximum value, so as to obtain the UAV flight azimuth control value;
[0082] The control unit generates a track point at the next moment based on the UAV flight azimuth control value and through calculation of the UAV control model;
[0083] The data generation module is used to transmit the next moment track point to the outside and determine whether the end condition is met. If the end condition is met, the track optimization is stopped.
[0084] Preferably, the end condition is that the ground radiation source target positioning estimation values at several consecutive moments are the same.
[0085] In the third aspect, the present invention also provides a UAV cluster AOA positioning trajectory optimization device, including a processor, a memory and a bus, wherein the memory stores instructions and data that can be read by the processor, and the processor is used to call the instructions and data in the memory to execute the UAV cluster AOA positioning trajectory optimization method as described above, and the bus connects the functional components to transmit information.
[0086] By adopting the above technical solution, the present invention has the following beneficial effects:
[0087] The UAV cluster AOA positioning trajectory optimization method provided by the present invention can quickly improve the positioning accuracy and positioning stability of the UAV by taking the FIM based on the AOA measurement value as the objective function and optimizing and calculating the UAV flight azimuth control value, thereby providing the optimal station configuration and optimal trajectory for the UAV cluster to detect the target position of the ground radiation source. BRIEF DESCRIPTION OF THE DRAWINGS
[0088] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings in the following description are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0089] Figure 1 A flowchart of the AOA positioning and trajectory optimization method for UAV clusters provided in an embodiment of the present invention;
[0090] Figure 2 The effect diagram of the AOA positioning track optimization of the UAV cluster for the ground static radiation source target provided by the embodiment of the present invention;
[0091] Figure 3for Figure 2 Positioning error comparison chart;
[0092] Figure 4 The effect diagram of the AOA positioning track optimization of the drone cluster for the ground dynamic radiation source target provided by the embodiment of the present invention;
[0093] Figure 5 for Figure 4 Positioning error comparison chart;
[0094] Figure 6 A diagram of the UAV cluster AOA positioning trajectory optimization system provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0095] The technical solution of the present invention will be described clearly and completely below in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of them. 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.
[0096] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.
[0097] The present invention is further explained below in conjunction with specific implementation modes.
[0098] like Figure 1 As shown, in order to solve the above technical problems, the UAV cluster AOA positioning track optimization method provided by the present invention specifically includes the following steps:
[0099] Step 1: Collect the system status X of several drones at time k k =[χ1(k),L,χ M (k)] T and the AOA measurement values Z of the several UAVs to a ground radiation source target k ;
[0100] Step 2: Based on the AOA measurement values Z k , through the estimation method, such as the least squares algorithm, the ground radiation source target location estimation value is obtained
[0101] Step 3: Target positioning estimation based on the ground radiation source As well as the constraints, the FIM based on the AOA measurement value is used as the objective function of the track optimization, and the maximum value is solved by an optimization algorithm, such as a differential evolution algorithm, to obtain the flight azimuth control value of each UAV;
[0102] Step 4: Based on the flight azimuth control value u of each UAV k+1 , call the UAV control model to generate the next moment track point x of each UAV i (k+1);
[0103] Step 5: Each UAV is based on the track point x i (k+1) to fly and return to step 1 until the end condition is reached.
[0104] Furthermore, the UAV flight azimuth control amount refers to the deviation between the azimuth at the next moment and the azimuth at the current moment.
[0105] Furthermore, the AOA measurement value is obtained by measuring the AOA sensor onboard the drone after receiving the ground radiation source signal at the current moment.
[0106] Furthermore, the system status of the drone at the current moment includes the drone position, flight direction and flight speed.
[0107] Furthermore, the constraints include: the UAV's own heading angle constraint, the upper limit constraint of the distance between the UAV and the ground radiation source target, the lower limit constraint of the distance between the UAV and the ground radiation source target, the anti-collision constraint between UAVs and the communication constraint between UAVs.
[0108] Furthermore, the FIM based on AOA measurement values refers to the Fisher information matrix based on AOA measurement values, and the specific construction idea is:
[0109] First, we build a multi-UAV AOA positioning measurement model. Assume that M UAVs are used to locate the ground radiation source target. The motion state of each UAV is: i = 1, 2, ... M;
[0110] in,(·) T Represents matrix transpose;
[0111] x i (k)=(x i (k), y i (k)) T
[0112] represents the position vector of the i-th UAV;
[0113]
[0114] represents the flight speed vector of the i-th UAV;
[0115] The location of the ground radiation source target is:
[0116] At this time, the AOA measurement value of the drone is: φ i (x t ) = arc tan2(x t -x i ,y t -y i )+e i ;
[0117] Among them, arctan2 represents the inverse tangent function, whose range is [0, 2π), e i Indicates measurement error;
[0118] Assuming that the AOA positioning measurement value obeys the additive Gaussian distribution, the corresponding measurement vector for M drones can be expressed as:
[0119] Among them, Φ(x t )=[φ1(x t ),L,φ M (x t )] T Represents a vector set of measurement values, e = [e1,L,e M ] T A set of vectors representing measurement errors;
[0120] Assuming that the measurement errors between different drones are independent of each other, their covariance Among them I M is the M-dimensional identity matrix; thus, It can be expressed as: That is, obey Φ(x t ) is the expectation, with R φ is a normal distribution with a variance of .
[0121] Then, a model of error variance varying with distance is constructed. Assuming that the bandwidth of the AOA sensor receiving signal is a constant, the measurement error is related to the signal-to-noise ratio of the received signal. When the power and frequency of the ground radiation source are constant, the signal-to-noise ratio is determined by the distance r between the sensor and the target. i Therefore, the relationship between the error variance of the i-th AOA sensor and the distance can be expressed as:
[0122]
[0123] Among them, a is the path loss factor, r0 is the critical value of the positioning error that just does not change with distance, and SNR0 is the signal-to-noise ratio of the current drone received signal.
[0124] Since the relative configuration between the UAV and the ground radiation source target is closely related to the positioning accuracy during the UAV AOA positioning process, FIM can reflect the positioning accuracy of the UAV to the ground radiation source target under different configuration conditions, and the configuration corresponding to the smallest Cramer-Rao bound (CRLB) is the optimal positioning configuration.
[0125] For an unbiased estimator, the Cramer-Rao bound can be expressed as:
[0126]
[0127] Among them, J represents FIM.
[0128] Assuming that the M measurements are independent of each other and follow an additive Gaussian distribution, the (i, j)th value of J can be expressed as:
[0129]
[0130] in, express The probability density function of is:
[0131]
[0132] Substituting AOA measurements into J i,j , we can get:
[0133]
[0134] It can be seen that J (i,j) It can be regarded as the preceding term J 1,(i,j) and the latter term J 2,(i,j) sum;
[0135] Among them, the previous
[0136] Previous Item J 1,(i,j) is the FIM of the AOA measurement value, the analytical expression can be expressed as:
[0137]
[0138] To simplify the formula, let Then we can get:
[0139]
[0140] For the latter
[0141] By simple deduction, we can get
[0142] So, They can be expressed as:
[0143]
[0144]
[0145] Combination matrix J 1,(i,j) and J 2,(i,j) , we get the matrix J, that is, the expanded expression of FIM based on AOA measurement value is as follows:
[0146]
[0147] It can be seen from the expression that the positioning error in the FIM based on the AOA measurement value varies with the distance. The size of the matrix is related to the distance and angle between each UAV and the ground radiation source. By solving the station configuration corresponding to the maximum value of the FIM determinant based on the AOA measurement value, high-precision positioning can be quickly achieved.
[0148] Furthermore, the objective function can be expressed as: arg max f(u k+1 )=det(J k+1 (r i ,φ i ));
[0149] Among them, u k+1 represents the control value of the flight azimuth of each UAV at the next moment under the condition of minimum measurement error; J k+1 represents the FIM of each drone at the next moment; r i represents the distance between UAV i and the ground radiation source target; φ i Represents the AOA measurement value of drone i.
[0150] Furthermore, assuming that multiple drones adopt an angle control method, the drone control model can be expressed as:
[0151] X k+1 =f(X k ,u k ),k=1,2,L,M;
[0152] Among them, X k Represents the position vector X of each drone at time k k =[x1(k),L,x M (k)] T ,u kIndicates the control amount of each UAV's flight azimuth at the current moment: u k =[u1(k),u2(k),L u M (k)].
[0153] Preferably, the equation of motion of the drone can be:
[0154]
[0155] Among them, v0 represents the flight speed and T0 represents the time interval of motion control.
[0156] In each T0 range, the control value u of the flight azimuth of each UAV at the next moment under the condition of minimum measurement error is calculated through the ground radiation source target positioning estimation value and the FIM based on the AOA measurement value through an optimization algorithm, such as a differential evolution algorithm with constraint solving. k+1 .
[0157] The constrained differential evolution algorithm belongs to the prior art and has the characteristics of high calculation accuracy and small calculation amount, and can ensure the effectiveness and validity of the calculation.
[0158] Furthermore, the formula for the UAV's own heading angle constraint may specifically be:
[0159] ||u i (k+1)-u i (k)||≤u max ;
[0160] Among them, u i (k) represents the heading angle of UAV i at time k, u i (k+1) represents the heading angle of UAV i at time k+1), u max Indicates the UAV's own heading angle constraint threshold.
[0161] Furthermore, the formula for the upper limit constraint of the distance between the UAV and the ground radiation source target may specifically be:
[0162] in, represents the estimated value of the ground radiation source target positioning at time k; x i (k+1) represents the position vector of UAV i at time k+1; R h Indicates the upper range threshold, which is mainly determined by the signal-to-noise ratio of the airborne AOA sensor.
[0163] Furthermore, the formula for the lower limit constraint of the distance between the UAV and the ground radiation source target may specifically be:
[0164] in, represents the estimated value of the ground radiation source target positioning at time k; x i (k+1) represents the position vector of UAV i at time k+1; R l Indicates the lower distance threshold.
[0165] Furthermore, the formula for the anti-collision constraint between the drones may specifically be:
[0166] ||x i (k+1)-x j (k+1)||≥c l ;
[0167] Among them, x i (k+1) represents the position vector of UAV i at time k+1); x j (k+1) represents the position vector of drone j at time k+1); c l Represents the collision avoidance constraint threshold between UAVs.
[0168] Furthermore, the formula for the communication constraint between the drones may specifically be:
[0169] ||x i (k+1)-x j (k+1)||≤c h ;
[0170] Among them, x i (k+1) represents the position vector of UAV i at time k+1); x j (k+1) represents the position vector of drone j at time k+1); c h Represents the communication constraint threshold between UAVs.
[0171] Furthermore, the end condition may be determining the target position of the ground radiation source or reaching a preset time.
[0172] Embodiment 1:
[0173] Use three drones to perform AOA positioning simulation on ground static radiation source targets:
[0174] Assume that the initial position of the ground static radiation source target is x t =[0,0] T ;
[0175] The initial states of the drone are: x1(1) = [-9200, -5000] T 、x2(1)=[-10000,-5000] T 、x3(1)=[-10000,-5800] T ;
[0176] The initial orientation of each drone is: the nose points to due north (π / 2 direction in the coordinate system);
[0177] The initial flight speed of each drone is: v0 = 10m / s;
[0178] Sampling time interval: T = 0.1s;
[0179] Simulation time: 100s.
[0180] UAV's own heading angle constraint: u max =15°;
[0181] The upper limit of the distance between the UAV and the ground radiation source target: R h =15km;
[0182] The lower limit constraint of the distance between the UAV and the ground radiation source target: R l =0.3km;
[0183] Communication constraints between drones: c h =15km;
[0184] Anti-collision constraints between drones: c l =40m.
[0185] The effect diagram of optimizing the AOA positioning track of the UAV cluster for the ground static radiation source target through simulation calculation by the method of the embodiment of the present invention is as follows: Figure 2 As shown: the horizontal axis represents the x-axis position coordinate, and the vertical axis represents the y-axis position coordinate, both in meters. The true position of the static target is shown as a triangle in the figure; the estimated values of the target position by the three drones at each moment are shown as hollow circles in the figure; at the initial moment, the relative configuration effect between the cluster platform composed of three drones and the target is poor, which is manifested in that the distance between the three drones and the target is far, and the angle between the three drones and the target is approximately zero, but as time goes by, through track optimization, each drone continuously adjusts its relative configuration with the target, so that the three drones are getting closer and closer to the target, the angle between the three drones and the target is getting larger and larger, and the estimated values of the target position by the three drones at each moment are getting closer and closer to the true position of the static target.
[0186] Figure 3The figure shows the error comparison of positioning the static target by two methods when a cluster of three drones flies towards the static target in a fixed configuration and flies towards the static target by using the present scheme for trajectory optimization: the horizontal axis represents the positioning time in seconds; the vertical axis represents the mean square error between the real position of the target and the estimated position; at the initial moment, the mean square error of positioning the target by both methods is in the range of 3000 to 5000. As time goes by, the error after trajectory optimization by the present scheme (as shown by the circle in the figure) decreases rapidly, and the decrease is much higher than the positioning error in the case of fixed configuration. For example, when the simulation time reaches 30 seconds, the positioning error in the case of optimization by the present scheme is close to 0, while the positioning error in the case of fixed configuration is about 2000, which proves that the trajectory optimization effect of the present scheme is effective.
[0187] Embodiment 2:
[0188] Use three drones to perform AOA positioning simulation on ground dynamic radiation source targets:
[0189] Assume that the initial position of the ground static radiation source target is x t =[0,0] T ;
[0190] The initial states of the drone are: x1(1) = [-9200, -5000] T 、x2(1)=[-10000,-5000] T 、x3(1)=[-10000,-5800] T ;
[0191] The initial orientation of each drone is: the nose points to due north (in the coordinate system);
[0192] The initial flight speed of each drone is: v0 = 10m / s;
[0193] Sampling time interval: T = 0.1s;
[0194] Simulation time: 100s.
[0195] UAV's own heading angle constraint: u max =15°;
[0196] The upper limit of the distance between the UAV and the ground radiation source target: R h =15km;
[0197] The lower limit constraint of the distance between the UAV and the ground radiation source target: R l =0.3km;
[0198] Communication constraints between drones: R l=0.3km;
[0199] Anti-collision constraints between drones: c l =40m.
[0200] The effect diagram of the AOA positioning track optimization of the UAV cluster for the ground dynamic radiation source target is shown in the following figure through simulation calculation by the method of the embodiment of the present invention. Figure 4 As shown: the horizontal axis represents the x-axis position coordinate, and the vertical axis represents the y-axis position coordinate, both in meters. The real position of the dynamic target is shown as a star in the figure; the estimated values of the target position by the three drones at each moment are shown as hollow circles in the figure; at the initial moment, the relative configuration effect between the cluster platform composed of three drones and the target is poor, which is manifested in that the distance between the three drones and the target is far, and the angle between the three drones and the target is approximately zero, but as time goes by, through track optimization, each drone continuously adjusts its relative configuration with the target, so that the three drones are getting closer and closer to the target, the angle between the three drones and the target is getting larger and larger, and the estimated values of the target position by the three drones at each moment are getting closer and closer to the real position of the dynamic target.
[0201] Figure 5 The figure shows the error comparison of positioning the dynamic target by two methods when a cluster of three drones flies towards the dynamic target in a fixed configuration and flies towards the dynamic target by using the present scheme for trajectory optimization: the horizontal axis represents the positioning time in seconds; the vertical axis represents the mean square error between the real position of the target and the estimated position; at the initial moment, the mean square error of positioning the target by both methods is about 10000. As time goes by, the error after trajectory optimization by the present scheme (as shown by the circle in the figure) decreases rapidly, and the decrease is much higher than the positioning error in the case of fixed configuration. For example, when the simulation time reaches 60 seconds, the positioning error in the case of optimization by the present scheme is close to 0, while the positioning error in the case of fixed configuration is about 6000, which proves that the trajectory optimization effect of the present scheme is effective.
[0202] On the other hand, based on the same inventive concept, the present invention also provides a UAV cluster AOA positioning track optimization system, such as Figure 6 As shown, it includes: a data receiving module, a data processing module and a data generating module:
[0203] The data receiving module is used to receive the current system status data, AOA measurement value data and ground radiation source signal of the UAV;
[0204] The data processing module includes an estimation unit, a FIM unit and a control unit:
[0205] The estimation unit is used to receive the ground radiation source signal and obtain the ground radiation source target positioning estimation value after estimation calculation;
[0206] The FIM unit is used to receive the current system status data and AOA measurement value data of the UAV, and use the FIM based on the AOA measurement value as the objective function to perform optimal calculation to solve the maximum value, so as to obtain the UAV flight azimuth control value;
[0207] The control unit generates a track point at the next moment based on the UAV flight azimuth control value and through calculation of the UAV control model;
[0208] The data generation module is used to transmit the next moment track point to the outside and determine whether the end condition is met. If the end condition is met, the track optimization is stopped.
[0209] Furthermore, the end condition is to determine the target position of the ground radiation source, for example, the target positioning estimation values of the ground radiation source at several consecutive moments may be the same.
[0210] On the other hand, the present invention also provides a UAV cluster AOA positioning trajectory optimization device, including a processor, a memory and a bus, wherein the memory stores instructions and data that can be read by the processor, and the processor is used to call the instructions and data in the memory to execute the UAV cluster AOA positioning trajectory optimization method as described above, and the bus connects the functional components to transmit information.
[0211] In another implementation mode, the present solution can also be implemented by a device, which may include a corresponding module for executing each or several steps in the above-mentioned various implementation modes. The module may be one or more hardware modules specially configured to execute the corresponding steps, or implemented by a processor configured to execute the corresponding steps, or stored in a computer-readable medium for implementation by a processor, or implemented by some combination.
[0212] The processor performs the various methods and processes described above. For example, the method implementation in the present solution can be implemented as a software program, which is tangibly contained in a machine-readable medium, such as a memory. In some embodiments, part or all of the software program can be loaded and / or installed via a memory and / or a communication interface. When the software program is loaded into the memory and executed by the processor, one or more steps in the method described above can be executed. Alternatively, in other embodiments, the processor can be configured to perform one of the above methods by any other appropriate means (for example, by means of firmware).
[0213] The device can be implemented using a bus architecture. The bus architecture can include any number of interconnecting buses and bridges, depending on the specific application and overall design constraints of the hardware. The bus connects various circuits including one or more processors, memories, and / or hardware modules together. The bus can also connect various other circuits such as peripherals, voltage regulators, power management circuits, external antennas, etc.
[0214] The bus can be an Industry Standard Architecture (ISA) bus, a Peripheral Component Interconnect (PCI) bus, or an Extended Industry Standard Component (EISA) bus, etc. The bus can be divided into an address bus, a data bus, a control bus, etc.
[0215] In summary, according to the technical solution of the present invention, the problem of rapid positioning of ground radiation sources by drone clusters can be well solved. The FIM based on the AOA measurement value is used as the objective function to perform optimal calculation to solve the maximum value, and a drone cluster AOA positioning trajectory optimization method based on the FIM criterion is constructed, which can improve the positioning accuracy and positioning stability in a shorter time.
[0216] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A UAV cluster AOA positioning track optimization method, characterized in that: include: Based on the current system status, AOA measurement values and constraints of several drones, the estimated positioning value of the ground radiation source target is obtained through pre-estimation calculation, and the FIM based on the AOA measurement value is used as the objective function. The optimal calculation is performed by solving the maximum value to obtain the flight azimuth control value of the drone. Based on the flight azimuth control value of the drone, the track point of each drone at the next moment is obtained through the drone control model calculation; The current system status of the drone includes the drone position, flight direction and flight speed; The constraints include: the UAV's own heading angle constraint, the upper limit constraint of the distance between the UAV and the ground radiation source target, the lower limit constraint of the distance between the UAV and the ground radiation source target, the anti-collision constraint between UAVs and the communication constraint between UAVs; The FIM based on AOA measurements refers to a Fisher information matrix based on AOA measurements; The objective function is: ,in Indicates the control amount of each UAV's flight azimuth at the next moment under the condition of minimum measurement error; It represents the FIM of each UAV based on the AOA measurement value at the next moment; Indicates drone The distance to the ground radiation source target; Indicates drone AOA measurement value.
2. The method according to claim 1, characterized in that The UAV flight azimuth control amount refers to the deviation between the azimuth at the next moment and the azimuth at the current moment.
3. The method according to claim 1, characterized in that The AOA measurement value is obtained by measuring the ground radiation source signal received by the airborne AOA sensor at the current moment.
4. A UAV cluster AOA positioning track optimization system, characterized in that: include: Data receiving module, data processing module and data generating module: The data receiving module is used to receive the current system status data, AOA measurement value data and ground radiation source signal of the UAV; The data processing module includes an estimation unit, a FIM unit and a control unit: The estimation unit is used to receive the ground radiation source signal and obtain the ground radiation source target positioning estimation value after estimation calculation; The FIM unit is used to receive the system status data and AOA measurement value data of the drone at the current moment, and use the FIM based on the AOA measurement value as the objective function to perform optimal calculation to solve the maximum value according to the constraint conditions to obtain the drone flight azimuth control quantity; the system status data of the drone at the current moment includes the drone position, flight direction and flight speed; the constraint conditions include: the drone's own heading angle constraint, the upper limit constraint of the distance between the drone and the ground radiation source target, the lower limit constraint of the distance between the drone and the ground radiation source target, the anti-collision constraint between drones and the communication constraint between drones; the FIM based on the AOA measurement value refers to the Fisher information matrix based on the AOA measurement value; the objective function is: ,in Indicates the control amount of each UAV's flight azimuth at the next moment under the condition of minimum measurement error; It represents the FIM of each UAV based on the AOA measurement value at the next moment; Indicates drone The distance to the ground radiation source target; Indicates drone AOA measurement value; The control unit generates a track point at the next moment based on the UAV flight azimuth control value and through calculation of the UAV control model; The data generation module is used to transmit the next moment track point to the outside and determine whether the end condition is met. If the end condition is met, the track optimization is stopped.
5. The system according to claim 4, characterized in that The end condition is to determine the target position of the ground radiation source.
6. A UAV cluster AOA positioning track optimization device, characterized in that: It includes a processor, a memory and a bus, the memory stores instructions and data that can be read by the processor, the processor is used to call the instructions and data in the memory to execute the UAV cluster AOA positioning trajectory optimization method as described in any one of claims 1 to 3, and the bus connects the functional components to transmit information.
Citation Information
Patent Citations
Method for tracking mobile radiation source by multiple unmanned aerial vehicles based on position and speed errors
CN113342059A
Observation optimization-oriented collaborative multi-target tracking method using multi-vehicle heterogeneous sensors
WO2022057107A1
