Method for monitoring track of fixed-wing unmanned aerial vehicle in satellite denial environment
By dividing the drone positioning process into two stages in a satellite denial environment, using TOA method and trajectory fitting technology, the problem of large positioning error in traditional positioning methods is solved, and high-precision autonomous navigation of drone is achieved , and synchronous communication between anchor nodes is not required.
Patent Information
- Application Number
- CN202411180563.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-27
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-08-27
AI Technical Summary
In satellite denial environment, traditional TOA methods require time synchronization between anchor nodes and drones, and cannot communicate between anchor nodes, resulting in low positioning accuracy, especially during fixed-wing drones movement process The problem of large positioning error.
The TOA method is used to measure the distance between the drone and the anchor node, and the drone positioning is divided into two stages: the first stage is trajectory fitting and preliminary positioning, and the second stage is utilizing the fitted trajectory for distance correction to achieve precise positioning. , and there is no need for time synchronization between anchor nodes and time synchronization between drones and anchor nodes.
It realizes high-precision autonomous navigation of fixed-wing drones in satellite denial environments, reduces positioning errors, can perform autonomous navigation of multiple drones at the same time, and avoids communication and time synchronization requirements between anchor nodes.
Smart Images

Figure CN119087349A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of unmanned aerial vehicle (UAV) positioning technology, and in particular to a fixed-wing UAV track monitoring method in a satellite denial environment. Background Art
[0002] In a satellite-denied environment, when the ground-deployed anchor nodes cannot communicate with each other and cannot synchronize time, the TOA (Time of Arrival) method is generally used to locate the UAV. By communicating with each anchor node in turn to obtain the propagation time of the measurement signal between the anchor node and the UAV, the measured time parameter is converted into the distance required for positioning, thereby achieving positioning. The schematic diagram of its positioning principle is shown below: Figure 1 shown. Figure 1 The distances between the three anchor nodes BS1, BS2, and BS3 and the target node MS are measured as R1, R2, and R3 respectively. Then the intersection of the three circles is the position of the target node MS to be located. That is, formula (1):
[0003]
[0004] The traditional TOA method requires the anchor node involved in positioning to be strictly time synchronized with the drone. The TOA method calculates the position by measuring the time it takes for the signal to reach the positioning target from the anchor node. This time reflects the difference in the distance the signal propagates in space. If the time between the anchor node and the positioning target is not synchronized, the measured time will have errors, which will lead to inaccurate positioning results.
[0005] For a stationary (hovering) drone, although the drone can only communicate with one anchor node at a time to obtain a distance, if the drone remains stationary during the time required to obtain the distance information required for a TOA, and the drone is in the same position for multiple ranging measurements, good positioning accuracy can be guaranteed.
[0006] However, for fixed-wing UAVs, their positions in the air are constantly changing and they cannot hover in the air. When TOA is used to measure the distance to multiple anchor nodes in sequence, the position of the UAV corresponding to each distance measurement is different. If the traditional TOA method is used for positioning, the position of the UAV during these distance measurements is generally regarded as the same position, which increases the positioning error.
[0007] In 2017, Peng Shusheng, He Ye and others from Nanjing University of Science and Technology proposed a method based on TDOA (time difference of The invention discloses an indoor three-dimensional positioning method based on time difference of arrival (TDOA) and TOA, specifically, three reference nodes A, B, and C are placed at the same height, and reference node D is placed on a plane higher than the first three nodes to establish a three-dimensional coordinate system; reference node A is used as a reference node, and signals are sent to other reference nodes respectively to obtain a first time difference, and other reference nodes send the first time difference to the reference node respectively; the node to be measured sends signals to all reference nodes respectively, and the reference nodes obtain second time differences after receiving the signals, and the reference nodes send the second time differences to the reference nodes respectively; the reference node obtains the time difference between the reference node and other reference nodes and between the node to be measured and all reference nodes according to the first time difference and the second time difference, and the time difference is multiplied by the speed of light to obtain distance information, the distance between the reference nodes A, B, C, and D and the node to be measured is Ri, i=1, 2, 3, 4, and the distance difference between the reference nodes B and C and the reference node A to the node to be measured is R2, 1, R3, 1; the reference node calculates the position coordinates of the node to be measured M according to TDOA and TOA information. Although the TDOA method does not require strict time synchronization between the positioning target and the anchor node, it still requires time synchronization between the anchor nodes, and the accuracy of time synchronization will affect the positioning accuracy. Summary of the invention
[0008] In view of this, the present invention provides a method for monitoring the track of fixed-wing UAVs in a satellite denial environment, which does not require time synchronization between anchor nodes and UAVs, nor does it require time synchronization between anchor nodes. It can achieve positioning and track monitoring of fixed-wing UAVs in a satellite denial environment.
[0009] The method for monitoring the track of a fixed-wing UAV in a satellite denial environment of the present invention comprises:
[0010] Step 1: During the flight, the UAV communicates with each anchor node on the ground in turn, and uses the TOA method to measure the distance between each flight time and the corresponding anchor node; the UAV positioning solution is performed with N adjacent flight times as a group to obtain the UAV positioning results corresponding to each group;
[0011] Step 2: Based on the positioning results of the corresponding drones in each group, the motion trajectory is fitted and the flight position at the next moment is predicted;
[0012] Step 3, calculate the distance between the predicted flight position at the next moment and the corresponding anchor node, and compare it with the distance between the flight position and the anchor node actually measured by the TOA method at the next moment; if the difference between the two distances is less than the set threshold, execute step 4, otherwise, return to step 1;
[0013] Step 4, based on the fitted motion trajectory, estimate the flight position at the next N moments; calculate the distances d_initial1 to d_initialN between the estimated flight position at the next N moments and the corresponding anchor nodes; at the same time, calculate the distances d_last1 to d_lastN between the estimated flight position at the next Nth moment and each anchor node; subtract d_initial from d_last to obtain the distance correction deta_d between the estimated flight position at each moment in the next N moments and the corresponding anchor node;
[0014] Step 5: At the next N flight times, after using TOA to measure the distance between the flight time and the corresponding anchor node, the distance correction value obtained in step 4 is used to compensate the TOA measurement distance; based on the compensated TOA measurement distance, the drone positioning solution is performed, and the fitted trajectory is updated, and the process returns to step 4 until the navigation ends.
[0015] Preferably, in step 1, for a group of N TOA measurement distances, the Chan algorithm is used to perform drone positioning solution to obtain the drone positioning result corresponding to the group.
[0016] Preferably, in step 2, polynomial fitting, Bezier curve, Kalman filtering or least squares method is used to fit the motion trajectory.
[0017] Preferably, in step 3, when three consecutive differences are smaller than a set threshold, execute step 4, otherwise, return to step 1.
[0018] Preferably, N is the number of ground communication anchor nodes; the number of ground communication anchor nodes is greater than or equal to 4.
[0019] Beneficial effects:
[0020] The present invention divides the entire autonomous navigation process into two stages. In the first stage, TOA positioning and solution are performed with N flight times as a group, and preliminary trajectory fitting is performed. By comparing the distance between the predicted position of the trajectory and the anchor node and the actual measured distance, when the distance is less than the set threshold, the second stage, i.e., the precise positioning and navigation stage, is performed; in the second stage, the actual measured distance information is corrected using the position on the fitting trajectory, and the distance between multiple trajectory predicted positions and corresponding anchor nodes is converted into one position and the position of all anchor nodes, thereby improving the accuracy of the distance used for TOA positioning and solution, and thus achieving more accurate TOA positioning. The present invention realizes high-precision autonomous navigation under satellite denial conditions and during the movement of unmanned aerial vehicles; and the anchor nodes deployed on the ground do not need to communicate with each other, and there is no need for time synchronization between the anchor nodes, nor is there any need for time synchronization between the anchor nodes involved in positioning and the unmanned aerial vehicle. The present invention can realize autonomous navigation of multiple unmanned aerial vehicles at the same time. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] Figure 1 This is a schematic diagram of TOA positioning.
[0022] Figure 2 This is a principle block diagram of the method for autonomous navigation of unmanned aerial vehicles in a satellite denial environment of the present invention.
[0023] Figure 3 The present invention is a flow chart of the autonomous navigation method of unmanned aerial vehicle in a satellite denial environment.
[0024] Figure 4 This is a schematic diagram of the first stage scenario.
[0025] Figure 5 This is a schematic diagram of the second stage scenario.
[0026] Figure 6 This is the simulation result of the UAV autonomous navigation method based on ranging in a satellite denial environment. DETAILED DESCRIPTION
[0027] The present invention is described in detail below with reference to the accompanying drawings and embodiments.
[0028] The present invention provides a method for monitoring the track of a fixed-wing UAV in a satellite-denied environment. Under the satellite-denied condition, multiple anchor nodes that do not need to communicate with each other are deployed on the ground (the UAV can only communicate with one anchor node at the same time), and the UAV in the air communicates with different anchor nodes in turn, and adopts the TOA method to obtain distance information, and then performs positioning and solving. The entire autonomous positioning and navigation process can be divided into two stages. In the first stage, a preliminary navigation route is obtained through position approximation and trajectory fitting. The obtained navigation route includes TOA results and interpolation of TOA results during trajectory fitting, and then enters the second stage through state conversion, and compensates for TOA ranging, thereby correcting the positioning result, so that the UAV in motion can navigate autonomously.
[0029] The principle block diagram of the present invention is as follows Figure 2 As shown in the flow chart, Figure 3 For the traditional TOA positioning method, at least 4 anchor nodes need to be deployed on the ground. The present invention is improved based on the TOA method and also needs to deploy at least 4 anchor nodes on the ground. The following takes the deployment of 5 anchor nodes on the ground as an example for explanation.
[0030] The scene diagrams of the first and second stages are shown in Figure 2. Figure 4 , Figure 5 The dotted line represents the predicted flight trajectory of the drone, the solid airplane icon and the five-pointed star represent the actual location of the drone, and the hollow airplane icon represents the predicted location of the drone based on the trajectory.
[0031] In the first stage, the TOA algorithm needs to be used to continuously measure the distance between the drone and the anchor node and perform positioning calculation. Unlike the traditional TOA process, when obtaining multiple distance information required for each TOA positioning, due to the continuous movement of the drone and each measurement can only obtain the distance with one anchor node, the distance between the drone at different positions and the corresponding anchor node is not obtained. It is necessary to approximately regard the position of the drone when these distances are measured as the same position. Through this method, multiple TOA positioning is performed, and the trajectory fitting is performed using the results of TOA positioning to predict the motion trajectory of the drone, and then the position of the drone at the next moment is obtained. At the beginning, due to the small amount of position information involved in trajectory fitting, the deviation between the position predicted by the fitted trajectory and the actual position is large. As the TOA process continues, the position information involved in trajectory fitting gradually increases, and the deviation between the position predicted by the fitted trajectory and the actual position becomes smaller, but the error always exists. By setting the error threshold, when the error is less than the threshold value, the second stage is entered.
[0032] Among them, in actual situations, there are always errors in the location of the base station, that is, there are errors in the time from the target node to the base station measured by TOA, and there may be no solution to the equation group. At this time, the Chan algorithm based on TOA can be used; this algorithm first assumes that the solutions of the equation group are independent of each other, linearizes them, and uses weighted least squares to obtain their estimated values, and then uses the least squares method once to estimate the relationship between them, and finally solves the target position.
[0033] Specifically, Figure 4 As shown, the drone performs TOA ranging every △t. Starting from the take-off of the drone, the five distance information obtained every 5△t is regarded as a group, and the five distances actually obtained by the drone at five positions are regarded as obtained at one position. The Chan algorithm in TOA positioning is applied to each group of distances for position solution, and a TOA positioning result Q can be obtained every 5△t. Multiple groups of TOA positioning information are used to fit the motion trajectory of the drone, and the position of the drone at the next △t can be inferred based on the trajectory. The methods that can be used for trajectory fitting in the present invention include but are not limited to polynomial fitting, Bezier curve, Kalman filtering, and least squares method.
[0034] At the next △t, the difference between the distance d between the drone position and the anchor node at that moment obtained by trajectory inference and the distance d1 between the drone and the anchor node obtained by actual communication measurement is calculated, and this difference is used as the transition threshold between the first stage and the second stage. If the difference is greater than the set threshold, the process of TOA in the first stage is repeated; if it is less than the threshold for three consecutive times, the second stage is entered.
[0035] In the second stage, the drones still communicate with different anchor nodes to obtain distance information. Although the TOA method is still used for positioning and solving, the method of obtaining the distance information required for a TOA calculation is different from the first stage. The fitting trajectory can be used to convert the distance information obtained from different drone positions used for the same TOA positioning into the distance information of the same position, and then TOA positioning is performed, and the fitting trajectory is continuously iterated, thereby reducing the error.
[0036] Specifically, Figure 5 As shown in the figure, on the basis of establishing the UAV motion trajectory, the trajectory is used to infer the five positions of the UAV at the next five △t moments, and the distances d_initial1~d_initial5 between the five UAV positions predicted by the trajectory and the corresponding five anchor nodes are calculated; and the distances d_last1~d_last5 between the UAV position predicted by the trajectory at the next 5△t moment and each anchor node are calculated; d_last is subtracted from d_initial to obtain the distance correction deta_d corresponding to the next five △t moments, as shown in formula (2).
[0037] deta_d = d_last - d_initial (2)
[0038] Deta_d is added as a correction value to the distances d_real1 to d_real5 from the corresponding anchor nodes actually measured by TOA at the corresponding positions at the next five △t moments, and the TOA distance measurement value is corrected, as shown in formula (3).
[0039] d_real=deta_d+d_initial (3)
[0040] The 5 corrected distance values can be regarded as the distance values from the drone's position to the 5 anchor nodes after 5△t. This step is equivalent to position conversion. Different from the first stage, the distance measured by the drone at 5 positions is directly used for TOA positioning and solving. After position conversion, it can be regarded as the distance measured by the drone at one position for TOA position solving, and a new Q value is obtained. Then, the corrected distance is used for position solving every 5△t, and the new Q value is continuously used to update the fitting trajectory, and the positioning and solving process is repeated to achieve continuous positioning of the drone's position.
[0041] The following is an explanation with reference to specific examples.
[0042] Five anchor nodes are deployed on the ground, and the positions of the anchor nodes are BS1 = [0, 0, 0], BS2 = [-5000, 0, 0], BS3 = [0, -5000, 0], BS4 = [-5000, -5000, 0], and BS5 = [-2500, -2500, 250]. Assuming that the distance measurement is performed every 0.1 seconds, that is, △t = 0.1s, the initial velocity of the UAV in the x, y, and z directions is 200m / s, and the acceleration obeys a normal distribution with a variance of 50, simulating the irregular movement of the UAV in three-dimensional space. Compare the results of positioning solution using the traditional TOA chan algorithm with the positioning solution using the method of the present invention, as shown in the figure. Figure 6 After error analysis, in the current scenario, when the UAV flies about 30 kilometers away from the origin, the error of traditional TOA positioning is about 5%, while the positioning error of the present invention is about 3%, which reflects the reliability of the present invention.
[0043] In summary, the above are only preferred embodiments of the present invention and are not intended to limit the protection scope of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for monitoring the trajectory of fixed-wing UAVs in a satellite-denied environment. It is characterized in that include: Step 1: During the flight, the UAV communicates with each anchor node on the ground in turn, and uses the TOA method to measure the distance between each flight time and the corresponding anchor node; the UAV positioning solution is performed with N adjacent flight times as a group to obtain the UAV positioning results corresponding to each group; Step 2: Based on the positioning results of the corresponding drones in each group, the motion trajectory is fitted and the flight position at the next moment is predicted; Step 3, calculate the distance between the predicted flight position at the next moment and the corresponding anchor node, and compare it with the distance between the flight position and the anchor node actually measured by the TOA method at the next moment; if the difference between the two distances is less than the set threshold, execute step 4, otherwise, return to step 1; Step 4, based on the fitted motion trajectory, estimate the flight position at the next N moments; calculate the distances d_initial1 to d_initialN between the estimated flight position at the next N moments and the corresponding anchor nodes; at the same time, calculate the distances d_last1 to d_lastN between the estimated flight position at the next Nth moment and each anchor node; subtract d_initial from d_last to obtain the distance correction deta_d between the estimated flight position at each moment in the next N moments and the corresponding anchor node; Step 5: At the next N flight times, after using TOA to measure the distance between the flight time and the corresponding anchor node, the distance correction value obtained in step 4 is used to compensate the TOA measurement distance; based on the compensated TOA measurement distance, the drone positioning solution is performed, and the fitted trajectory is updated, and the process returns to step 4 until the navigation ends.
2. The method according to claim 1, It is characterized in that In the step 1, for a group of N TOA measurement distances, the Chan algorithm is used to perform drone positioning solution to obtain the drone positioning result corresponding to the group.
3. The method according to claim 1, It is characterized in that In the step 2, the motion trajectory is fitted by using polynomial fitting, Bezier curve, Kalman filtering or least square method.
4. The method according to claim 1, 2 or 3, It is characterized in that In step 3, when three consecutive difference values are all smaller than the set threshold, execute step 4; otherwise, return to step 1.
5. The method according to claim 1, It is characterized in that The N is the number of ground communication anchor nodes; the number of ground communication anchor nodes is greater than or equal to 4.
Citation Information
Patent Citations
Location data processing method and device used for mobile station locating service
CN101136678A
Track spoofing method based on GPS navigation
CN111650620A
Unmanned aerial vehicle non-cooperative target tracking system based on binocular vision
CN113467500A
Personnel positioning system and method adopting UWB technology
CN114845250A
Aircraft trajectory prediction method based on LSTM-DNN hybrid neural network
CN116822738A
