CN112859919A - Method for tracking moving target by unmanned aerial vehicle group - Google Patents
Method for tracking moving target by unmanned aerial vehicle group Download PDFInfo
- Publication number
- CN112859919A CN112859919A CN202110066702.XA CN202110066702A CN112859919A CN 112859919 A CN112859919 A CN 112859919A CN 202110066702 A CN202110066702 A CN 202110066702A CN 112859919 A CN112859919 A CN 112859919A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- tracking
- moving
- target
- aerial vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000000007 visual effect Effects 0.000 claims abstract description 7
- 238000005070 sampling Methods 0.000 claims description 15
- 239000013598 vector Substances 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003234 polygenic effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention provides a method for tracking moving targets by an unmanned aerial vehicle group, which comprises the following steps: setting an unmanned aerial vehicle group termination tracking parameter, and establishing a moving object motion model equation; obtaining distance observation values of a plurality of unmanned aerial vehicles to a moving target; obtaining the view angle of the moving target on the unmanned aerial vehicle according to the distance observation value; determining the motion direction of the unmanned aerial vehicle according to the view rotation angle; and adjusting the moving direction to track the target until reaching the defined distance and angle. The method has the advantages of simple and convenient operation steps, low requirement on operators and high accuracy; the tracking of the moving target on the basis of ensuring the stability of group flight due to the visual operation is avoided, and the stable and accurate tracking of the group flight can be ensured.
Description
Technical Field
The invention relates to an unmanned aerial vehicle technology, in particular to a method for tracking moving targets by an unmanned aerial vehicle group.
Background
The tracking of the moving target is realized by the existing unmanned aerial vehicle in a single-machine mode, and the tracking of the single-machine mode is realized by visual operation of personnel. Such operation of a single machine lacks precision and has high demands on the operator. For the unmanned aerial vehicle cluster, the tracking of the moving target is difficult to realize by the visual operation of the operator on the basis of ensuring the stability of the cluster flight, the situation that the operator is easily lost is easily caused, and the stability and the accurate tracking of the cluster are difficult to ensure at the same time.
At present, unmanned aerial vehicle is to moving target's tracking, and the polygenic unit operating personnel is tracked the operation of visualing of moving target, and it is still less to utilize many unmanned aerial vehicles to realize the pursuit to moving target. The single unmanned aerial vehicle has the advantages of simple implementation and no coordination requirement on the tracking of the moving target. However, the single unmanned aerial vehicle operator has high intensity of target tracking operation, has high requirement on the operator, and is difficult to realize the tactical target realized by the unmanned aerial vehicle group.
The unmanned aerial vehicle group has the advantages of high reliability, more portable equipment, stable flight and low overall failure rate. A plurality of unmanned aerial vehicles can be dispatched to execute special tasks at any time in the flight process.
Along with the development of unmanned aerial vehicle technique, unmanned aerial vehicle forms the unmanned aerial vehicle crowd with the mode collaborative flight that becomes many times, reaches certain bigger practical function, possesses functions such as communication, mutual range finding between the unmanned aerial vehicle crowd.
It is noted that this section is intended to provide a background or context to the embodiments of the invention that are recited in the claims. The description herein is not admitted to be prior art by inclusion in this section.
Disclosure of Invention
The invention aims to provide a method for tracking a moving target by an unmanned aerial vehicle cluster, which can ensure that the unmanned aerial vehicle cluster can stably and accurately track.
In order to achieve the purpose, the invention adopts the following technical scheme:
the method for tracking the moving target by the unmanned aerial vehicle group comprises the following steps:
s1: setting an unmanned aerial vehicle group termination tracking parameter, and establishing a moving object motion model equation;
s2: obtaining distance observation values of a plurality of unmanned aerial vehicles to a moving target;
s3: obtaining the view angle of the moving target on the unmanned aerial vehicle according to the distance observation value;
s4: determining the motion direction of the unmanned aerial vehicle according to the view rotation angle;
s5: and adjusting the moving direction to track the target until reaching the defined distance and angle.
Further, the step S1 is specifically as follows:
s101: setting a tracking termination parameter, wherein the tracking termination parameter is as follows: distance D, pitch angle θ, yaw angle
S102: establishing a moving object model equation:
wherein dt is a time sampling interval, x (k) is an instantaneous position of the moving object at a kth sampling interval, v (k) is an instantaneous speed of the moving object at the kth sampling interval, a (k) is an instantaneous acceleration of the moving object at the kth sampling interval, and w (k) is noise suffered by the moving object at the kth sampling interval.
Further, the step S2 is specifically as follows:
s201: at the kth time, the coordinate x (k) of the moving object to be obtained is set to (x, y, z)TThe nth known space has three-dimensional coordinates of (x)(n),y(n),z(n)) The distance from the unmanned aerial vehicle to the sensor to be solved is r(n)Obtaining a total of N corresponding distances r(n)(n＝1,2,…,N)；
S202: the measured values are rewritten as:
wherein
Formula (2) is
SX(k)＝L (4)
S203: and obtaining the instantaneous position of the moving target at the kth moment as follows:
X(k)＝(STS)-1STL (5)。
further, the number of the multiple unmanned planes in the step S2 is greater than four.
Further, the step S3 is specifically as follows:
s301: obtaining a series of instantaneous values V (k), A (k) of the moving target according to the formula (1);
s302: obtaining the rotation angle alpha (k) of a series of speed vectors of the moving target; wherein:
further, the step S4 is specifically as follows:
s401: according to the target instantaneous position and X (k) ═ x, y, z)TUnmanned plane position (x)(n),y(n),z(n)) And a distance r(n)Obtaining corresponding direction vector
S402: calculating a preset meeting vector 2dtV (k) of the motion of the moving target;
s403: calculating the speed steering angle of the unmanned aerial vehicle according to the following formula;
s404: the drone tracks the direction of speed by pointing to the moving object, i.e. along
And adjusting the preset meeting point to the target motion.
Further, the step S404 is specifically: on the basis of pointing to the target, i.e. along
On the basis, the speed steering angle beta (k) is increased along the direction V (k)/| | V (k) | direction of the meeting point of the target motion, and the unmanned aerial vehicle speed direction is changed into:
further, the step S5 is specifically as follows:
s501: increasing a rotation angle beta (k) to the direction of V (k)/| | V (k) | | from the original direction of the speed;
s502: judging the distance r of the moving target(n)If the tracking error is smaller than the set value D, stopping tracking if the tracking error is smaller than or equal to the set value D, and returning to the step S401 if the tracking error is larger than the set value D; then the pitch angle theta and the yaw angle are appointed
And moving to enable the moving target to reach the limited visual field.
The invention has the beneficial effects that:
1) the invention provides a method for tracking a moving target by an unmanned aerial vehicle group, which has the advantages of simple operation steps, low requirement on operators and high precision;
2) the invention provides a method for tracking a moving target by an unmanned aerial vehicle cluster, which avoids the difficulty in tracking the moving target on the basis of ensuring the stability of cluster flight by visual operation and can ensure the stability and accurate tracking of the cluster.
Detailed Description
The example embodiments may be embodied in many different forms and should not be construed as limited to the examples set forth herein; rather, these embodiments are provided so that this disclosure will be thorough and complete, and will fully convey the concept of example embodiments to those skilled in the art. The described features or characteristics may be combined in any suitable manner in one or more embodiments.
The method for tracking the moving target by the unmanned aerial vehicle group comprises the following steps:
the first step is as follows: setting a termination tracking parameter, and establishing a moving object motion model equation;
the second step is that: obtaining distance observation values of a plurality of unmanned aerial vehicles (more than four) to a moving target;
the third step: obtaining the view angle of the moving target on the unmanned aerial vehicle according to the distance observation value;
the fourth step: determining the motion direction of the unmanned aerial vehicle according to the view rotation angle;
the fifth step: adjusting the direction of motion enables tracking of the target until a defined minimum distance and angle is reached.
The first step is as follows:
s101: setting a tracking termination parameter, wherein the tracking termination parameter is as follows: distance D, pitch angle θ, yaw angle
S102: establishing a moving object model equation:
wherein dt is a time sampling interval, x (k) is an instantaneous position of the moving object at a kth sampling interval, v (k) is an instantaneous speed of the moving object at the kth sampling interval, a (k) is an instantaneous acceleration of the moving object at the kth sampling interval, and w (k) is noise suffered by the moving object at the kth sampling interval.
The second step is as follows:
s201: at the kth time, the coordinate x (k) of the moving object to be obtained is set to (x, y, z)TThe nth known space has three-dimensional coordinates of (x)(n),y(n),z(n)) The distance from the unmanned aerial vehicle to the sensor to be solved is r(n)Obtaining a total of N corresponding distances r(n)(n＝1,2,…,N)；
S202: the measured values are rewritten as:
wherein
Formula (2) is
SX(k)＝L (4)
S203: and obtaining the instantaneous position of the moving target at the kth moment as follows:
X(k)＝(STS)-1STL (5)。
the third step is as follows:
s301: obtaining a series of instantaneous values V (k), A (k) of the moving target according to the formula (1);
s302: obtaining the rotation angle alpha (k) of a series of speed vectors of the moving target; wherein:
further, the step S4 is specifically as follows:
s401: according to the target instantaneous position and X (k) ═ x, y, z)TUnmanned plane position (x)(n),y(n),z(n)) And a distance r(n)Obtaining corresponding direction vector
S402: calculating a preset meeting vector 2dtV (k) of the motion of the moving target;
s403: calculating the speed steering angle of the unmanned aerial vehicle according to the following formula;
s404: the drone tracks the direction of speed by pointing to the moving object, i.e. along
And adjusting the preset meeting point to the target motion.
Step S404 is specifically: on the basis of pointing to the target, i.e. along
On the basis of the target movement, the direction V (k)/| | V (k) | | direction increases along the target movement meeting point directionAcceleration steering angle β (k), unmanned aerial vehicle speed pointing becomes:
the fifth step is as follows:
s501: increasing a rotation angle beta (k) to the direction of V (k)/| | V (k) | | from the original direction of the speed;
s502: judging the distance r of the moving target(n)If the tracking error is smaller than the set value D, stopping tracking if the tracking error is smaller than or equal to the set value D, and returning to the step S401 if the tracking error is larger than the set value D; then the pitch angle theta and the yaw angle are appointed
And moving to enable the moving target to reach the limited visual field.
Other embodiments of the invention will be apparent to those skilled in the art from consideration of the specification and practice of the invention disclosed herein. This application is intended to cover any variations, uses, or adaptations of the invention following, in general, the principles of the invention and including such departures from the present disclosure as come within known or customary practice within the art to which the invention pertains. It is intended that the specification and examples be considered as exemplary only, with a true scope and spirit of the invention being indicated by the following claims.
Claims (8)
1. The method for tracking the moving target by the unmanned aerial vehicle group is characterized by comprising the following steps:
s1: setting an unmanned aerial vehicle group termination tracking parameter, and establishing a moving object motion model equation;
s2: obtaining distance observation values of a plurality of unmanned aerial vehicles to a moving target;
s3: obtaining the view angle of the moving target on the unmanned aerial vehicle according to the distance observation value;
s4: determining the motion direction of the unmanned aerial vehicle according to the view rotation angle;
s5: and adjusting the moving direction to track the target until reaching the defined distance and angle.
2. The method for tracking a moving object by a cluster of unmanned aerial vehicles according to claim 1, wherein the step S1 is as follows:
s101: setting a tracking termination parameter, wherein the tracking termination parameter is as follows: distance D, pitch angle θ, yaw angle
S102: establishing a moving object model equation:
wherein dt is a time sampling interval, x (k) is an instantaneous position of the moving object at a kth sampling interval, v (k) is an instantaneous speed of the moving object at the kth sampling interval, a (k) is an instantaneous acceleration of the moving object at the kth sampling interval, and w (k) is noise suffered by the moving object at the kth sampling interval.
3. The method for tracking a moving object by a cluster of unmanned aerial vehicles according to claim 1, wherein the step S2 is as follows:
s201: at the kth time, the coordinate x (k) of the moving object to be obtained is set to (x, y, z)TThe known space three-dimensional coordinate of the nth frame is (x)(n),y(n),z(n)) The distance from the unmanned aerial vehicle to the sensor to be solved is r(n)Obtaining a total of N corresponding distances r(n)(n＝1,2,…,N)；
S202: the measured values are rewritten as:
wherein
Formula (2) is
SX(k)＝L (4)
S203: and obtaining the instantaneous position of the moving target at the kth moment as follows:
X(k)＝(STS)-1STL (5)。
4. the method for tracking the moving object by the drone swarm of claim 1 or 3, wherein the number of the plurality of drones in step S2 is greater than four.
5. The method for tracking a moving object by a cluster of unmanned aerial vehicles according to claim 1, wherein the step S3 is as follows:
s301: obtaining a series of instantaneous values V (k), A (k) of the moving target according to the formula (1);
s302: obtaining the rotation angle alpha (k) of a series of speed vectors of the moving target; wherein:
6. the method for tracking a moving object by a cluster of unmanned aerial vehicles according to claim 1, wherein the step S4 is as follows:
s401: according to the target instantaneous position and X (k) ═ x, y, z)TUnmanned plane position (x)(n),y(n),z(n)) And a distance r(n)Obtaining corresponding direction vector
S402: calculating a preset meeting vector 2dtV (k) of the motion of the moving target;
s403: calculating the speed steering angle of the unmanned aerial vehicle according to the following formula;
s404: the drone tracks the direction of speed by pointing to the moving object, i.e. along
And adjusting the preset meeting point to the target motion.
7. The method for tracking a moving object by a cluster of unmanned aerial vehicles according to claim 5, wherein the step S404 is specifically as follows: on the basis of pointing to the target, i.e. along
On the basis, the speed steering angle beta (k) is increased along the direction V (k)/| | V (k) | direction of the meeting point of the target motion, and the speed direction of the unmanned aerial vehicle is changed into:
8. the method for tracking a moving object by a cluster of unmanned aerial vehicles according to claim 6, wherein the step S5 is as follows:
s501: increasing a rotation angle beta (k) to the direction of V (k)/| | V (k) | | from the original direction of the speed;
s502: judging the distance r of the moving target(n)Whether the current time is less than the set value D or not, if the current time is less than or equal to the set value D, the tracking is stopped, and if the current time is more than the set value D, the step S401 is returned; then the pitch angle theta and the yaw angle are appointed
And moving to enable the moving target to reach the limited visual field.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110066702.XA CN112859919B (en) | 2021-01-19 | 2021-01-19 | Method for tracking moving target by unmanned aerial vehicle group |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110066702.XA CN112859919B (en) | 2021-01-19 | 2021-01-19 | Method for tracking moving target by unmanned aerial vehicle group |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112859919A true CN112859919A (en) | 2021-05-28 |
| CN112859919B CN112859919B (en) | 2022-08-26 |
Family
ID=76007031
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110066702.XA Active CN112859919B (en) | 2021-01-19 | 2021-01-19 | Method for tracking moving target by unmanned aerial vehicle group |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112859919B (en) |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20090187299A1 (en) * | 2008-01-23 | 2009-07-23 | Fregene Kingsley Oc | Method and System for Autonomous Tracking of a Mobile Target by an Unmanned Aerial Vehicle |
| JP2014123306A (en) * | 2012-12-21 | 2014-07-03 | Secom Co Ltd | Autonomous flight robot |
| CN105652891A (en) * | 2016-03-02 | 2016-06-08 | 中山大学 | Unmanned gyroplane moving target autonomous tracking device and control method thereof |
| CN106406359A (en) * | 2016-08-30 | 2017-02-15 | 南京航空航天大学 | Virtual object-based guidance method used for fixed wing unmanned aerial vehicle to track ground object |
| CN108227736A (en) * | 2017-12-18 | 2018-06-29 | 南京航空航天大学 | A kind of fixed-wing unmanned plane formation homing guidance method based on distance measuring signal |
| CN110032214A (en) * | 2019-04-17 | 2019-07-19 | 中国人民解放军海军航空大学 | Quick Standoff method for tracking target based on vector field |
| CN110825112A (en) * | 2019-11-22 | 2020-02-21 | 渤海大学 | Oil field dynamic invasion target tracking system and method based on multiple unmanned aerial vehicles |
| CN112198886A (en) * | 2019-12-31 | 2021-01-08 | 北京理工大学 | Unmanned aerial vehicle control method for tracking maneuvering target |
-
2021
- 2021-01-19 CN CN202110066702.XA patent/CN112859919B/en active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20090187299A1 (en) * | 2008-01-23 | 2009-07-23 | Fregene Kingsley Oc | Method and System for Autonomous Tracking of a Mobile Target by an Unmanned Aerial Vehicle |
| JP2014123306A (en) * | 2012-12-21 | 2014-07-03 | Secom Co Ltd | Autonomous flight robot |
| CN105652891A (en) * | 2016-03-02 | 2016-06-08 | 中山大学 | Unmanned gyroplane moving target autonomous tracking device and control method thereof |
| CN106406359A (en) * | 2016-08-30 | 2017-02-15 | 南京航空航天大学 | Virtual object-based guidance method used for fixed wing unmanned aerial vehicle to track ground object |
| CN108227736A (en) * | 2017-12-18 | 2018-06-29 | 南京航空航天大学 | A kind of fixed-wing unmanned plane formation homing guidance method based on distance measuring signal |
| CN110032214A (en) * | 2019-04-17 | 2019-07-19 | 中国人民解放军海军航空大学 | Quick Standoff method for tracking target based on vector field |
| CN110825112A (en) * | 2019-11-22 | 2020-02-21 | 渤海大学 | Oil field dynamic invasion target tracking system and method based on multiple unmanned aerial vehicles |
| CN112198886A (en) * | 2019-12-31 | 2021-01-08 | 北京理工大学 | Unmanned aerial vehicle control method for tracking maneuvering target |
Non-Patent Citations (5)
| Title |
|---|
| L. LIU, ET AL.: "UAV Autonomous Trajectory Planning in Target Tracking Tasks via a DQN Approach", 《2019 IEEE INTERNATIONAL CONFERENCE ON REAL-TIME COMPUTING AND ROBOTICS (RCAR)》 * |
| S. A. P. QUINTERO, ET AL.: "Optimal UAV coordination for target tracking using dynamic programming", 《49TH IEEE CONFERENCE ON DECISION AND CONTROL (CDC)》 * |
| SONG-LIN LIAO, ET AL.: "Path planning for moving target tracking by fixed-wing UAV", 《DEFENCE TECHNOLOGY》 * |
| 孙健 等: "无人机跟踪运动目标航迹规划算法", 《飞行力学》 * |
| 赵长春 等: "基于改进RPG方法的MUAVs协同目标跟踪", 《航空学报》 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112859919B (en) | 2022-08-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110609290B (en) | Laser radar matching positioning method and device | |
| CN109375643B (en) | Multi-four-rotor-confrontation tracking target guidance law based on piloting-following type triangular formation | |
| CN106647257B (en) | Feedforward control method based on orthogonal least squares | |
| CN109159151A (en) | A kind of mechanical arm space tracking tracking dynamic compensation method and system | |
| CN112051590A (en) | Detection method and related device for laser radar and inertial measurement unit | |
| CN106774374B (en) | Automatic unmanned aerial vehicle inspection method and system | |
| WO2020103049A1 (en) | Terrain prediction method and device of rotary microwave radar, and system and unmanned aerial vehicle | |
| CN110764523B (en) | Proportional-integral pre-pilot attack target method based on anti-saturation smooth transformation | |
| CN110658854B (en) | Photoelectric turret video tracking feedforward compensation method based on combined inertial navigation information application | |
| CN109655059B (en) | Vision-inertia fusion navigation system and method based on theta-increment learning | |
| Mills et al. | Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers | |
| CN109657928B (en) | Cooperative scheduling method of closed-loop cooperative scheduling framework of vehicle-mounted sensor system | |
| CN113051743A (en) | Terminal guidance system based on track online planning | |
| CN111486867B (en) | Calibration device and method for installation parameters of vision and inertia mixed tracking assembly | |
| CN115857538A (en) | Multi-aircraft cooperative guidance method meeting falling angle constraint in three-dimensional space | |
| CN112859919B (en) | Method for tracking moving target by unmanned aerial vehicle group | |
| Bai et al. | Cooperative trajectory optimization for unmanned aerial vehicles in a combat environment | |
| CN109341695B (en) | Indoor unmanned aerial vehicle navigation method based on indoor graph calibration | |
| CN111251303B (en) | Robot motion control method for periodic attitude adjustment | |
| WO2021217341A1 (en) | Obstacle avoidance method, moveable platform, control device, and storage medium | |
| CN113076634A (en) | Multi-machine cooperative passive positioning method, device and system | |
| JP2021119458A (en) | Obstacle speed determination method, device, electronic instrument, storage medium and computer program | |
| CN112947569A (en) | Visual servo target tracking control method for quad-rotor unmanned aerial vehicle based on preset performance | |
| WO2021056503A1 (en) | Positioning method and apparatus for movable platform, movable platform, and storage medium | |
| CN113689501B (en) | Double-machine cooperative target machine positioning tracking control method based on convergence point |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |