A non-line-of-sight UAV positioning method based on genetic algorithm
Through a genetic algorithm-based method, the millimeter-wave radar system is used to obtain drone multipath ghost information, construct an objective function and optimize street width, which solves the drone positioning problem in complex urban environments with unknown building layouts and achieves high-precision non-line-of-sight drone positioning.
Patent Information
- Application Number
- CN202411374514.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-29
- Publication Date
- 2025-09-09
- Estimated Expiration
- 2044-09-29
AI Technical Summary
In complex urban environments, existing technologies find it difficult to accurately obtain the position of non-line-of-sight drones under conditions of unknown building layouts, especially in non-cooperative environments, where their applicability is relatively limited.
Through a genetic algorithm-based method, the millimeter-wave radar system is used to obtain the multipath ghost information of the UAV, construct an objective function and optimize the street width. Combined with the positional relationship between the ghost and the target, the objective function is established and optimized through the genetic algorithm to obtain the accurate position of the UAV.
Accurate positioning of non-line-of-sight UAV targets is achieved under conditions of unknown building layouts, improving positioning accuracy. It is suitable for typical L-shaped urban block models and provides technical support for target positioning under generalized non-line-of-sight models.
Smart Images

Figure CN119199791B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of obscured target detection, and in particular relates to a non-line-of-sight UAV positioning method based on a genetic algorithm. Background Art
[0002] In recent years, drone technology, leveraging its unique advantages, has been widely applied in fields such as express logistics, disaster relief, and smart cities. However, in complex urban environments, the increasing number of drones inevitably brings potential airspace conflicts and security risks. Therefore, accurately acquiring drone positions is key to improving drone system security, promoting efficient collaboration between drones, and optimizing flight path planning.
[0003] Radar technology is a key means of target positioning, and extensive research has been conducted on positioning under line-of-sight (LOS) conditions. However, in complex urban environments, electromagnetic waves cannot directly reach the target location due to obstruction by buildings. Instead, they must propagate through multiple paths, such as diffraction and reflection from building surfaces. Current research on drone positioning in non-line-of-sight (NLOS) scenarios is relatively limited. Existing methods primarily rely on known building layout information to extract drone signals and study positioning algorithms. However, their applicability to unknown scenarios in real-world applications, particularly non-cooperative environments, is limited. Summary of the Invention
[0004] To solve the above problems, the present invention provides a non-line-of-sight UAV positioning method based on genetic algorithm, which can accurately obtain the target position of the UAV after the non-line-of-sight corner under the condition of unknown building and street layout.
[0005] A non-line-of-sight (NLOS) UAV positioning method based on a genetic algorithm is provided. The target to be measured is located in a non-line-of-sight blind spot formed by the corner occlusion of an L-shaped street. The positioning method comprises the following steps:
[0006] S1: Obtain a set of multipath ghost positions of the target to be measured through the BP image containing the multipath ghost information of the UAV;
[0007] S2: Obtain a mapping relationship between the true ghost position of the target to be measured formed on each reflection path of the radar electromagnetic wave reflected multiple times by the L-shaped street and the true position of the target to be measured, where each reflection forms a true ghost position, and the true ghost positions formed on the first P reflection paths with the largest reflection intensity are used to construct the objective function, where P is the number of paths in the multipath ghost position;
[0008] S3: Construct the objective function based on the multipath ghost position and the true ghost position of the target to be measured as follows:
[0009]
[0010] Among them, (x e ,y e ) is the estimated position value of the target to be measured, G est is the position set composed of the real positions of each ghost represented by the mapping relationship, G ref is the location set consisting of multipath ghost locations, ||·|| represents the bi-norm, D1 is the street width, and argmin represents the value when the objective function reaches its minimum (x e ,y e ), the value of D1;
[0011] S4: Use genetic algorithm to optimize the objective function and obtain the position estimate of the target to be measured (x e ,y e ) and street width D1.
[0012] Furthermore, a method for obtaining a set of multipath ghost positions of the target to be measured through the BP image containing the multipath ghost information of the UAV is as follows:
[0013] Use Gaussian smoothing filter to process BP image I BP , and obtain the smoothed image I S ;
[0014] Using CA-CFAR threshold detection method to suppress smooth image I S Grating lobe in the image is obtained, and the grating lobe suppression image I is obtained. c , where the grating lobe suppression image I c The pixel value I corresponding to each grid point c (q) is calculated as:
[0015]
[0016] Among them, I s (q) is the suppressed smoothed image I S The pixel value of the qth grid point on the left is α, which is the set detection threshold in the CA-CFAR threshold detection method;
[0017] Grating lobe suppression image I c Perform binarization processing to obtain a binary image;
[0018] The eight-connectedness algorithm is used to obtain the connected domains in the binary image, and the centroid of each connected domain is used as the multipath ghost position. The number of connected domains is at most 3.
[0019] Furthermore, the method for obtaining the BP image containing the multipath ghost information of the UAV is as follows:
[0020] The millimeter-wave radar system with M transmitters and N receivers is used to collect multipath echo signals of the target to be measured in the non-line-of-sight blind zone;
[0021] Suppress the background clutter of multipath echo signals through moving target detection technology MTI;
[0022] Perform FFT processing on the multipath echo signal after clutter suppression to obtain the distance-time diagram of M×N channels;
[0023] The imaging area of the millimeter wave radar system is divided into X×Y grids, and the time delay τ corresponding to each grid q on each channel is calculated m,n (q):
[0024]
[0025] Among them, τ m (q) represents the electromagnetic wave transmitted from the mth transmitting antenna T m The delay along the straight line to the grid q, τ n (q) represents the electromagnetic wave propagating from the grid q along a straight line to the nth receiving antenna R n The delay, ||qT m || is the grid q to the mth transmitting antenna T m The distance, ||qR n || is the grid q to the nth receiving antenna R n distance, c is the speed of light, m=1,2,..,M, n=1,2,..,N;
[0026] Match the multi-channel amplitudes for each grid point in the imaging area to obtain a BP image containing the multipath ghost information of the drone. The amplitude corresponding to any grid point on any channel is determined as follows:
[0027] Get the delay τ corresponding to the current grid point on the current channel m,n (q), obtain the time delay τ on the distance-time graph m,n (q) The mth transmitting antenna T m With the nth receiving antenna R n The distance of the formed channel is used as the amplitude of the current grid point on the current channel.
[0028] Furthermore, the method for obtaining the centroid of any connected domain is:
[0029]
[0030] Among them, G p (x p ,y p ) is the centroid coordinate of the pth connected domain, (x k,p ,yk,p ) is the coordinate of the kth grid in the pth connected domain, N p is the number of grids in the pth connected domain, p = 1, 2, …, P.
[0031] Furthermore, if M=3, the mapping relationship between the true position of each ghost image and the true position of the target to be measured is as follows:
[0032] G 11 (x 11 ,y 11 )=(x t -2D2-x u ,y u )
[0033] G 22 (x 22 ,y 22 )=(x u -2D1,y u )
[0034] G 33 (x 33 ,y 33 )=(2x t -2D2-2D1-x u ,y u )
[0035] Among them, G 11 (x 11 ,y 11 ) is the real position of the ghost image formed by the target on the reflection path of the first reflection of the radar electromagnetic wave, G 22 (x 22 ,y 22 ) is the real position of the ghost image formed by the target on the reflection path of the second reflection of the radar electromagnetic wave, G 33 (x 33 ,y 33 ) is the real position of the ghost image formed by the target on the reflection path of the third reflection of the radar electromagnetic wave, (x u ,y u ) is the actual position of the target to be measured, (x t ,y t ) is the position of the radar, D1 is the street width of the L-shaped street in the non-line-of-sight blind spot, and D2 is the distance from the radar to the wall of the L-shaped street in the non-line-of-sight blind spot.
[0036] Furthermore, the genetic algorithm is used to optimize the objective function to obtain the position estimate of the target to be measured (x e ,y e ) and the estimated street width D1, specifically:
[0037] S41: (x e ,y e ) and D1 as different individuals to obtain the initial population, where the number of individuals is G;
[0038] S42: Determine whether each individual satisfies two set conditions x c <x e <x c +D1 and Where D1 is the width of the L-shaped street in the non-line-of-sight blind spot, x c is the horizontal coordinate of the corner of the L-shaped street, is the average value of the ordinates of the true positions of the ghosts represented by the mapping relationship; the constraint violation counter conv corresponding to the individual that does not meet the two set conditions is recorded as 2, the constraint violation counter conv corresponding to the individual that meets one of the set conditions is recorded as 1, and the constraint violation counter conv corresponding to the individual that meets both set conditions is recorded as 0;
[0039] S43: Calculate the objective function value corresponding to each individual;
[0040] S44: Use simulated binary crossover and uniform mutation methods to evolve each individual in the previous generation population to obtain a new population after crossover and mutation;
[0041] S45: Calculate the objective function value corresponding to each individual in the new population, and determine the constraint violation counter conv corresponding to each individual in the new population according to the number of set conditions satisfied by the new population;
[0042] S46: Select the first G individuals with the smallest objective function value from the new population individuals whose constraint violation counter conv is 0 to form the next generation population;
[0043] S47: The next generation population obtained in step S46 is used as the previous generation population in step S44, and then steps S44 to S47 are repeated until the set number of iterations is reached, and then step S48 is entered;
[0044] S48: Select the best individual in all iterations as the final position estimate of the target to be measured (x e ,y e ) and the estimated street width D1, where the optimal individual satisfies: the constraint violation counter conv is 0 and the objective function value is the smallest.
[0045] Beneficial effects:
[0046] The present invention provides a non-line-of-sight (NLOS) unmanned aerial vehicle (UAV) positioning method based on a genetic algorithm. Based on the characteristics of millimeter-wave radar multipath echo data, the ghost position of the target is obtained through BP imaging, and the principle conforms to the multipath propagation model in a non-line-of-sight environment. Then, street width is used to characterize the building street layout information. Based on the geometric relationship between the position of the target and the ghost, an objective function including the unknown street width is established. The objective function is optimized through a genetic algorithm to obtain the accurate position and street width of the target. In other words, the present invention can realize non-line-of-sight target positioning under the condition of unknown building layout, and is an effective target positioning method with higher target positioning accuracy. The present invention is particularly suitable for a typical L-shaped urban block model, and provides technical support for target positioning under a generalized non-line-of-sight model. BRIEF DESCRIPTION OF THE DRAWINGS
[0047] Figure 1 It is a diagram showing the relationship between ghost and target positions and a scene diagram simulated by the method of the present invention;
[0048] Figure 2 This is the ghost imaging result of the simulation experiment;
[0049] Figure 3 This is the ghost position extraction result diagram of the simulation experiment;
[0050] Figure 4 is the genetic algorithm optimization process curve of the simulation experiment;
[0051] Figure 5 This is the result of 50 Monte Carlo experiments in the simulation experiment;
[0052] Figure 6 It is a scene diagram taken by the method of the present invention;
[0053] Figure 7 This is the ghost position extraction result diagram of the measured experiment;
[0054] Figure 8 It is the genetic algorithm optimization process curve of the measured experiment. DETAILED DESCRIPTION
[0055] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application.
[0056] A non-line-of-sight (NLOS) UAV positioning method based on a genetic algorithm is provided. The target to be measured is located in a non-line-of-sight blind spot formed by the corner occlusion of an L-shaped street. The positioning method comprises the following steps:
[0057] S1: Obtain a set of multipath ghost positions of the target to be measured through the BP image containing the multipath ghost information of the UAV, specifically including the following steps:
[0058] S11: Processing BP image I using Gaussian smoothing filter BP , and obtain the smoothed image I S At the same time, the method for obtaining the BP image containing the multipath ghost information of the UAV is:
[0059] S11a: A millimeter-wave radar system with M transmitters and N receivers is used to collect multipath echo signals of the target under test in the non-line-of-sight blind zone;
[0060] S11b: Suppress the background clutter of multipath echo signals through the moving target detection technology MTI;
[0061] S11c: Perform FFT processing on the multipath echo signal after clutter suppression to obtain a range-time diagram of M×N channels;
[0062] S11d: Divide the imaging area of the millimeter wave radar system into X×Y grids and calculate the time delay τ corresponding to each grid q on each channel m,n (q):
[0063]
[0064] Among them, τ m (q) represents the electromagnetic wave transmitted from the mth transmitting antenna T m The delay along the straight line to the grid q, τ n (q) represents the electromagnetic wave propagating from the grid q along a straight line to the nth receiving antenna R n The delay, ||qT m || is the grid q to the mth transmitting antenna T m The distance, ||qR n || is the grid q to the nth receiving antenna R n distance, c is the speed of light, m=1,2,..,M, n=1,2,..,N;
[0065] S11e: Match the multi-channel amplitudes for each grid point in the imaging area to obtain a BP image containing the multipath ghost information of the UAV. The amplitude corresponding to any grid point on any channel is determined as follows:
[0066] Get the delay τ corresponding to the current grid point on the current channel m,n (q), obtain the time delay τ on the distance-time graph m,n (q) The mth transmitting antenna T m With the nth receiving antenna R n The distance of the formed channel is taken as the amplitude of the current grid point on the current channel;
[0067] S12: Suppressing smooth image I using CA-CFAR threshold detection methodS Grating lobe in the image is obtained, and the grating lobe suppression image I is obtained. c , where the grating lobe suppression image I c The pixel value corresponding to each grid point I c (q) is calculated as:
[0068]
[0069] Among them, I s (q) is the suppressed smoothed image I S The pixel value of the qth grid point on the left is α, which is the set detection threshold in the CA-CFAR threshold detection method;
[0070] S13: Grating lobe suppression image I c Perform binarization processing to obtain a binary image;
[0071] S14: Using the eight-connectivity algorithm to obtain connected domains in the binary image, and using the centroid of each connected domain as the multipath ghost position, wherein the number of connected domains is at most 3; the centroid of any connected domain is obtained as follows:
[0072]
[0073] Among them, G p (x p ,y p ) is the centroid coordinate of the pth connected domain, (x k,p ,y k,p ) is the coordinate of the kth grid in the pth connected domain, N p is the number of grids in the pth connected domain, p = 1, 2, …, P.
[0074] S2: Obtain a mapping relationship between the true ghost position of the target to be measured formed on each reflection path of the radar electromagnetic wave reflected multiple times by the L-shaped street and the true position of the target to be measured, where each reflection forms a true ghost position, and the true ghost positions formed on the first P reflection paths with the largest reflection intensity are used to construct the objective function, where P is the number of paths in the multipath ghost position;
[0075] Construct a typical non-line-of-sight urban environment with an "L"-shaped street layout, such as Figure 1 As shown, the street width is represented by D1, and the radar T(x t ,y t ) to the wall 1 is represented by D2, and the radar T(x t ,y t ) to wall 3 is represented by D3, and the position of corner C is (x c ,y c ), set the target real position U(xu ,y u ) is located at the radar T(x t ,y t (where the position is known) within the non-line-of-sight region. D3 is a known quantity, while D1 and D2 are unknown quantities.
[0076] The transformation relationship for determining building layout parameters is:
[0077]
[0078] It should be noted that the radar electromagnetic wave will be reflected multiple times on the L-shaped street and have different reflection paths. However, the energy of the radar electromagnetic wave is severely attenuated after three reflections and can be ignored. Therefore, the present invention only calculates the ghost position within three reflections.
[0079] Based on this, the mapping relationship between the true position of each ghost image and the true position of the target to be measured is as follows:
[0080] G 11 (x 11 ,y 11 )=(x t -2D2-x u ,y u )
[0081] G 22 (x 22 ,y 22 )=(x u -2D1,y u )
[0082] G 33 (x 33 ,y 33 )=(2x t -2D2-2D1-x u ,y u )
[0083] Among them, G 11 (x 11 ,y 11 ) is the real position of the ghost image formed by the target on the reflection path of the first reflection of the radar electromagnetic wave, G 22 (x 22 ,y 22 ) is the real position of the ghost image formed by the target on the reflection path of the second reflection of the radar electromagnetic wave, G 33 (x 33 ,y 33 ) is the real position of the ghost image formed by the target on the reflection path of the third reflection of the radar electromagnetic wave, (x u ,y u) is the actual position of the target to be measured, (x t ,y t ) is the position of the radar, D1 is the street width of the L-shaped street in the non-line-of-sight blind spot, and D2 is the distance from the radar to the wall of the L-shaped street in the non-line-of-sight blind spot.
[0084] S3: Construct the objective function based on the multipath ghost position and the true ghost position of the target to be measured as follows:
[0085]
[0086] Among them, (x e ,y e ) is the estimated position value of the target to be measured, G est is the position set composed of the real positions of each ghost represented by the mapping relationship, G ref is the location set consisting of multipath ghost locations, ||·|| represents the bi-norm, D1 is the street width, and argmin represents the value when the objective function reaches its minimum (x e ,y e ), the value of D1;
[0087] S4: Use genetic algorithm to optimize the objective function and obtain the position estimate of the target to be measured (x e ,y e ) and street width D1, specifically comprising the following steps:
[0088] S41: (x e ,y e ) and D1 as different individuals to obtain the initial population, where the number of individuals is G;
[0089] S42: Determine whether each individual satisfies two set conditions x c <x e <x c +D1 and Where D1 is the width of the L-shaped street in the non-line-of-sight blind spot, x c is the horizontal coordinate of the corner of the L-shaped street, is the average value of the ordinates of the true positions of the ghosts represented by the mapping relationship; the constraint violation counter conv corresponding to the individual that does not meet the two set conditions is recorded as 2, the constraint violation counter conv corresponding to the individual that meets one of the set conditions is recorded as 1, and the constraint violation counter conv corresponding to the individual that meets both set conditions is recorded as 0;
[0090] S43: Calculate the objective function value corresponding to each individual;
[0091] S44: Use simulated binary crossover and uniform mutation methods to evolve each individual in the previous generation population to obtain a new population after crossover and mutation;
[0092] S45: Calculate the objective function value corresponding to each individual in the new population, and determine the constraint violation counter conv corresponding to each individual in the new population according to the number of set conditions satisfied by the new population;
[0093] S46: Select the first G individuals with the smallest objective function value from the new population individuals whose constraint violation counter conv is 0 to form the next generation population;
[0094] S47: The next generation population obtained in step S46 is used as the previous generation population in step S44, and then steps S44 to S47 are repeated until the set number of iterations is reached, and then step S48 is entered;
[0095] S48: Select the best individual in all iterations as the final position estimate of the target to be measured (x e ,y e ) and the estimated street width D1, where the optimal individual satisfies: the constraint violation counter conv is 0 and the objective function value is the smallest.
[0096] The following takes the number of iterations H=50 and the number of individuals G=50 as an example to describe in detail the process of optimizing the objective function using the genetic algorithm of the present invention.
[0097] First, initialize the parameters of the genetic algorithm and set the following constraints using the positional relationship between the target location and the building block:
[0098] (1) The target is located within the street interval, that is, x c <x u <x c +D1;
[0099] (2) The difference between the y-axis coordinates of the target and the extracted ghost point is no more than 0.2, that is,
[0100] If an individual violates a constraint, the constraint violation counter conv is incremented by 1, and the individual is evolved by simulating binary crossover (SBX) and uniform mutation. The crossover probability P1 is set to 0.9, that is, when the random number generated between (0,1) is greater than P1, crossover evolution is performed. If two parent individuals p1 and p2 are crossed, two offspring c1 and c2 can be generated, which can be expressed as
[0101]
[0102] Where a is a constant with a value of 0.5. β is dynamically controlled by the parameters of the crossover distribution and is calculated as follows:
[0103]
[0104] Among them, rand is a random number in the interval (0,1). T is a constant, and its value is 0.5. μ is a parameter that controls the crossover distribution. The larger its value, the smaller the difference between the offspring and the parent individuals. In the present invention, μ=10 is set. The probability of mutation P2 is set to 0.04. For each individual after the crossover, a random number in the interval (0,1) is generated. If the random number is greater than P2, the individual mutates. The present invention adopts a uniform mutation method, that is, by randomly extracting the mutation amount from the uniform distribution in the interval (0,1), and adding the mutation amount to the individual, a new individual after mutation is generated. After obtaining the new population after the crossover mutation, the competitive selection method is used for environmental selection. The individual with the highest fitness and the lowest conv value is selected as the winner, and is used as the individual of the next generation population.
[0105] Repeat the above crossover, mutation, and selection operations. After 50 iterations, the optimal individual is selected as the parameter estimation result.
[0106] The simulation and actual measurement verification are carried out below.
[0107] Simulation scenario such as Figure 1 As shown in Figure 1, an L-shaped non-line-of-sight scenario model is constructed, and the gprMax software is used to simulate the electromagnetic echo in this scenario. The target is set to be in the non-line-of-sight blind zone of the radar. The specific simulation parameters are shown in Table 1.
[0108] Table 1 Simulation experiment parameter settings
[0109]
[0110] Figure 2 It is a ghost image processed by the method proposed by the present invention, Figure 3 This is the ghost position extraction result after processing in step 4. Considering the serious attenuation of high-order reflection signals in actual measurement, only the ghosts formed by the first three paths are used. Figure 4 The blue line is the average degree of constraint violation. As the iterations increase, the degree of constraint violation decreases rapidly and approaches 0, indicating that the optimization process is effectively finding the optimal solution that meets the constraints. The red line is the objective function value, indicating that the genetic algorithm is constantly looking for the optimal solution. The target position estimation result is (2.55m, 2.01m), and the error compared with its true value (2.45m, 2.0m) is 0.11m. The street width estimation value is 3.03m, and the error compared with the true value is 0.03m. In order to further analyze the feasibility of the method proposed in this invention, the target position is randomly generated and the Monte Carlo experiment is carried out for verification. Figure 5The experimental error curve is unfolded, where the blue curve represents the street width error and the red curve represents the drone position error. After 50 experiments, the root mean square error (RMES) of the drone position is 0.086, and the RMES of the street width is 0.128m.
[0111] At the same time, in order to verify the practicability of the method proposed in this invention, the IWR6843ISK millimeter wave radar is used to conduct a measurement experiment. The experimental scene is as follows: Figure 6 As shown in Figure 2, the rotorcraft UAV is placed in the non-line-of-sight blind spot of the radar, and the parameter settings of the actual measurement experiment are shown in Table 2.
[0112] Table 2 Parameter settings of the measured experiment
[0113]
[0114] Based on the multipath echo data collected by field measurement, Figure 7 is the extracted ghost position, Figure 8 For the optimization process curve, as the number of iterations increases, the average constraint violation and the optimal objective function value gradually converge and approach 0, indicating that the optimal solution satisfies both the objective function and the constraints. The target position is estimated to be (1.08m, 1.33m), and the street width is estimated to be 1.60m.
[0115] The present invention provides a non-line-of-sight UAV positioning method based on a genetic algorithm. In this method, the ghost position is calculated by using the traditional BP imaging method, which reflects the virtual target position corresponding to each propagation path in the imaging area. Then, the building layout information is parameterized, and the street spacing is used to characterize the building layout information in combination with the building geometric relationship. An objective function is established based on the positional relationship between the ghost and the target, and a genetic algorithm is used for optimization to obtain an accurate UAV target position. Compared with existing methods, the proposed method can effectively solve the problem of UAV target positioning when the building layout is unknown. Both simulation experiments and actual measurement experiments show that the present invention can accurately obtain the target position and is an effective non-line-of-sight UAV target positioning method.
[0116] Of course, the present invention may have many other embodiments. Without departing from the spirit and essence of the present invention, those skilled in the art may of course make various corresponding changes and modifications based on the present invention, but these corresponding changes and modifications should all fall within the scope of protection of the claims attached to the present invention.
Claims
1. A non-line-of-sight UAV positioning method based on genetic algorithm, characterized in that: The target to be measured is located in a non-line-of-sight blind spot formed by the corner of an L-shaped street; the positioning method includes the following steps: S1: Obtain a set of multipath ghost positions of the target to be measured through the BP image containing the multipath ghost information of the UAV, specifically: Processing BP images using Gaussian smoothing filter , and obtain a smooth image ; Suppressing smooth images using CA-CFAR threshold detection method Grating lobe in the image is obtained , where the grating lobe suppression image The pixel value corresponding to each grid point The calculation method is: in, To suppress smooth images The pixel value of the qth grid point on the Setting the detection threshold for CA-CFAR threshold detection method; Grating lobe suppression image Perform binarization processing to obtain a binary image; The eight-connectedness algorithm is used to obtain the connected domains in the binary image, and the centroid of each connected domain is used as the multipath ghost position. The number of connected domains is at most 3. S2: Obtain a mapping relationship between the true ghost position of the target to be measured formed on each reflection path of the radar electromagnetic wave reflected multiple times by the L-shaped street and the true position of the target to be measured, where each reflection forms a true ghost position, and the true ghost positions formed on the first P reflection paths with the largest reflection intensity are used to construct the objective function, where P is the number of paths in the multipath ghost position; Assuming P = 3, the mapping relationship between the true position of each ghost image and the true position of the target to be measured is as follows: in, It is the real position of the ghost image formed by the target on the reflection path of the first reflection of the radar electromagnetic wave. It is the real position of the ghost image formed by the target on the reflection path of the second reflection of the radar electromagnetic wave. It is the real position of the ghost image formed by the target on the reflection path of the third reflection of the radar electromagnetic wave. is the actual position of the target to be measured, is the radar position, is the width of the L-shaped street in the non-line-of-sight blind spot, The distance from the radar to the wall of the L-shaped street in the non-line-of-sight blind spot; S3: Construct the objective function based on the multipath ghost position and the true ghost position of the target to be measured as follows: in, is the estimated position of the target to be measured, is a position set consisting of the real positions of each ghost represented by the mapping relationship, is the set of positions consisting of multipath ghost positions, represents the two-norm, is the street width, argmin represents the time when the objective function reaches the minimum value 、 The value of S4: Use genetic algorithm to optimize the objective function and obtain the position estimate of the target to be measured and street width , specifically: S41: will have different initial values and As different individuals, we get the initial population, where the number of individuals is G; S42: Determine whether each individual satisfies two set conditions and ,in, is the width of the L-shaped street in the non-line-of-sight blind spot, is the horizontal coordinate of the corner of the L-shaped street, is the average value of the ordinates of the true positions of the ghosts represented by the mapping relationship; the constraint violation counter conv corresponding to the individual that does not meet the two set conditions is recorded as 2, the constraint violation counter conv corresponding to the individual that meets one of the set conditions is recorded as 1, and the constraint violation counter conv corresponding to the individual that meets both set conditions is recorded as 0; S43: Calculate the objective function value corresponding to each individual; S44: Use simulated binary crossover and uniform mutation methods to evolve each individual in the previous generation population to obtain a new population after crossover and mutation; S45: Calculate the objective function value corresponding to each individual in the new population, and determine the constraint violation counter conv corresponding to each individual in the new population according to the number of set conditions satisfied by the new population; S46: Select the first G individuals with the smallest objective function value from the new population individuals whose constraint violation counter conv is 0 to form the next generation population; S47: The next generation population obtained in step S46 is used as the previous generation population in step S44, and then steps S44 to S47 are repeated until the set number of iterations is reached, and then step S48 is entered; S48: Select the best individual in all iterations as the final position estimate of the target to be measured and street width estimates , where the optimal individual satisfies: the constraint violation counter conv is 0 and the objective function value is the smallest.
2. The non-line-of-sight UAV positioning method based on genetic algorithm according to claim 1, characterized in that: The method for obtaining the BP image containing the multipath ghost information of the UAV is as follows: The millimeter-wave radar system with M transmitters and N receivers is used to collect multipath echo signals of the target to be measured in the non-line-of-sight blind zone; Suppress the background clutter of multipath echo signals through moving target detection technology MTI; Perform FFT processing on the multipath echo signal after clutter suppression to obtain the distance-time diagram of M×N channels; Divide the imaging area of the millimeter wave radar system into X×Y grids and calculate the time delay corresponding to each grid q on each channel : in, Indicates that the electromagnetic wave is transmitted from the mth transmitting antenna The time delay of propagating along the straight line to the grid q is, Indicates that the electromagnetic wave propagates from the grid q along a straight line to the nth receiving antenna The delay, For grid q to the mth transmitting antenna distance, For grid q to the nth receiving antenna distance, is the speed of light, m=1,2,..,M, n=1,2,..,N; Match the multi-channel amplitudes for each grid point in the imaging area to obtain a BP image containing the multipath ghost information of the drone. The amplitude corresponding to any grid point on any channel is determined as follows: Get the delay corresponding to the current grid point on the current channel , get the delay on the distance-time graph The mth transmitting antenna With the nth receiving antenna The distance of the formed channel is used as the amplitude of the current grid point on the current channel.
3. The non-line-of-sight UAV positioning method based on genetic algorithm according to claim 1, characterized in that: The method to obtain the centroid of any connected domain is: in, is the centroid coordinate of the pth connected domain, is the coordinate of the kth grid in the pth connected domain, is the number of grids in the pth connected domain, p=1,2,…,P.
Citation Information
Patent Citations
Outdoor non-line-of-sight propagation single-station positioning method based on scattering region model
CN114513849A
Wide-range complex environment UWB base station comprehensive layout method considering non-line-of-sight influence
CN116709346A