A trajectory planning method for unmanned aerial vehicle tracking moving targets
By using the artificial potential field method to determine temporary target points and plan tracks on the confrontation circle, the problem of lack of target points when the drone tracks mobile targets is solved, and the drone's effective tracking of mobile targets and safe distance maintenance is achieved. , reduces positioning errors and exposure risks, and generates smooth tracks.
Patent Information
- Application Number
- CN202111593676.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-12-23
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2041-12-23
AI Technical Summary
When tracking mobile targets, drones lack a certain planned target point, making it difficult to maintain a safe distance. Traditional track planning algorithms cannot effectively solve the problems of drone positioning errors and exposure risks.
The artificial potential field method is used to determine the temporary target point in the confrontation circle. By calculating the future target position and drone speed, the drone's track is planned to ensure that the drone always maintains a certain distance from the mobile target, and the artificial potential field is used. Gravity and repulsion calculate the direction of the combined force to navigate.
The drone continuously tracks mobile targets by the mobile phone is realized, positioning errors and exposure risks are reduced, smooth tracks are generated, local optimal solution problems are avoided, and the calculation is small and fast.
Smart Images

Figure CN114371730B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of autonomous control of unmanned aerial vehicles, and in particular relates to a method for planning a trajectory of an unmanned aerial vehicle tracking a moving target. Background Art
[0002] A drone is an unmanned, autonomously propelled aircraft controlled by radio remote control or its own program, which uses aerodynamics to carry and fly and is reusable. Drones have the advantages of small size, low cost, good maneuverability, good concealment, and strong adaptability. These advantages enable drones to conduct aerial detection and reconnaissance in complex and dangerous environments. With the promotion of scientific, economic and political factors, drones are increasingly widely used in various fields.
[0003] Detecting targets is one of the important tasks of drones. Its purpose is to search, track and monitor targets, obtain target positions and trajectories, and identify the nature and state of targets. According to the motion characteristics of the detected targets, targets can be divided into two categories: fixed targets and mobile targets. Different from the track planning of drones when detecting fixed targets, when drones detect mobile targets, they must keep tracking the targets, and the track planning has no fixed end point. When drones track mobile targets, it is necessary to ensure that the detection payload of the mobile targets is covered, reduce positioning errors, and require the drones to always maintain a certain safe distance from the mobile targets to reduce the exposure risk of the drones. Traditional drone track planning algorithms plan the trajectory of drones when the target points are determined. Therefore, studying the track planning of drones tracking mobile targets is of great significance to improving the mission capabilities of drones. Summary of the invention
[0004] In order to solve the technical problem that the planned target point is not determined when the UAV tracks the moving target, and the UAV is required to always maintain a certain distance with the moving target for continuous tracking, the present invention proposes a trajectory planning method for UAV tracking the moving target. First, a temporary target point is determined on the confrontation circle, and the trajectory to the temporary target point is planned using the artificial potential field method, so as to realize the continuous tracking of the moving target by the UAV.
[0005] The technical solution adopted by the present invention is:
[0006] A method for planning a trajectory of a UAV tracking a moving target comprises the following steps:
[0007] (1) Calculate the position information of the moving target after a set time ΔT in the future based on the motion characteristics of the moving target and its current position;
[0008] (2) The UAV tracks the moving target in real time by circling around the moving target at a certain distance. The circling circle is called the confrontation circle. The distance between the UAV and the moving target during the circling process is called the confrontation distance. The confrontation distance is determined as the maximum action distance R of the UAV carrying the detection payload.
[0009] (3) Calculate the distance between the current position of the UAV and the position of the moving target after ΔT time in the future, determine the position of the UAV on the confrontation circle based on the calculated distance and the confrontation distance R, and determine the temporary target point on the confrontation circle based on the position of the UAV on the confrontation circle and the speed of the UAV;
[0010] (4) Calculate the artificial potential field attraction force on the UAV at the temporary target point and the artificial potential field repulsion force on the UAV at the obstacle;
[0011] (5) According to the artificial potential field gravitation of the temporary target point on the UAV and the artificial potential field repulsion of the obstacle on the UAV, the resultant force on the UAV is calculated, and the direction of the resultant force is used as the planned speed direction of the UAV at the current position. The trajectory planning step is set, the speed of the UAV is kept unchanged, and the position of the UAV after the set time Δt is calculated;
[0012] (6) Repeat steps (4) and (5) every Δt to obtain the UAV track within the ΔT time; return to step (1).
[0013] Wherein, step (3) specifically comprises the following steps:
[0014] (3.1) Calculate the distance d between the current position of the drone and the moving target position after ΔT time in the future;
[0015] (3.2) According to the relationship between d and R, the temporary target point on the confrontation circle is determined in three cases: when the UAV is outside the confrontation circle, the temporary target point is determined by drawing a tangent to the confrontation circle along the current UAV position; when the UAV is inside the confrontation circle, the temporary target point is determined by the intersection of the reverse extension of the line between the UAV and the moving target position point, the angular bisector of the UAV speed, and the confrontation circle; when the UAV is on the confrontation circle, a circle is drawn with the current UAV position as the center, and the temporary target point is determined according to the intersection with the confrontation circle.
[0016] Wherein, step (3.2) specifically comprises the following steps:
[0017] According to the relationship between d and R, the temporary target point on the confrontation circle is determined, which can be divided into the following three cases:
[0018] 1) When d>R, the UAV is outside the future confrontation circle. Two tangents of the confrontation circle are drawn along the current UAV position, intersecting the confrontation circle at points A and B respectively. The angles between the two tangents UA and UB and the UAV speed V are α1 and α2 respectively. When α1≤α2, the temporary target point is set as point A. When α1>α2, the temporary target point is set as point B. Among them, it is stipulated that 0≤α1≤π, 0≤α2≤π;
[0019] 2) When d<R, the UAV is in the future confrontation circle. The reverse extension line of the line UO between the UAV and the moving target position point O is made to intersect the confrontation circle at point C. With the current position U of the UAV as the vertex, the angle bisector of UC and the UAV speed V is made to intersect the confrontation circle at point D. The temporary target point is set as point D.
[0020] 3) When d = R, the UAV is located on the future confrontation circle. A circle is constructed with the current position of the UAV as the center and the radius V × ΔT, intersecting the confrontation circle at points E and F. The angles between the UAV speed V and UE and UF are α3 and α4 respectively. When α3 ≤ α4, the temporary target point is set as point E. When α3 > α4, the temporary target point is set as point F. It is stipulated that 0 ≤ α3 ≤ π and 0 ≤ α4 ≤ π.
[0021] Compared with the prior art, the present invention has the following advantages:
[0022] The present invention calculates the distance between a UAV at the current moment and a moving target at a future moment, determines a temporary target point on the confrontation circle according to the position of the UAV in the confrontation circle and the speed of the UAV, thereby solving the problem that the target point cannot be determined when the UAV tracks the moving target; an artificial potential field method is used to plan the track from the UAV to the temporary target point, which has a small amount of calculation and a fast calculation speed, can generate a smooth track, and because the temporary target point is constantly updated and changed, the problem that the track planning algorithm of the artificial potential field method is easy to fall into a local optimal solution is solved. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] Figure 1 It is a schematic diagram of determining a temporary target point when the distance between the UAV of the present invention and the moving target is greater than the confrontation distance.
[0024] Figure 2 It is a schematic diagram of determining a temporary target point when the distance between the UAV of the present invention and the moving target is less than the confrontation distance.
[0025] Figure 3 It is a schematic diagram of determining a temporary target point when the distance between the UAV of the present invention and the moving target is equal to the confrontation distance.
[0026] Figure 4 It is a process flow chart for implementing the present invention. DETAILED DESCRIPTION
[0027] The following is combined with Figure 1-Figure 4 The present invention is further illustrated by the following embodiments.
[0028] The present invention is a method for planning the trajectory of a UAV tracking a mobile target. Figure 4 As shown, the following steps are included:
[0029] (1) Predict the future position of a moving target;
[0030] In the process of UAV tracking a moving target, the tracking effect of the UAV on the target depends not only on the current target position, but also on the target position in the future. The motion state of the moving target can be directly detected by the UAV. According to the motion characteristics of the moving target, the moving target motion type is divided into uniform motion, uniform acceleration motion, and uniform turning motion. According to the current moving target position and the interval time ΔT, the position information of the moving target after the future ΔT time can be calculated.
[0031] According to the motion state of the moving target, it is divided into the following three situations:
[0032] 1) If the moving target moves at a constant speed, the speed is V T (V Tx , V Ty ), the current position is (x T ,y T ), then after ΔT time, the moving target position (x T(ΔT) ,y T(ΔT) )for:
[0033]
[0034] 2) If the moving target is moving with uniform acceleration, the current speed is V T , the current position is (x T ,y T ), the acceleration is a T (a Tx , a Ty ), then after ΔT time, the moving target position (x T(ΔT) ,y T(ΔT) )for:
[0035]
[0036] 3) If the moving target makes a uniform turning motion, the current position is (x T ,y T ), the angular velocity is The turning radius is R T , then after ΔT time, the moving target position (x T(ΔT) ,y T(ΔT) )for:
[0037]
[0038] (2) Determine the standoff distance;
[0039] When a UAV tracks a moving target, because the speed of the UAV is greater than that of the moving target, the UAV should circle around the target at a certain distance to achieve real-time tracking of the moving target. This circling circle is called the confrontation circle. The distance between the UAV and the moving target during the circling process is called the confrontation distance, and the confrontation distance is determined as the maximum effective distance R of the UAV carrying the detection payload.
[0040] (3) Determine the temporary target point on the confrontation circle;
[0041] The specific steps include:
[0042] (3.1) Calculate the distance between the drone and the moving target position after ΔT time. Now assume that the current position of the drone is point U, and the coordinates are (x u ,y u ), after ΔT time in the future, the position of the moving target is point O, and the coordinates are (x T(ΔT) ,y T(ΔT) ), the circle with point O as the center and R as the radius is the confrontation circle, and d is the position of the drone and the moving target after ΔT time (x T(ΔT) ,y T(ΔT) ):
[0043]
[0044] (3.2) Determine the temporary target point on the confrontation circle. According to the relationship between d and R, it can be divided into the following three cases:
[0045] 1) When d>R, the drone is outside the future confrontation circle. Figure 1 As shown. Two tangent lines of the confrontation circle are drawn along the current UAV position, intersecting the confrontation circle at points A and B respectively. The angles between the two tangent lines UA and UB and the UAV speed V are α1 and α2 respectively (0≤α1≤π, 0≤α2≤π). When α1≤α2, the temporary target point is set as point A. When α1>α2, the temporary target point is set as point B.
[0046] 2) When d<R, the drone is in the future confrontation circle. Figure 2 As shown. Make the reverse extension line UO between the drone and the moving target position point O, intersecting the confrontation circle at point C. With the current position of the drone as the vertex, make the angle bisector of UC and the drone speed V intersecting the confrontation circle and point D, and set the temporary target point as point D.
[0047] 3) When d = R, the UAV is located on the future confrontation circle, such as Figure 3As shown. With the current position of the drone as the center and V×ΔT as the radius, a circle is drawn, which intersects the opposite circles at points E and F. The angles between the drone speed V and UE and UF are α3 and α4 respectively (0≤α3≤π, 0≤α4≤π). When α3≤α4, the temporary target point is set as point E. When α3>α4, the temporary target point is set as point F.
[0048] (4) Calculate the attraction and repulsion of the artificial potential field;
[0049] The gravitational force of the artificial potential field of the temporary target point on the drone is:
[0050] F attractive =k×l
[0051] The artificial potential field repulsion force on the drone from the obstacle is:
[0052]
[0053] Among them, k is the gravitational coefficient, l is the distance between the UAV and the temporary target point, η is the repulsion coefficient, ρ is the distance between the UAV and the obstacle, and ρ0 is the influence range of the obstacle on the UAV.
[0054] (5) Determine the UAV’s flight path;
[0055] According to the artificial potential field attraction of the temporary target point on the UAV given in step (4) and the artificial potential field repulsion of the obstacle on the UAV, the resultant force on the UAV is calculated, and the speed of the UAV is kept unchanged. The direction of the resultant force is the planned speed direction of the UAV at the current position. The trajectory planning step length Δt is set (Δt<<ΔT). When nΔt is set, the position of the UAV is (x u(nΔt) ,y u(nΔt) ), the speed is V (nΔt) , then after Δt time, the position of the UAV is:
[0056]
[0057] (6) By repeating steps (4) and (5) every Δt, the UAV track in the future can be obtained. After ΔT time, step (1) is executed to determine the new temporary target point and obtain the continuous track of the UAV.
Claims
1. A method for planning a trajectory of a UAV tracking a moving target, characterized in that: Specifically, it includes the following steps: (1) Calculate the position information of the moving target after a set future time ΔT based on the motion characteristics of the moving target and its position at the current moment; (2) The UAV conducts real-time tracking of the moving target by hovering around the moving target at a certain distance. The hovering circle is called the confrontation circle, the distance between the UAV and the moving target during the hovering process is called the confrontation distance, and the confrontation distance is determined as the maximum operating distance R of the detection payload carried by the UAV; (3) Calculate the distance between the UAV's position at the current moment and the moving target's position after ΔT time in the future. Determine the position of the UAV on the confrontation circle based on the calculated distance and the confrontation distance R. Determine the temporary target point on the confrontation circle according to the position of the UAV on the confrontation circle and the UAV's speed; (4) Calculate the artificial potential field attraction of the UAV by the temporary target point and the artificial potential field repulsion of the UAV by the obstacle; (5) Calculate the resultant force received by the UAV according to the artificial potential field attraction of the temporary target point to the UAV and the artificial potential field repulsion of the obstacle to the UAV. Take the direction of the resultant force as the planned speed direction of the UAV at the current position, set the track planning step size, keep the magnitude of the UAV's speed unchanged, and calculate the position of the UAV after a set time Δt; where, Δt << ΔT; (6) Repeat steps (4) and (5) every Δt to obtain the UAV track within ΔT time; return to step (1); Among them, step (3) specifically includes the following steps: (3.1) Calculate the distance d between the UAV's position at the current moment and the moving target's position after ΔT time in the future; (3.2) Determine the temporary target point on the confrontation circle according to the magnitude relationship between d and R, which is divided into three cases: when the UAV is outside the confrontation circle, determine the temporary target point by making a tangent to the confrontation circle along the current UAV position. When the UAV is inside the confrontation circle, determine the temporary target point according to the intersection of the angular bisector of the reverse extension line of the connection line between the UAV and the moving target position point and the UAV's speed and the confrontation circle. When the UAV is on the confrontation circle, make a circle with the current UAV position as the center and determine the temporary target point according to the intersection with the confrontation circle.
2. The method for tracking a moving target by an unmanned aerial vehicle according to claim 1, characterized in that: Step (3.2) specifically includes the following steps: Determine the temporary target point on the confrontation circle according to the magnitude relationship between d and R, which is divided into the following three cases: 1) When d > R, the UAV is outside the future confrontation circle. Make two tangents to the confrontation circle along the current UAV position, which intersect the confrontation circle at point A and point B respectively. The angles between the two tangents UA, UB and the UAV speed V are α1 and α2 respectively. When α1 ≤ α2, it is stipulated that the temporary target point is point A. When α1 > α2, it is stipulated that the temporary target point is point B; where, it is stipulated that 0 ≤ α1 ≤ π, 0 ≤ α2 ≤ π; 2) When d < R, the UAV is inside the future confrontation circle. Make the reverse extension line of the connection line UO between the UAV and the moving target position point O, which intersects the confrontation circle at point C. Take the current UAV position U as the vertex, make the angular bisector of UC and the UAV speed V and intersect the confrontation circle at point D. It is stipulated that the temporary target point is point D; 3) When d = R, the UAV is located on the future confrontation circle. A circle with the current position of the UAV as the center and a radius of V × ΔT is constructed, intersecting the confrontation circle at points E and F. The angles between the UAV speed V and UE and UF are α3 and α4 respectively. When α3 ≤ α4, the temporary target point is set as point E. When α3> α4, the temporary target point is set as point F. Among them, it is stipulated that 0 ≤ α3 ≤ π, 0 ≤ α4 ≤ π.
Citation Information
Cited By
Double-AUV target tracking path planning method and system based on broadside array detection
CN120972944A
