FM Signal-Based Unmanned Aerial Vehicle (UAV) Swarm Crash Prevention Positioning and Navigation System and Method
By adding an FM signal transceiver module and a positioning and navigation mode switching module to the UAV, and combining Gaussian filtering and the least squares method to estimate the path loss model, the problem of inaccurate positioning of UAV swarms in complex environments is solved, achieving low-cost and reliable positioning and navigation, and ensuring the safe landing of UAVs.
Patent Information
- Application Number
- CN202311553633.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-11-21
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2043-11-21
AI Technical Summary
Existing technologies struggle to provide reliable, low-cost positioning and navigation support for drone swarms in densely built-up and complex terrain environments, especially when onboard positioning and navigation functions fail, leading to frequent drone crashes.
A drone swarm crash prevention positioning and navigation system based on FM signals is adopted. By adding an FM signal transceiver module and a positioning and navigation mode switching module, the wide coverage and anti-interference capability of FM signals are utilized, combined with Gaussian filtering and least squares method to estimate the path loss model, to achieve safe positioning and navigation of drones.
Under low cost and low power consumption conditions, the reliability and accuracy of UAV positioning are improved, ensuring that UAVs can land safely when out of control, and reducing the complexity of positioning algorithms and computational requirements.
Smart Images

Figure CN117572342B_ABST
Abstract
Description
Technical Field
[0001] This invention belongs to the field of wireless navigation technology, and specifically relates to a drone swarm anti-crash positioning and navigation system based on FM signals. It can be used in scenarios where a large-scale drone swarm crashes due to the failure of the original onboard positioning and navigation functions, ensuring the safe flight and landing of drones. Background Technology
[0002] With continuous breakthroughs in flight control, navigation, and communication technologies, unmanned aerial vehicles (UAVs), as autonomous aircraft, have attracted widespread attention. Their unique characteristics, such as high maneuverability, small size, high efficiency, and high flexibility, have demonstrated increasing application potential in various fields. Aircraft positioning technology, a key technology in UAV research, is crucial for UAV path planning, safe flight, and task allocation. In recent years, high-altitude UAV swarms have frequently experienced large-scale crashes and collisions due to the failure or loss of control of their onboard positioning and navigation functions caused by human-induced electromagnetic attacks or other interference. Therefore, there is an urgent need for safe and reliable UAV swarm crash prevention positioning and navigation methods and systems.
[0003] FM (Frequency Modulation) is a traditional analog modulation method. Its low signal propagation frequency (87-110MHz) gives it strong penetration and anti-interference capabilities. With its advantages of wide coverage, low equipment cost, and low power consumption, it has been widely used in broadcasting and television for half a century. This invention aims to utilize the many advantages of FM signals and their transceivers to provide safe, reliable, and low-cost assisted positioning and navigation for drones in densely built-up urban environments, offering a new approach to drone swarm safety and crash prevention technology research. However, existing FM signal-based positioning technologies are all applied to wide-area coarse positioning. Due to the relatively large ranging error of the signal itself, its application in drone swarm safety and crash prevention still has room for improvement in positioning reliability.
[0004] This invention targets small unmanned aerial vehicle (UAV) swarms with limited computing power and payload. It addresses various positioning scenarios in complex and varied flight terrains, such as urban and wilderness environments. Under conditions of low-cost positioning system deployment and low-computing-power, low-power onboard navigation modules, it provides safe, reliable, and accurate crash-prevention assisted positioning and automatic navigation for out-of-control UAV swarms, enabling them to make a safe forced landing and effectively reducing loss of life and property caused by accidents. Based on these background conditions, researching UAV swarm crash-prevention positioning and navigation methods based on FM signals is of great significance for ensuring the safe flight and landing of UAVs.
[0005] In their paper "Improvement in the UAV positionestimation with low-cost GPS, INS and vision-based system: Application to aquadrotor UAV" (2018 International Conference on Unmanned Aircraft Systems (ICUAS)), L. Arreola et al. developed a hardware and software-based UAV position estimation system. This system utilizes low-cost GPS, commercially available autonomous driving sensors, and a dense optical flow algorithm in an onboard microcomputer to track the trajectory of hovering and outdoor UAVs. However, because GPS signals are transmitted in the L1 band (1575.42 MHz) and the L2 band (1227.60 MHz), they are susceptible to electromagnetic attacks and human interference. This makes it difficult to provide reliable positioning support for UAVs in complex and variable scenarios such as densely built-up urban areas and rugged terrain. Furthermore, the system places high demands on the variability of sensor positions and the processing power of the processor, making it difficult to implement at a low cost.
[0006] In their paper "Season-Invariant GNSS-Denied VisualLocalization for UAVs" (IEEE Robotics and Automation Letters (Volume: 7, Issue: 4, October 2022)), D. Scaramuzza et al. proposed a localization method that matches UAV camera images with georeferenced orthophotos. This method uses a trained convolutional neural network model to achieve stability of UAV localization results in seasonally changing environments. However, vision-based localization methods are extremely sensitive to lighting conditions and cannot work in dim or dark scenes. They also require high image clarity, have high algorithmic complexity, and require high-quality, expensive camera equipment and high-bandwidth networks for real-time image transmission. These drawbacks, including high deployment costs and weight limitations, make them unsuitable for small UAV localization and navigation systems.
[0007] In their paper "3D Maximum Likelihood Estimation Positioning Algorithm Based on RSSI Ranging" (2017 IEEE 2nd Advanced Information Technology, Electronic and Automation Control Conference (IAEAC)), Rui Qiang et al. proposed a three-dimensional weighted maximum likelihood estimation positioning algorithm based on RSSI ranging values. This algorithm uses a diagonal weighting matrix composed of squared distances as weighting factors to calculate the position, achieving improved positioning accuracy under the same ranging error range. While this method improves positioning accuracy under the same RSSI ranging error, in positioning scenarios with limited anchor node deployment and complex, variable environments, the RSSI ranging accuracy of FM signals exhibits instability, leading to a decline in positioning performance. Summary of the Invention
[0008] The purpose of this invention is to address the shortcomings of the prior art by proposing a drone swarm crash prevention positioning and navigation system based on FM signals. This system reduces the cost of deploying FM positioning anchor nodes, improves the reliability of drone positioning results under low-power requirements and low-power-constraint conditions, and reduces the complexity of the positioning algorithm. It enables drones to automatically acquire their real-time three-dimensional position information during an uncontrolled fall and then navigate to a pre-deployed drone safety capture area to achieve a safe landing.
[0009] The technical solution to achieve the objective of this invention is as follows:
[0010] 1. A drone swarm crash prevention positioning and navigation system based on FM signals, comprising a drone flight data module 1, characterized in that it further comprises an FM signal transceiver module 2 and a positioning and navigation mode switching module 3;
[0011] The FM signal transceiver module 2 includes:
[0012] Airborne FM signal transceiver module 21 is used to transmit FM signals and receive FM signals transmitted by anchor FM signal transceiver module 22;
[0013] An anchor FM signal transceiver module 22 is used to transmit FM signals and receive signals transmitted by the airborne FM signal transceiver module 21 and the anchor FM signal transceiver module 22. ;
[0014] The positioning and navigation mode switching module 3 is used to transmit the data received by the airborne FM signal transceiver module 21 to the UAV flight data module 1 for FM positioning and navigation when the airborne positioning fails.
[0015] Furthermore, the UAV flight data module 1, the airborne FM signal transceiver module 21, and the positioning and navigation mode switching module 3 are installed inside the UAV fuselage; the anchor FM signal transceiver module 22 is deployed in the UAV flight scenario; and the modules are wirelessly connected to each other.
[0016] Furthermore, the UAV flight data module 1 includes:
[0017] Data processing submodule 1 is used to process data from FM signal transceiver module 2;
[0018] Positioning submodules 1 and 2 are used to calculate the real-time position of the UAV;
[0019] Navigation submodules 1 and 3 are used to correct the dynamic trajectory of the UAV.
[0020] 2. A method for crash prevention positioning and navigation of unmanned aerial vehicle (UAV) swarms using the above system, characterized by comprising the following steps:
[0021] 1) Using the anchor FM signal transceiver module 2, perform real-time least squares estimation on the existing logarithmic path loss model to obtain the reference path loss estimate for environmental parameters. and environmental parameter path loss factor estimation value ,
[0022] 2) Airborne FM signal transceiver module 2.1 collects the FM signal strength value transmitted and received by the anchor FM signal transceiver module 2.2 in real time. The signal is then transmitted to the data processing submodule 11 for Gaussian filtering to obtain a stable received signal strength value. ;
[0023] 3) Using reference path loss estimates and path loss factor estimate Received signal strength value Convert to distance measurement value ;
[0024] 4) In positioning submodules 1 and 2, based on the distance measurement value... The set of three-dimensional position coordinates of the anchor FM signal transceiver module 2. Calculate the uncertain information of the respective positions of the anchor FM signal transceiver modules 2 and 2. Sort and select to obtain An initial screening of anchor FM signal transceiver modules 2 2 three-dimensional coordinate set ;
[0025] 5) From the initial screening Any one of the anchor FM signal transceiver modules 2. Components Various combinations For each combination, calculate its condition number to obtain the set of condition numbers for all combinations. ,filter A set of three-dimensional coordinates for a reliable anchor FM signal transceiver module 2. and its distance measurement value , so as to participate in the calculation of subsequent positioning algorithms;
[0026] 6) A three-dimensional coordinate set composed of a reliable anchor FM signal transceiver module 2. and its distance measurement value An improved weighted centroid localization estimation based on altitude weighting is performed on the UAV to be located:
[0027] 6a) From Any one of the anchor FM signal transceiver modules 2. Components Various combinations ;Utilizing the three-dimensional position information and ranging value of anchor FM signal transceiver module 22 in each combination For each combination While positioning, the location of the drone to be positioned is obtained. Preliminary three-dimensional position estimate ;
[0028] 6b) Using the ranging value of anchor FM signal transceiver module 2 in each combination Calculate each preliminary three-dimensional position estimate corresponding weighted values , ;
[0029] 6c) will As a weighting factor, the secondary three-dimensional position estimate of the UAV to be located is calculated using the weighted centroid localization algorithm. ;
[0030] 6d) Using secondary three-dimensional position estimates Calculate its horizontal distance from each anchor FM signal transceiver module 2. ;
[0031] 6e) Utilizing horizontal distance calculate Estimated altitude of the drone to be located ;
[0032] 6f) Utilize estimated height Establish a height-weighted function to obtain the height. The corresponding weighted value set ; through weighted values right The final altitude estimate coordinates of the UAV to be located are obtained by performing weighted averaging. ;
[0033] 7) From the quadratic position estimate With the corrected height value Together constitute Time-estimated three-dimensional position coordinates of the UAV to be located ;
[0034] 8) Repeat steps 6) and 7) to obtain the three-dimensional position coordinates of the UAV to be located at consecutive time points. ,use , , 3D position coordinates of the drone at any given time , , Calculation of drones Real-time acceleration in the height direction at all times ;
[0035] 9) Set the acceleration threshold in the altitude direction based on the actual flight speed and maximum acceleration of the UAV. ,when Greater than or equal to At that time, the airborne positioning and navigation is switched to FM positioning and navigation through the positioning and navigation mode switching module 3;
[0036] 10) Navigation submodule 1 (3 pairs) Mean filtering is performed to obtain the flight trajectory. Ensure that the drone is navigated to a safe capture area.
[0037] Compared with existing technologies, the present invention has the following advantages:
[0038] First, this invention adds an FM signal transceiver module 2 to the original airborne positioning and navigation system to transmit and receive FM signals. It can take advantage of the low propagation frequency, wide coverage, low equipment cost, low power consumption, strong penetration and anti-interference capabilities of FM signals, so as to achieve safe, reliable and low-cost auxiliary positioning and navigation of UAVs in densely built urban environments.
[0039] Secondly, this invention adds a positioning and navigation mode switching module 3 to the original airborne positioning and navigation system to switch the positioning mode of the out-of-control UAV, thereby providing a reliable positioning and navigation mode for the out-of-control UAV when the airborne positioning function fails due to electromagnetic interference, ensuring the flight safety of the UAV.
[0040] Third, this invention corrects the collected RSSI values by using a Gaussian filtering model, filtering out some singular values and low-probability RSSI values, reducing errors caused by fluctuations in ranging signal propagation, and improving the stability of RSSI values. At the same time, by using the linear least squares method to estimate the environmental parameters of the path loss model in real time, the FM's own ranging error can be adaptively corrected and improved according to the actual flight scenario of the UAV, providing relatively accurate ranging information for subsequent positioning.
[0041] Fourth, based on two key factors—the distance information between the anchor FM signal transceiver module 22 and the UAV to be located, and the position information of the anchor FM signal transceiver module 22 itself—this invention provides an optimal selection strategy for the anchor FM signal transceiver module 22. That is, by having a small number of reliable anchor FM signal transceiver modules 22 participate in the positioning, information redundancy is reduced, and the problem of excessive computational complexity caused by an excessive number of anchor nodes participating in the positioning in the prior art is overcome.
[0042] Fifth, the present invention obtains preliminary position estimates of several UAVs to be located by using a multi-group anchor FM signal transceiver module 22 for multilateral positioning, and then uses an improved centroid positioning algorithm based on altitude weighting to obtain the final position estimate. This two-step positioning method overcomes the problem of low accuracy of existing centroid positioning technology, enabling the present invention to improve the reliability of the positioning system while ensuring low-complexity positioning. Attached Figure Description
[0043] Figure 1 This is a schematic diagram of the UAV anti-fall positioning and navigation system of the present invention;
[0044] Figure 2 This is a schematic diagram of the anchor node deployment distribution in the positioning and navigation method of the present invention;
[0045] Figure 3 This is a flowchart illustrating the implementation of the UAV crash prevention positioning and navigation method of the present invention.
[0046] Figure 4 This is a schematic diagram of UAV altitude correction in the positioning and navigation method of the present invention;
[0047] Figure 5 These are comparison charts showing the absolute altitude error of UAV positioning using the present invention and existing technologies under different anchor node height differences;
[0048] Figure 6 These are comparison charts showing the absolute altitude error of UAV positioning using the method of this invention and existing technologies under different numbers of anchor nodes.
[0049] Figure 7 These are comparison charts showing the absolute altitude error of UAV positioning under different ranging errors using the method of this invention and existing technologies.
[0050] Figure 8 These are cumulative error distribution diagrams obtained by using the mean filtering of the UAV flight trajectory in the method of this invention. Detailed Implementation
[0051] The embodiments and effects of the present invention will be described in further detail below with reference to the accompanying drawings.
[0052] Reference Figure 1 This invention relates to an FM signal-based UAV swarm crash prevention positioning and navigation system, comprising a UAV flight data module 1, an FM signal transceiver module 2, and a positioning and navigation mode switching module 3. The UAV flight data module 1 processes the positioning signal data received by the UAV, enabling both positioning and navigation functions. The FM signal transceiver module 2 transmits and receives FM signals, providing data support for FM positioning. The positioning and navigation mode switching module 3 switches between onboard positioning and FM positioning when onboard positioning fails due to electromagnetic interference, ensuring a safe landing for the UAV.
[0053] The UAV flight data module 1 includes a data processing submodule 11, a positioning submodule 12, and a navigation submodule 13. The data processing submodule 11 is used to process the data from the FM signal transceiver module 2; the positioning submodule 12 is used to calculate the real-time position of the UAV; and the navigation submodule 13 is used to correct the dynamic trajectory of the UAV.
[0054] The FM signal transceiver module 2 includes an airborne FM signal transceiver module 21 and... FM signal transceiver module 22, Among them, the airborne FM signal transceiver module 21 is used to transmit FM signals and receive signals transmitted by the FM signal transceiver module 22; the anchor FM signal transceiver module 22 is used to transmit FM signals and receive signals transmitted by the airborne FM signal transceiver module 21 and the anchor FM signal transceiver module 22.
[0055] The aforementioned UAV flight data module 1, airborne FM signal transceiver module 2, and positioning and navigation mode switching module 3 are all housed within the UAV fuselage; the anchor FM signal transceiver module 2 is deployed within the UAV flight environment, with the specific deployment distribution as shown below. Figure 2As shown, due to the limitations imposed by surrounding buildings, the deployment of anchor FM transceiver modules 2 2 at a certain height exhibits non-uniform and random characteristics, and the deployment cost is high, so the number of deployments is limited; ground-deployed anchor FM transceiver modules 2 2, due to terrain limitations, can exhibit relatively uniform and dense distribution characteristics in wide and flat areas.
[0056] The modules communicate wirelessly. The airborne FM signal transceiver module 21 receives signals from all anchor FM signal transceiver modules 22 pre-deployed in the flight scenario in real time, transmits the data to the data processing submodule 11 in the UAV flight data module 1 to preprocess the data, and transmits the processed data to the positioning submodule 12 to calculate the UAV's real-time position. The positioning and navigation mode switching module 3 receives the UAV's own positioning data obtained from the positioning submodule 12, determines whether a crash has occurred, and switches to FM positioning and navigation mode when the UAV crashes. The navigation submodule 13 receives the real-time position information transmitted by the positioning submodule 12 and performs trajectory tracking on the UAV to achieve FM anti-crash assisted positioning and navigation for the UAV, ensuring the safe landing of the UAV.
[0057] Reference Figure 3 The method for using the above system for anti-crash positioning and navigation of drone swarms involves the following steps:
[0058] Step 1, Reference path loss of environmental parameters and environmental parameters path loss factor Make an estimate.
[0059] 1.1) Select A reliable anchor FM signal transceiver module 2 participates in environmental parameter estimation. This example assumes, but is not limited to, [a specific configuration]. ;
[0060] 1.2) Using measuring tools, obtain the pre-selected reliable anchor FM signal transceiver module 2 and the rest. Distance between anchor FM signal transceiver modules 2 and 2 :
[0061]
[0062] in, This indicates that the reliable anchor FM signal transceiver module 2 and the second... The distance between the two anchor FM signal transceiver modules 2;
[0063] 1.3) Using distance values Calculate the parameter matrix :
[0064] ;
[0065] 1.4) The remaining data collected by the reliable anchor FM signal transceiver module 22 The received signal strength of the anchor FM signal transceiver module 22 is obtained by using the Gaussian filtering method in step 1) to obtain a stable received signal strength value. :
[0066]
[0067] in, Indicates the obtained first The stable received signal strength value of the anchor FM signal transceiver module 2;
[0068] 1.5) Using the parameter matrix and received signal strength value The estimated environmental parameter reference path loss is calculated using the following formula. and environmental parameter path loss factor estimation value :
[0069] ;
[0070] Step 2, Real-time acquisition of received signal strength Gaussian filtering is then applied to obtain a stable received signal strength. For signal strength value Transform it.
[0071] 2.1) Airborne FM signal transceiver module 2.1 Acquisition The FM signal strength value transmitted by the anchor FM transceiver module 2. :
[0072]
[0073] in, This indicates that the airborne FM signal transceiver module 2.1 collected the first... The FM signal strength value transmitted by the anchor FM transceiver module 2. This indicates that the airborne FM signal transceiver module 2.1 collected the first... The anchor FM signal transceiver module 2 2 One data point, , For the first The amount of received signal strength data collected by the anchor FM signal transceiver module 2 in this example is, but not limited to, the following. ;
[0074] 2.2) For the collected data from the first... FM signal transceiver module 2 FM received signal strength value Gaussian filtering is performed to obtain the filtered received signal strength value. :
[0075]
[0076] in, Indicates the number of collections The anchor FM signal transceiver module 2 2 One data point;
[0077] 2.3) Received signal strength value after filtering Stable received signal strength values are obtained by averaging. :
[0078] ;
[0079] 2.4) By The stable received signal strength value that constitutes all anchor FM signal transceiver modules 2 2 :
[0080] .
[0081] 2.5) Using reference path loss estimates and path loss factor estimate Received signal strength value Convert to distance measurement value :
[0082]
[0083] in, Indicates the first The distance measurement value between the anchor FM signal transceiver module 2 and the UAV to be located.
[0084] Step 3: Perform initial screening of the anchor FM signal transceiver module 2.
[0085] 3.1) Calculate the set of uncertain information using the distance measurements between each anchor FM signal transceiver module 2 and the UAV to be located. :
[0086]
[0087] in, Indicates the first Uncertain information from anchor FM signal transceiver module 2. , The number of anchor FM signal transceiver modules 2. and They represent the first Distance measurement between the anchor FM signal transceiver module 2 and the drone to be located The mean and standard deviation;
[0088] 3.2) For Sort by size from smallest to largest and select the first few. indivual The corresponding anchor FM signal transceiver module 22 obtains the initially selected set of three-dimensional coordinates. :
[0089]
[0090] in, Indicates the first screening result. Anchor FM signal transceiver module 2 provides three-dimensional coordinate information. For the initial selection of anchor FM signal transceiver modules, there are 2 modules. This example assumes, but is not limited to, 2 modules. .
[0091] Step 4: Perform a second screening on the anchor FM signal transceiver module 2.
[0092] 4.1) From the initial screening Any one of the anchor FM signal transceiver modules 2. Components Various combinations Calculate the set of all combinational condition numbers. :
[0093]
[0094] in, Indicates the first The condition number for the FM signal transceiver module 2 in combination mode. Indicates by the first The coefficient matrix formed by the combination of two anchor FM signal transceiver modules. For the reason The number of combinations consisting of 2 anchor FM signal transceiver modules is given in this example, but is not limited to... ;
[0095] 4.2) For Sort by size from smallest to largest and select the first few. indivual The anchor FM signal transceiver module 22 used is used as the set of anchor FM signal transceiver modules 22 for secondary screening. :
[0096]
[0097] in, Indicates the second filtering result. FM signal transceiver module 2 2, For the anchor FM signal transceiver module 2 in the secondary screening, this example assumes, but is not limited to, the number of modules. ;
[0098] 4.3) Obtain the set of anchor FM signal transceiver modules 2 after secondary screening. Corresponding distance value :
[0099]
[0100] in, Indicates the second filtering result. The distance measurement value between the anchor FM signal transceiver module 2 and the UAV to be located.
[0101] Step 5: Perform altitude-weighted improved centroid positioning estimation on the UAV to be located.
[0102] Traditional weighted centroid localization algorithms require high anchor node deployment density. In non-dense localization scenarios, the discrete position information of anchor nodes causes a sharp drop in localization accuracy. Moreover, UAV crash-avoidance localization requires high reliability of the UAV's altitude localization results. This example addresses this problem by adopting an improved weighted centroid localization estimation method based on altitude weighting to achieve highly reliable and low-complexity position estimation for the UAV to be localized. The implementation steps include the following:
[0103] 5.1) From Any one of the anchor FM signal transceiver modules 2. Components Various combinations ;Utilizing the position information and ranging value of anchor FM signal transceiver module 22 in each combination. For each combination While positioning, the location of the drone to be positioned is obtained. Preliminary location estimates :
[0104]
[0105] in, Indicates the first A preliminary location estimate, ,
[0106] for The matrix,
[0107] for column vectors,
[0108] In the matrix Indicates the first Anchor FM signal transceiver module 2 2 combination corresponding A number, in this example, is set to, but not limited to, [number]. ;
[0109] 5.2) Calculate each preliminary position estimate using the ranging values from all anchor FM signal transceiver modules 2 in each combination. corresponding weighted values :
[0110]
[0111] in, Indicates the first The ranging value corresponding to the combination of anchor FM signal transceiver module 2;
[0112] 5.3) Based on the results of 5.1) and 5.2), the weighted centroid localization algorithm is used to calculate the secondary position estimate of the UAV. :
[0113] ;
[0114] 5.4) Using quadratic position estimates Calculate its horizontal distance from each anchor FM signal transceiver module 2. :
[0115]
[0116] in, Indicates the second position estimate With the The horizontal distance between the two anchor FM signal transceiver modules 2 and 2. and The first FM signal transceiver module 2 2 Axis coordinates and Axis coordinates and They are respectively of Axis coordinates and Axis coordinates;
[0117] 5.5) Reference Figure 4 According to horizontal distance Calculate the distance values between each anchor node. Estimated altitude of the drone to be located :
[0118]
[0119] in, Indicates by the first The estimated altitude value of the UAV to be located is calculated by the anchor FM signal transceiver module 2. For the first FM signal transceiver module 2 2 Axis coordinates For the drone to be located to the number The ranging value of the anchor FM signal transceiver module 2;
[0120] 5.6) Based on the estimated altitude of the UAV to be located Calculate the weighted value set using a height-weighted function. :
[0121]
[0122] in, Indicates the first Each weighted value, for mean for variance;
[0123] 5.7) Using weighted values Calculate the estimated altitude coordinates of the UAV to be located. : .
[0124] Step 6: Obtain the final estimated location of the drone to be located.
[0125] From the second position estimate With the corrected height value get The final estimated 3D coordinates of the UAV to be located at that moment :
[0126]
[0127] in, and These are the secondary position estimates of the UAV to be located. Axis coordinates and Axis coordinates These are the height-weighted and corrected height estimate coordinates.
[0128] Step 7: Calculate the real-time acceleration of the UAV in the altitude direction.
[0129] Repeat steps 5 and 6 to obtain the real-time three-dimensional position of the UAV to be located. :
[0130] ;
[0131] in, This indicates the last moment of location. Indicates the time interval between two consecutive positioning operations. .
[0132] The FM signal is obtained and calculated using the positioning submodules 1 and 2. , , Real-time UAV 3D position coordinates , , ;
[0133] according to , , Real-time UAV 3D position coordinates , , Calculate the real-time acceleration of the UAV in the altitude direction. :
[0134]
[0135] in, , , They represent , , The altitude and position coordinates of the drone at any time.
[0136] Step 8: Switch the onboard positioning and navigation to FM positioning and navigation.
[0137] Set the acceleration threshold in the height direction. That is, the maximum acceleration value allowed for safe flight of the drone. In this embodiment of the invention, it is set to... ;
[0138] Real-time acceleration in the altitude direction of the drone With setting the acceleration threshold in the height direction Comparison:
[0139] like This indicates that the drone is at risk of crashing. At this time, the positioning and navigation mode switching module 3 is triggered, switching the airborne positioning and navigation to FM anti-crash assisted positioning and navigation.
[0140] like This indicates that the drone is in safe flight, the positioning and navigation mode switching module 3 is not triggered, and the drone continues to use onboard positioning to achieve self-positioning.
[0141] Step 9: Real-time estimation of the three-dimensional position coordinates of the UAV to be located. The flight trajectory was obtained by performing mean filtering. .
[0142] The navigation submodule 1 and 3 perform mean filtering on the obtained flight trajectory of the UAV to be located. :
[0143]
[0144] in, express The coordinate results after time filtering. express The first moment One coordinate estimate, This represents the total number of estimations at each time step. This example assumes, but is not limited to, the total number of estimations. .
[0145] The reference numerals for the above steps are only used for clear description of examples of the present invention, and their order is not limited.
[0146] The technical effects of the present invention will be further explained below with reference to simulation experiments.
[0147] 1. Simulation experimental conditions:
[0148] The simulation uses an AMD Ryzen R7 4800H CPU with a clock speed of 2.90GHz, 16.0GB of memory, a 64-bit operating system, Microsoft Windows 10 Professional Edition, and MATLAB 2020b simulation software.
[0149] The airspace for drone flights is The number of anchor nodes in a cubic space of meters. maximum height of anchor node The three-dimensional spatial coordinates of the meter and the aerial anchor node are respectively , , , , .
[0150] Initial anchor node selection number The number of anchor node combinations retained during the secondary screening process The drone to be located is situated at any position within an airspace of 100-200 meters. 1000 Monte Carlo simulations are performed after each change in experimental conditions.
[0151] 2. Simulation Content and Result Analysis:
[0152] Simulation 1: Under the above simulation conditions, the number of anchor nodes in the specific experimental scenario is set to 30, including 25 ground anchor nodes evenly distributed with a spacing of 250 meters, and 5 aerial anchor nodes. The maximum height of the anchor nodes is... The impact of the anchor node deployment height difference on the positioning performance of UAVs was simulated using both the present invention and existing weighted maximum likelihood estimation positioning algorithms. The relative positioning errors of the two methods were obtained, such as... Figure 5 As shown.
[0153] Depend on Figure 5 As can be seen, the relative positioning error of existing weighted maximum likelihood localization algorithms gradually increases as the anchor node height difference decreases, reaching as high as 3.25% when the anchor node height difference is 10 meters. In contrast, the present invention significantly reduces the average relative positioning error. When the maximum anchor node deployment height is below 40 meters, the relative positioning error of existing weighted maximum likelihood localization algorithms is above 0.75%, while the relative positioning error of the present invention is basically unaffected by the anchor node height difference, with an average relative positioning error of 0.6%. The present invention maintains positioning accuracy even when the anchor node height difference is small, indicating that it has better positioning performance in scenarios where anchor node height deployment is limited.
[0154] Simulation 2: Under the above simulation conditions, the number of anchor nodes is set in a specific experimental scenario. The number of ground anchor nodes is The spacing is The meters are evenly distributed, with 5 aerial anchor nodes, and the highest height of the anchor nodes is... For a distance of 30 meters, the impact of ground anchor node deployment density on the positioning performance of the UAV was simulated using both the present invention and existing weighted maximum likelihood estimation positioning algorithms. The relative altitude positioning errors of the two methods were obtained, such as... Figure 6 As shown.
[0155] Depend on Figure 6 As can be seen, the relative positioning error of the existing weighted maximum likelihood localization algorithm decreases with the increase of the number of anchor nodes. However, when there are only 4 ground anchor nodes, the relative positioning error is as high as 2.5%, showing significantly poor positioning performance. In contrast, the present invention, when the number of ground anchor nodes is less than 36, exhibits a significantly lower relative positioning error in terms of altitude, indicating that the present invention has a significant advantage in positioning scenarios with a limited number of anchor nodes.
[0156] Simulation 3: Under the above simulation conditions, the number of anchor nodes in the specific experimental scenario is set to 30, including 25 ground anchor nodes evenly distributed with a spacing of 250 meters, and 5 aerial anchor nodes with a maximum height of [missing information]. Assuming a distance of 30 meters and that the distance measurement errors between UAVs all follow a Gaussian distribution, with the mean distance error increasing from 0 to 10 meters at 1-meter intervals, the impact of distance measurement errors on UAV positioning performance is simulated using both the present invention and existing weighted maximum likelihood estimation positioning algorithms. The relative altitude positioning errors of the two methods are obtained, as shown below. Figure 7 As shown.
[0157] Depend on Figure 7 It is evident that existing weighted maximum likelihood (WML) localization algorithms exhibit a significant increase in relative positioning error with increasing ranging error, resulting in very large relative positioning errors and poor localization performance. In contrast, the present invention demonstrates a significantly lower relative positioning error compared to existing WML algorithms, indicating a clear advantage in positioning reliability in harsh flight environments.
[0158] Simulation 4: The UAV moves at a constant velocity along the line from the origin (0,0) to (500,500), where the velocity components in both the x and y axes are 5 m / s. The time interval between two consecutive positioning operations is 1 s. The positioning results calculated by this invention are used to track the UAV using a mean filtering algorithm to obtain the cumulative error distribution of this invention, as shown below. Figure 8 As shown.
[0159] Depend on Figure 8 As can be seen, the cumulative error of the present invention reaches 1 when the tracking error is 10 meters, indicating that when the side length of the safe capture zone of the UAV is more than 10 meters or even larger, the UAV can be safely captured and the safe landing of the UAV can be guaranteed.
[0160] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the principles of the present invention should be included within the protection scope of the present invention.
Claims
1. A method for anti-crash positioning and navigation of unmanned aerial vehicle (UAV) swarms based on FM signals, characterized in that, Includes the following steps: 1) The anchor FM signal transceiver module (22) is used to perform least squares real-time estimation on the existing logarithmic path loss model to obtain the reference path loss estimate of environmental parameters. and environmental parameter path loss factor estimation value ; 2) The airborne FM signal transceiver module (21) collects the FM signal strength value transmitted by the anchor FM signal transceiver module (22) in real time. The signal is then transmitted to the data processing submodule (11) for Gaussian filtering to obtain a stable received signal strength value. ; 3) Using reference path loss estimates and path loss factor estimate Received signal strength value Convert to distance measurement value ; 4) In the positioning submodule (12), based on the distance measurement value The set of three-dimensional position coordinates of all anchor FM signal transceiver modules (22) Calculate the uncertain information of the positions of the anchor FM signal transceiver modules (22). The three-dimensional coordinate set of the anchor FM signal transceiver module (22) is obtained by sorting and selecting it. ; 5) From the initial screening Any one of the anchor FM signal transceiver modules (22) Components Various combinations For each combination, calculate its condition number to obtain the set of condition numbers for all combinations. ,filter Three-dimensional coordinate set of a reliable anchor FM signal transceiver module (22) and its distance measurement value , so as to participate in the calculation of subsequent positioning algorithms; 6) Three-dimensional coordinate set of reliable anchor FM signal transceiver module (22) and its distance measurement value An improved weighted centroid localization estimation based on altitude weighting is performed on the UAV to be located: 6a) From Any one of the anchor FM signal transceiver modules (22) Components Various combinations ;Utilizing the three-dimensional position information and ranging value of the anchor FM signal transceiver module (22) in each combination For each combination While positioning, the location of the drone to be positioned is obtained. Preliminary three-dimensional position estimate ; 6b) Using the ranging value of the anchor FM signal transceiver module (22) in each combination Calculate each preliminary three-dimensional position estimate corresponding weighted values , ; 6c) will As a weighting factor, the secondary three-dimensional position estimate of the UAV to be located is calculated using the weighted centroid localization algorithm. ; 6d) Using secondary three-dimensional position estimates Calculate its horizontal distance from each anchor FM signal transceiver module (22). ; 6e) Utilizing horizontal distance calculate Estimated altitude of the drone to be located ; 6f) Utilize estimated height Establish a height-weighted function to obtain the height. The corresponding weighted value set ; through weighted values right The final altitude estimate coordinates of the UAV to be located are obtained by performing weighted averaging. ; 7) From the quadratic position estimate With the corrected height value Together constitute Time-estimated three-dimensional position coordinates of the UAV to be located ; 8) Repeat steps 6) and 7) to obtain the three-dimensional position coordinates of the UAV to be located at consecutive time points. ,use , , 3D position coordinates of the drone at any given time , , Calculation of drones Real-time acceleration in the height direction at all times ; 9) Set the acceleration threshold in the altitude direction based on the actual flight speed and maximum acceleration of the UAV. ,when Greater than or equal to At that time, the airborne positioning and navigation is switched to FM positioning and navigation through the positioning and navigation mode switching module (3); 10) Navigation submodule (13) Mean filtering is performed to obtain the flight trajectory. Ensure that the drone is navigated to a safe capture area.
2. The method according to claim 1, characterized in that, The environmental parameter reference path loss estimate obtained in step 1) and environmental parameter path loss factor estimation value The implementation steps include the following: 1a) Using measurement tools, obtain the pre-selected reliable anchor FM signal transceiver module (22) and the rest Distance between the anchor FM signal transceiver modules (22) : ; in, This indicates that the reliable anchor FM signal transceiver module (22) and the first The distance between the anchor FM signal transceiver modules (22); 1b) Using distance values Calculate the parameter matrix : ; 1c) The remaining data collected by the reliable anchor FM signal transceiver module (22) The received signal strength of the anchor FM signal transceiver module (22) is obtained by using a Gaussian filtering method to obtain a stable received signal strength value. : ; in, Indicates the obtained first The stable received signal strength value of the anchor FM signal transceiver module (22); 1d) Using the parameter matrix and received signal strength value The reference path loss estimate for environmental parameters is calculated using the following formula. and environmental parameter path loss factor estimation value : 。 3. The method according to claim 1, characterized in that, The stable received signal strength value obtained in step 2) The implementation steps include the following: 2a) Airborne FM signal transceiver module (21) acquisition The FM signal strength value transmitted by the anchor FM transceiver module (22) : ; in, This indicates that the first signal collected by the airborne FM transceiver module (21) is... The FM signal strength value transmitted by the anchor FM transceiver module (22) is expressed as: ; in, This indicates that the first signal collected by the airborne FM transceiver module (21) is... The anchor FM signal transceiver module (22) One data point, , For the first The amount of received signal strength data collected by the anchor FM signal transceiver module (22); 2b) For the collected data from the first FM signal transceiver module (22) FM received signal strength value Gaussian filtering is performed to obtain the filtered received signal strength value. : ; in, Indicates the number of collections The anchor FM signal transceiver module (22) One data point; 2c) The received signal strength value after filtering Stable received signal strength values are obtained by averaging. : ; 2d) by The stable received signal strength value that constitutes all anchor FM signal transceiver modules (22) : 。 4. The method according to claim 1, characterized in that, Step 3) uses the reference path loss estimate and path loss factor estimate Received signal strength value Convert to distance measurement value : ; in, Indicates the first The distance measurement value between the anchor FM signal transceiver module (22) and the UAV to be located.
5. The method according to claim 1, characterized in that, The set of uncertain information obtained in step 4) and the initial set of three-dimensional coordinates The implementation steps are as follows: 4a) Calculate the set of uncertain information using the ranging values between each anchor FM signal transceiver module (22) and the UAV to be located. : ; in, Indicates the first Uncertain information from the anchor FM signal transceiver module (22), , The number of anchor FM signal transceiver modules (22) and They represent the first Distance measurement between the anchor FM signal transceiver module (22) and the UAV to be located The mean and standard deviation; 4b) To Sort by size from smallest to largest and select the first few. indivual The corresponding anchor FM signal transceiver module (22) obtains the initial set of three-dimensional coordinates. : ; in, Indicates the first screening result. Three-dimensional coordinate information of the anchor FM signal transceiver module (22), The number of anchor FM signal transceiver modules (22) selected in the initial screening.
6. The method according to claim 1, characterized in that, In step 5), calculate the set of all combinational condition numbers. ,choose A collection of anchor FM signal transceiver modules (22) and its distance measurement value The implementation steps are as follows: 5a) Calculate the set of all combinational condition numbers : ; in, Indicates the first The condition number of the combination mode of the anchor FM signal transceiver module (22) Indicates by the first The coefficient matrix formed by the combination of the anchor FM signal transceiver module (22) For the reason The number of combinations consisting of an anchor FM signal transceiver module (22); 5b) To Sort by size from smallest to largest and select the first few. indivual The FM signal transmitting submodule (31) used serves as the anchor FM signal transceiver module (22) set for secondary screening. : ; in, Indicates the second filtering result. Anchor FM signal transceiver module (22), The number of anchor FM signal transceiver modules (22) selected for secondary screening; 5c) Obtain the set of anchor FM signal transceiver modules (22) after secondary screening. Corresponding distance value : ; in, Indicates the second filtering result. The distance measurement value between the anchor FM signal transceiver module (22) and the UAV to be located.
7. The method according to claim 1, characterized in that, The drone to be located obtained in step 6a) Preliminary location estimates , means as follows: ; in, Indicates the first A preliminary location estimate, , , for The matrix, for column vectors, In the matrix Indicates the first The anchor FM signal transceiver module (22) is combined with the corresponding Number.
8. The method according to claim 1, characterized in that: Each preliminary position estimate obtained in step 6b) corresponding weighted values for: ; in, Indicates the first The anchor FM signal transceiver module (22) combines the corresponding ranging values; The secondary position estimate of the UAV to be located obtained in step 6c) for: ; The secondary position estimate obtained in step 6d) Horizontal distance from each anchor FM signal transceiver module (22) for: ,in, Indicates the second position estimate With the The horizontal distance of the anchor FM signal transceiver module (22) and The first Anchor FM signal transceiver module (22) Axis coordinates and Axis coordinates and They are respectively of Axis coordinates and Axis coordinates; The result obtained in step 6e) Estimated altitude of the drone to be located for: ,in, Indicates by the first The estimated altitude value of the UAV to be located is calculated by the anchor FM signal transceiver module (22). For the first Anchor FM signal transceiver module (22) Axis coordinates For the drone to be located to the number The ranging value of the anchor FM signal transceiver module (22); The height obtained in step 6f) The corresponding weighted value set and the estimated coordinates of the drone to be located They are respectively: , ,in, Indicates the first Each weighted value, for mean for variance.
9. The method according to claim 1, characterized in that: The result obtained in step 7) The final estimated 3D coordinates of the UAV to be located at that moment for: ,in, and These are the secondary position estimates of the UAV to be located. of Axis coordinates and Axis coordinates These are the height-weighted corrected height estimate coordinates; In step 8), the acceleration in the height direction is calculated. The formula is: ,in, , , They represent , , The drone's altitude and position coordinates at all times. Indicates the time interval between two consecutive positioning operations; The flight trajectory of the UAV to be located obtained in step 10) for: ,in, express The coordinate results after time filtering. This indicates the last moment of location. express The first moment One coordinate estimate, This represents the total number of estimates at each time step.
10. A drone swarm crash prevention positioning and navigation system implementing any one of claims 1-9, comprising a drone flight data module (1), characterized in that, It also includes an FM signal transceiver module (2) and a positioning and navigation mode switching module (3); The FM signal transceiver module (2) includes: An airborne FM transceiver module (21) is used to transmit FM signals and receive FM signals transmitted by the anchor FM transceiver module (22); An anchor FM signal transceiver module (22) is used to transmit FM signals and receive signals transmitted by the airborne FM signal transceiver module (21) and the anchor FM signal transceiver module (22). ; The positioning and navigation mode switching module (3) is used to transmit the data received by the airborne FM signal transceiver module (21) to the UAV flight data module (1) for FM positioning and navigation when the airborne positioning fails due to electromagnetic interference.
11. The system according to claim 10, characterized in that, The UAV flight data module (1), airborne FM signal transceiver module (21), and positioning and navigation mode switching module (3) are installed inside the UAV fuselage; the anchor FM signal transceiver module (22) is deployed in the UAV flight scenario; and the modules are wirelessly connected to each other.
12. The system according to claim 10, characterized in that, The UAV flight data module (1) includes: The data processing submodule (11) is used to process the data from the FM signal transceiver module (2); The positioning submodule (12) is used to calculate the real-time position of the UAV; The navigation submodule (13) is used to correct the dynamic trajectory of the UAV.
Citation Information
Patent Citations
Indoor three-dimensional positioning method based on MEMS sensor and FM broadcast signals
CN111765887A
