CN111880557A - Unmanned aerial vehicle cluster formation flight control method and device - Google Patents

Unmanned aerial vehicle cluster formation flight control method and device Download PDF

Info

Publication number
CN111880557A
CN111880557A CN202010633464.1A CN202010633464A CN111880557A CN 111880557 A CN111880557 A CN 111880557A CN 202010633464 A CN202010633464 A CN 202010633464A CN 111880557 A CN111880557 A CN 111880557A
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
following
flight
drone
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.)
Pending
Application number
CN202010633464.1A
Other languages
Chinese (zh)
Inventor
任小广
王彦臻
周浩
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
National Defense Technology Innovation Institute PLA Academy of Military Science
Original Assignee
National Defense Technology Innovation Institute PLA Academy of Military Science
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by National Defense Technology Innovation Institute PLA Academy of Military Science filed Critical National Defense Technology Innovation Institute PLA Academy of Military Science
Priority to CN202010633464.1A priority Critical patent/CN111880557A/en
Publication of CN111880557A publication Critical patent/CN111880557A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying

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 relates to a method and a device for controlling formation flight of unmanned aerial vehicle clusters, comprising the following steps: determining a yaw angle and a flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight trajectory of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation; controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation; the invention can realize real-time maintenance and real-time configuration of the unmanned aerial vehicle cluster formation form and improve the flexibility of the cluster formation form conversion.

Description

Unmanned aerial vehicle cluster formation flight control method and device
Technical Field
The invention relates to the technical field of unmanned aerial vehicle control, in particular to a method and a device for controlling formation flight of unmanned aerial vehicle clusters.
Background
Unmanned aerial vehicles are increasingly widely applied in various fields such as cargo delivery, disaster resistance rescue, communication relay, investigation and patrol. In order to efficiently complete high-strength complex tasks, autonomous cooperation of the unmanned aerial vehicle cluster gradually becomes a feasible and mature mainstream solution. In the process of cluster movement of the unmanned aerial vehicle, formation flying is adopted, so that wind resistance is reduced, and oil consumption is saved.
The most widely applied formation control algorithm at present is a leader-follower method, namely, a certain relative distance is kept between a follower following unmanned aerial vehicle follower and a leader navigating unmanned aerial vehicle in an unmanned aerial vehicle cluster, and the unmanned aerial vehicle cluster flies along the motion trail of the leader navigating unmanned aerial vehicle. The method has the advantages that the cooperative mode is simple, the communication traffic does not increase along with the change of the cluster scale, and the defects that the formation speed of the cluster formation is slow, the formation maintaining effect is poor and the formation conversion flexibility is low.
Disclosure of Invention
Aiming at the defects of the prior art, the invention aims to control the following unmanned aerial vehicle in real time through the obtained velocity vector of the following unmanned aerial vehicle, namely the yaw angle and the flight rate, and solve the problems of low formation speed of the unmanned aerial vehicle cluster formation, poor formation shape maintaining effect and low formation shape conversion flexibility.
The purpose of the invention is realized by adopting the following technical scheme:
the invention provides an unmanned aerial vehicle cluster formation flight control method, which is improved in that the method comprises the following steps:
determining a yaw angle and a flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight trajectory of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation;
and controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation.
Preferably, the above determining the yaw angle and the flight rate of the following drones in the cluster formation of drones based on the flight trajectory of the piloted drones in the cluster formation of drones includes:
when the flight track of the piloting unmanned aerial vehicle is a straight line, determining a yaw angle of the following unmanned aerial vehicle according to an included angle between the acquired flight track and the due north direction and a transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, and determining the flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle and the acquired longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle;
when the flight track of the piloting unmanned aerial vehicle is a circular arc, determining the yaw angle of the following unmanned aerial vehicle according to the acquired included angle between the line of the following unmanned aerial vehicle and the circle center and the due north direction, and determining the flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle, the flight radius of the piloting unmanned aerial vehicle and the acquired included angle between the line of the following unmanned aerial vehicle and the circle center and the line of the piloting unmanned aerial vehicle and the circle center.
Further, the aforesaid is according to the contained angle of flight orbit and the due north direction who acquires and the lateral distance who follows unmanned aerial vehicle and pilot unmanned aerial vehicle and confirms the yaw angle who follows unmanned aerial vehicle, includes:
determining the following unmanned aerial vehicle yaw angle byf
Figure BDA0002566778670000021
In the formula, yawlineIs the included angle between the flight track and the due north direction,
Figure BDA0002566778670000026
to follow the maximum adjustment of the yaw angle of the drone,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1],ydifffor following the horizontal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta y is following unmanned aerial vehicle and pilot unmanned aerial vehicle's horizontal distance target value.
Further, the aforesaid is according to the flight rate of pilot unmanned aerial vehicle and the vertical distance who acquires follow unmanned aerial vehicle and pilot unmanned aerial vehicle and is confirmed the flight rate who follows unmanned aerial vehicle, includes:
determining the flight velocity v of the following drone according to the formulaf
Figure BDA0002566778670000022
In the formula, vlTo pilot the flight rate of the drone,
Figure BDA0002566778670000023
to follow the maximum adjustment in the rate of flight of the drone,
Figure BDA0002566778670000024
vin order to follow the maximum flight rate of the drone,vto follow the convergent speed control of the unmanned aerial vehicle flight rate,v∈[0,1],xdiffin order to follow the longitudinal distance between the drone and the piloting drone,and delta x is a longitudinal distance target value of the following unmanned aerial vehicle and the piloting unmanned aerial vehicle.
Furthermore, the included angle yaw between the flight path and the due north direction is determined according to the following formulaline
Figure BDA0002566778670000025
In the formula, qnDue to the north component of the direction vector of the flight path, qeIs the righteast component of the flight trajectory direction vector,
Figure BDA0002566778670000031
further, determining the transverse distance y between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle according to the following formuladiffAnd a longitudinal distance xdiff
Figure BDA0002566778670000032
In the formula, yawlineThe angle between the flight path and the north direction, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle in a north-east coordinate system.
Further, the aforesaid is confirmed according to the contained angle of following unmanned aerial vehicle and centre of a circle line and true north direction that acquires and follows unmanned aerial vehicle's yaw angle includes:
determining the following unmanned aerial vehicle yaw angle byf
Figure BDA0002566778670000033
In the formula, thetafTo follow the angle between the connecting line of the unmanned plane and the circle center and the true north direction, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlIn order to pilot the flight radius of the drone,
Figure BDA0002566778670000034
ρ is the flight direction of the flight trajectory,
Figure BDA0002566778670000035
dist is the distance between the unmanned aerial vehicle and the center of the flight path, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively a north coordinate and an east coordinate under a north-east coordinate system following the unmanned aerial vehicle,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1]。
further, the aforesaid is according to the flight rate of pilot unmanned aerial vehicle, the flight radius of pilot unmanned aerial vehicle and the contained angle of following unmanned aerial vehicle and centre of a circle line and pilot unmanned aerial vehicle and centre of a circle line that acquire and confirm the flight rate of following unmanned aerial vehicle, include:
obtaining the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle
Figure BDA0002566778670000036
Based on the
Figure BDA0002566778670000037
Determining the flight speed v of the following unmanned aerial vehicle according to the following formulaf
Figure BDA0002566778670000038
In the formula, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlRadius of flight for piloting unmanned aerial vehicle, vlTo pilot the flight rate of the drone,
Figure BDA0002566778670000041
Figure BDA0002566778670000042
for following the maximum adjustment of the flight rate of the drone, vTo follow the maximum flight rate of the drone.
Further, an included angle theta between a connecting line of the following unmanned aerial vehicle and the circle center and the due north direction is determined according to the following formulaf
Figure BDA0002566778670000043
In the formula, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle under a north-east coordinate system,
Figure BDA0002566778670000044
further, an included angle between a connection line of the following unmanned aerial vehicle and the circle center and a connection line of the piloting unmanned aerial vehicle and the circle center is determined according to the following formula
Figure BDA0002566778670000045
Figure BDA0002566778670000046
In the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively are the north coordinate and the east coordinate of the circle center of the flight path under a north-east coordinate system, dist is the distance between the following unmanned aerial vehicle and the circle center,
Figure BDA0002566778670000047
further, the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle is obtained
Figure BDA0002566778670000048
The method comprises the following steps:
determining a judgment value omega of the front-back position relation of the following unmanned aerial vehicle and the piloting unmanned aerial vehicle according to the following formula:
ω=sign[(el-ce)nf-(nl-cn)ef+nlce-elcn]
in the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively representing a north coordinate and an east coordinate of the circle center of a flight track under a north-east coordinate system, wherein sign is a symbolic function, wherein omega is 1, which represents that the piloting unmanned aerial vehicle is in the clockwise direction of following the unmanned aerial vehicle, omega is-1, which represents that the piloting unmanned aerial vehicle is in the counterclockwise direction of following the unmanned aerial vehicle, and omega is 0, which represents that the piloting unmanned aerial vehicle, the following unmanned aerial vehicle and the circle center are collinear;
based on the ω, determining the ω as follows
Figure BDA0002566778670000051
Figure BDA0002566778670000052
In the formula (I), the compound is shown in the specification,
Figure BDA0002566778670000053
in order to follow the angle between the connecting line of the unmanned aerial vehicle and the circle center and the connecting line of the piloting unmanned aerial vehicle and the circle center,
Figure BDA0002566778670000054
the angle is a target included angle,
Figure BDA0002566778670000055
ωMis a target value of ω, ωMRho delta x, delta y is the target value of the transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, and delta x is the following unmanned aerial vehicle and the piloting unmanned aerial vehicleP is the direction of the flight trajectory,
Figure BDA0002566778670000056
based on the same invention concept, the invention also provides an unmanned aerial vehicle cluster formation flight control device, and the improvement is that the unmanned aerial vehicle cluster formation flight control device comprises:
the speed vector calculation unit is used for determining the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight tracks of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation;
and the flight control unit is used for controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation.
Compared with the closest prior art, the invention has the following beneficial effects:
the invention provides a flight control method and device for unmanned aerial vehicle cluster formation, which are characterized in that the yaw angle and the flight rate of following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation are determined based on the flight track of piloting unmanned aerial vehicles in the unmanned aerial vehicle cluster formation; controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation; the invention can realize the real-time maintenance and real-time configuration of the unmanned aerial vehicle cluster formation form, and improves the flexibility of the cluster formation form conversion;
when the flight track is a straight line, the yaw angle and the flight rate of the following unmanned aerial vehicle are controlled based on the acquired included angle between the flight track and the due north direction, so that the accuracy of formation forming and maintaining is improved;
when the flight orbit is the circular arc, at the in-process that obtains the flight rate who follows unmanned aerial vehicle, confirm the front and back relation of following unmanned aerial vehicle and piloting unmanned aerial vehicle through the coordinate of piloting unmanned aerial vehicle, following unmanned aerial vehicle and centre of a circle, can accurately obtain the relative position who follows unmanned aerial vehicle and piloting unmanned aerial vehicle, improved the accuracy of following unmanned aerial vehicle's flight rate.
Drawings
FIG. 1 is a flow chart of a method for controlling the formation flight of a cluster of unmanned aerial vehicles according to the present invention;
FIG. 2 is a schematic position diagram of a piloting unmanned aerial vehicle and a following unmanned aerial vehicle in a straight flight trajectory in an embodiment of the invention;
FIG. 3 is a schematic position diagram of a piloting unmanned aerial vehicle and a following unmanned aerial vehicle in an arc flight trajectory in an embodiment of the invention;
fig. 4 is a schematic diagram of the unmanned aerial vehicle cluster formation flight control device.
Detailed Description
The following describes embodiments of the present invention in further detail with reference to the accompanying drawings.
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are some, but not all, embodiments of the present invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The invention provides an unmanned aerial vehicle cluster formation flight control method, as shown in fig. 1, the method comprises the following steps:
determining a yaw angle and a flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight trajectory of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation;
and controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation.
In order to more clearly illustrate the objects of the present invention, the method of the present invention is further illustrated below with reference to specific examples.
The flight track of the piloting unmanned aerial vehicle can be divided into a straight line and a circular arc, and the straight line flight track is used { (p)n,pe),(qn,qe) Denotes, pnAnd peRespectively a north coordinate and an east coordinate of a certain point on the straight flight path under a north-east coordinate system, qnAnd q iseThe north component and the east component of the direction vector of the linear flight path and the circular arc flight path are respectively { (c)n,ce) R, ρ } denotes cnAnd ceRespectively representing a north coordinate and an east coordinate of the circle center of the circular arc flight path under a north-east coordinate system, wherein r represents the radius of the circular arc flight path, and rho represents the direction of the circular arc flight path (when the circular arc flight path is viewed from high altitude in a clockwise direction, rho is 1, otherwise rho is-1). The flight trajectory of the piloting unmanned aerial vehicle can be issued to the piloting unmanned aerial vehicle by a control console or calculated in real time by a flight trajectory calculation module of the piloting unmanned aerial vehicle.
Based on this, in the embodiment of the present invention, the determining the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight trajectory of the piloted unmanned aerial vehicle in the unmanned aerial vehicle cluster formation includes:
when the flight track of the piloting unmanned aerial vehicle is a straight line, as shown in fig. 2, determining a yaw angle of the following unmanned aerial vehicle according to an included angle between the acquired flight track and the due north direction and a transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, and determining a flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle and the acquired longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle;
when the flight path of the piloting unmanned aerial vehicle is a circular arc, as shown in fig. 3, the yaw angle of the following unmanned aerial vehicle is determined according to the acquired included angle between the connecting line of the following unmanned aerial vehicle and the circle center and the due north direction, and the flight rate of the following unmanned aerial vehicle is determined according to the flight rate of the piloting unmanned aerial vehicle, the flight radius of the piloting unmanned aerial vehicle and the acquired included angle between the connecting line of the following unmanned aerial vehicle and the circle center and the connecting line of the piloting unmanned aerial vehicle and the.
In fig. 2 and 3, the dashed line aircraft indicates the target position of the following drone, and the solid line aircraft indicates the current position of the following drone.
Specifically, the aforesaid is according to the contained angle of flight orbit and the due north direction who acquires and the yaw angle of following unmanned aerial vehicle is confirmed to following unmanned aerial vehicle with leading unmanned aerial vehicle's transverse distance, includes:
determining the following unmanned aerial vehicle yaw angle byf
Figure BDA0002566778670000071
In the formula, yawlineIs the included angle between the flight track and the due north direction,
Figure BDA0002566778670000072
to follow the maximum adjustment of the yaw angle of the drone,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1],ydifffor following the horizontal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta y is following unmanned aerial vehicle and pilot unmanned aerial vehicle's horizontal distance target value.
Specifically, the aforesaid is according to the flight rate of pilot unmanned aerial vehicle and the vertical distance who acquires follow unmanned aerial vehicle and pilot unmanned aerial vehicle and is confirmed the flight rate who follows unmanned aerial vehicle, includes:
determining the flight velocity v of the following drone according to the formulaf
Figure BDA0002566778670000081
In the formula, vlTo pilot the flight rate of the drone,
Figure BDA0002566778670000082
to follow the maximum adjustment in the rate of flight of the drone,
Figure BDA0002566778670000083
vin order to follow the maximum flight rate of the drone,vto follow the convergent speed control of the unmanned aerial vehicle flight rate,v∈[0,1],xdifffor following the longitudinal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta x is the longitudinal distance target value of following unmanned aerial vehicle and pilot unmanned aerial vehicle.
As shown in fig. 2 and 3, when the distance between the following drone and the piloting drone is calculated by following the head coordinates of the two, Δ y, ydiffGreater than 0, indicating that the following drone is on the right side of the piloting drone; deltay、ydiffLess than 0, indicating that the following drone is on the left side of the piloting drone; Δ y, ydiffEqual to 0, indicating that the following unmanned aerial vehicle and the piloting unmanned aerial vehicle are longitudinally collinear;
Δx、xdiffgreater than 0, indicating that the following drone is in front of the piloting drone; Δ x, xdiffWhen the distance is less than 0, the following unmanned aerial vehicle is behind the piloting unmanned aerial vehicle; Δ x, xdiffEqual to 0, representing the following drone and the piloting drone are transversely collinear.
Specifically, the included angle yaw between the flight path and the due north direction is determined according to the following formulaline
Figure BDA0002566778670000084
In the formula, qnDue to the north component of the direction vector of the flight path, qeIs the righteast component of the flight trajectory direction vector,
Figure BDA0002566778670000085
specifically, the transverse distance y between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle is determined according to the following formuladiffAnd a longitudinal distance xdiff
Figure BDA0002566778670000086
In the formula, yawlineThe angle between the flight path and the north direction, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle in a north-east coordinate system.
Further, the aforesaid is confirmed according to the contained angle of following unmanned aerial vehicle and centre of a circle line and true north direction that acquires and follows unmanned aerial vehicle's yaw angle includes:
determining the following unmanned aerial vehicle yaw angle byf
Figure BDA0002566778670000091
In the formula, thetafTo follow the angle between the connecting line of the unmanned plane and the circle center and the true north direction, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlIn order to pilot the flight radius of the drone,
Figure BDA0002566778670000092
ρ is the flight direction of the flight trajectory,
Figure BDA0002566778670000093
dist is the distance between the unmanned aerial vehicle and the center of the flight path, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively a north coordinate and an east coordinate under a north-east coordinate system following the unmanned aerial vehicle,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1]。
specifically, the aforesaid is according to the flight rate of pilot unmanned aerial vehicle, the flight radius of pilot unmanned aerial vehicle and the contained angle of following unmanned aerial vehicle and centre of a circle line and pilot unmanned aerial vehicle and centre of a circle line that acquire and confirm the flight rate of following unmanned aerial vehicle includes:
obtaining the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle
Figure BDA0002566778670000094
Based on the
Figure BDA0002566778670000095
Determining the flight speed v of the following unmanned aerial vehicle according to the following formulaf
Figure BDA0002566778670000096
In the formula, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlRadius of flight for piloting unmanned aerial vehicle, vlTo pilot the flight rate of the drone,
Figure BDA0002566778670000097
Figure BDA0002566778670000098
for following the maximum adjustment of the flight rate of the drone, vTo follow the maximum flight rate of the drone.
Specifically, an included angle theta between a connecting line of the following unmanned aerial vehicle and the circle center and the due north direction is determined according to the following formulaf
Figure BDA0002566778670000101
In the formula, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle under a north-east coordinate system,
Figure BDA0002566778670000102
specifically, an included angle between a connection line of the following unmanned aerial vehicle and the circle center and a connection line of the piloting unmanned aerial vehicle and the circle center is determined according to the following formula
Figure BDA0002566778670000103
Figure BDA0002566778670000104
In the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively the north coordinate and the east coordinate of the center of a circle of the flight path under a north-east coordinate system, dist is the distance between the following unmanned aerial vehicle and the center of the circleAfter the separation, the water is separated from the water,
Figure BDA0002566778670000105
specifically, the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle is obtained
Figure BDA0002566778670000106
The method comprises the following steps:
determining a judgment value omega of the front-back position relation of the following unmanned aerial vehicle and the piloting unmanned aerial vehicle according to the following formula:
ω=sign[(el-ce)nf-(nl-cn)ef+nlce-elcn]
in the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively representing a north coordinate and an east coordinate of the circle center of a flight track under a north-east coordinate system, wherein sign is a symbolic function, wherein omega is 1, which represents that the piloting unmanned aerial vehicle is in the clockwise direction of following the unmanned aerial vehicle, omega is-1, which represents that the piloting unmanned aerial vehicle is in the counterclockwise direction of following the unmanned aerial vehicle, and omega is 0, which represents that the piloting unmanned aerial vehicle, the following unmanned aerial vehicle and the circle center are collinear;
based on the ω, determining the ω as follows
Figure BDA0002566778670000107
Figure BDA0002566778670000111
In the formula (I), the compound is shown in the specification,
Figure BDA0002566778670000112
in order to follow the angle between the connecting line of the unmanned aerial vehicle and the circle center and the connecting line of the piloting unmanned aerial vehicle and the circle center,
Figure BDA0002566778670000113
the angle is a target included angle,
Figure BDA0002566778670000114
ωMis a target value of ω, ωMThe value of the transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle is-rho delta x, delta y is the target value of the longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, delta x is the direction of the flight track,
Figure BDA0002566778670000115
the relative position of the following unmanned aerial vehicle follower and the pilot unmanned aerial vehicle leader cannot be completely reflected by the included angle between the connecting line of the following unmanned aerial vehicle and the circle center and the connecting line of the pilot unmanned aerial vehicle and the circle center, so that a judgment value of the front-back position relation of the following unmanned aerial vehicle and the pilot unmanned aerial vehicle is defined. If the value is larger than 0, the leader is in the clockwise direction of the follower; if the value is less than 0, the leader is in the counterclockwise direction of the follower; if the value is equal to 0, the circle center, the leader and the follower are collinear.
Based on the same inventive concept, the invention also provides an unmanned aerial vehicle cluster formation flight control device, as shown in fig. 4, comprising:
the speed vector calculation unit is used for determining the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight tracks of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation;
and the flight control unit is used for controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation.
Preferably, the velocity vector calculation unit is specifically configured to:
when the flight track of the piloting unmanned aerial vehicle is a straight line, determining a yaw angle of the following unmanned aerial vehicle according to an included angle between the acquired flight track and the due north direction and a transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, and determining the flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle and the acquired longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle;
when the flight track of the piloting unmanned aerial vehicle is a circular arc, determining the yaw angle of the following unmanned aerial vehicle according to the acquired included angle between the line of the following unmanned aerial vehicle and the circle center and the due north direction, and determining the flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle, the flight radius of the piloting unmanned aerial vehicle and the acquired included angle between the line of the following unmanned aerial vehicle and the circle center and the line of the piloting unmanned aerial vehicle and the circle center.
Further, the aforesaid is according to the contained angle of flight orbit and the due north direction who acquires and the lateral distance who follows unmanned aerial vehicle and pilot unmanned aerial vehicle and confirms the yaw angle who follows unmanned aerial vehicle, includes:
determining the following unmanned aerial vehicle yaw angle byf
Figure BDA0002566778670000121
In the formula, yawlineIs the included angle between the flight track and the due north direction,
Figure BDA0002566778670000122
to follow the maximum adjustment of the yaw angle of the drone,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1],ydifffor following the horizontal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta y is following unmanned aerial vehicle and pilot unmanned aerial vehicle's horizontal distance target value.
Further, the aforesaid is according to the flight rate of pilot unmanned aerial vehicle and the vertical distance who acquires follow unmanned aerial vehicle and pilot unmanned aerial vehicle and is confirmed the flight rate who follows unmanned aerial vehicle, includes:
determining the flight velocity v of the following drone according to the formulaf
Figure BDA0002566778670000123
In the formula, vlTo pilot the flight rate of the drone,
Figure BDA0002566778670000124
to follow the maximum adjustment in the rate of flight of the drone,
Figure BDA0002566778670000125
vin order to follow the maximum flight rate of the drone,vto follow the convergent speed control of the unmanned aerial vehicle flight rate,v∈[0,1],xdifffor following the longitudinal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta x is the longitudinal distance target value of following unmanned aerial vehicle and pilot unmanned aerial vehicle.
Furthermore, the included angle yaw between the flight path and the due north direction is determined according to the following formulaline
Figure BDA0002566778670000126
In the formula, qnDue to the north component of the direction vector of the flight path, qeIs the righteast component of the flight trajectory direction vector,
Figure BDA0002566778670000131
further, determining the transverse distance y between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle according to the following formuladiffAnd a longitudinal distance xdiff
Figure BDA0002566778670000132
In the formula, yawlineThe angle between the flight path and the north direction, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle in a north-east coordinate system.
Further, the aforesaid is confirmed according to the contained angle of following unmanned aerial vehicle and centre of a circle line and true north direction that acquires and follows unmanned aerial vehicle's yaw angle includes:
determining the following unmanned aerial vehicle yaw angle byf
Figure BDA0002566778670000133
In the formula, thetafTo follow the angle between the connecting line of the unmanned plane and the circle center and the true north direction, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlIn order to pilot the flight radius of the drone,
Figure BDA0002566778670000134
ρ is the flight direction of the flight trajectory,
Figure BDA0002566778670000135
dist is the distance between the unmanned aerial vehicle and the center of the flight path, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively a north coordinate and an east coordinate under a north-east coordinate system following the unmanned aerial vehicle,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1]。
further, the aforesaid is according to the flight rate of pilot unmanned aerial vehicle, the flight radius of pilot unmanned aerial vehicle and the contained angle of following unmanned aerial vehicle and centre of a circle line and pilot unmanned aerial vehicle and centre of a circle line that acquire and confirm the flight rate of following unmanned aerial vehicle, include:
obtaining the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle
Figure BDA0002566778670000136
Based on the
Figure BDA0002566778670000137
Determining the flight speed v of the following unmanned aerial vehicle according to the following formulaf
Figure BDA0002566778670000138
In the formula, rf=rl-ρΔy,rfIs a heelAlong with the flight radius of the unmanned aerial vehicle, rlRadius of flight for piloting unmanned aerial vehicle, vlTo pilot the flight rate of the drone,
Figure BDA0002566778670000141
Figure BDA0002566778670000142
for following the maximum adjustment of the flight rate of the drone, vTo follow the maximum flight rate of the drone.
Further, an included angle theta between a connecting line of the following unmanned aerial vehicle and the circle center and the due north direction is determined according to the following formulaf
Figure BDA0002566778670000143
In the formula, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle under a north-east coordinate system,
Figure BDA0002566778670000144
further, an included angle between a connection line of the following unmanned aerial vehicle and the circle center and a connection line of the piloting unmanned aerial vehicle and the circle center is determined according to the following formula
Figure BDA0002566778670000145
Figure BDA0002566778670000146
In the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively are the north coordinate and the east coordinate of the circle center of the flight path under a north-east coordinate system, dist is the distance between the following unmanned aerial vehicle and the circle center,
Figure BDA0002566778670000147
further, the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle is obtained
Figure BDA0002566778670000148
The method comprises the following steps:
determining a judgment value omega of the front-back position relation of the following unmanned aerial vehicle and the piloting unmanned aerial vehicle according to the following formula:
ω=sign[(el-ce)nf-(nl-cn)ef+nlce-elcn]
in the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively a north coordinate and an east coordinate of the center of a circle of the flight path under a north-east coordinate system, wherein sign is a sign function;
based on the ω, determining the ω as follows
Figure BDA0002566778670000151
Figure BDA0002566778670000152
In the formula (I), the compound is shown in the specification,
Figure BDA0002566778670000153
in order to follow the angle between the connecting line of the unmanned aerial vehicle and the circle center and the connecting line of the piloting unmanned aerial vehicle and the circle center,
Figure BDA0002566778670000154
the angle is a target included angle,
Figure BDA0002566778670000155
ωMis a target value of ω, ωMThe value of the transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle is-rho delta x, delta y is the target value of the longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, delta x is the direction of the flight track,
Figure BDA0002566778670000156
in summary, the flight control method and device for unmanned aerial vehicle cluster formation provided by the invention determine the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight trajectory of the piloting unmanned aerial vehicles in the unmanned aerial vehicle cluster formation; controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation; the invention can realize the real-time maintenance and real-time configuration of the unmanned aerial vehicle cluster formation form, and improves the flexibility of the cluster formation form conversion;
when the flight track is a straight line, the yaw angle and the flight rate of the following unmanned aerial vehicle are controlled based on the acquired included angle between the flight track and the due north direction, so that the accuracy of formation forming and maintaining is improved;
when the flight orbit is the circular arc, at the in-process that obtains the flight rate who follows unmanned aerial vehicle, confirm the front and back relation of following unmanned aerial vehicle and piloting unmanned aerial vehicle through the coordinate of piloting unmanned aerial vehicle, following unmanned aerial vehicle and centre of a circle, can accurately obtain the relative position who follows unmanned aerial vehicle and piloting unmanned aerial vehicle, improved the accuracy of following unmanned aerial vehicle's flight rate.
As will be appreciated by one skilled in the art, embodiments of the present application may be provided as a method, system, or computer program product. Accordingly, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment or an embodiment combining software and hardware aspects. Furthermore, the present application may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, and the like) having computer-usable program code embodied therein.
The present application is described with reference to flowchart illustrations and/or block diagrams of methods, apparatus (systems), and computer program products according to embodiments of the application. It will be understood that each flow and/or block of the flow diagrams and/or block diagrams, and combinations of flows and/or blocks in the flow diagrams and/or block diagrams, can be implemented by computer program instructions. These computer program instructions may be provided to a processor of a general purpose computer, special purpose computer, embedded processor, or other programmable data processing apparatus to produce a machine, such that the instructions, which execute via the processor of the computer or other programmable data processing apparatus, create means for implementing the functions specified in the flowchart flow or flows and/or block diagram block or blocks.
These computer program instructions may also be stored in a computer-readable memory that can direct a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory produce an article of manufacture including instruction means which implement the function specified in the flowchart flow or flows and/or block diagram block or blocks.
These computer program instructions may also be loaded onto a computer or other programmable data processing apparatus to cause a series of operational steps to be performed on the computer or other programmable apparatus to produce a computer implemented process such that the instructions which execute on the computer or other programmable apparatus provide steps for implementing the functions specified in the flowchart flow or flows and/or block diagram block or blocks.
Finally, it should be noted that: the above embodiments are only for illustrating the technical solutions of the present invention and not for limiting the same, and although the present invention is described in detail with reference to the above embodiments, those of ordinary skill in the art should understand that: modifications and equivalents may be made to the embodiments of the invention without departing from the spirit and scope of the invention, which is to be covered by the claims.

Claims (12)

1. An unmanned aerial vehicle cluster formation flight control method is characterized by comprising the following steps:
determining a yaw angle and a flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight trajectory of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation;
and controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation.
2. The method of claim 1, wherein determining a yaw angle and a flight rate of following drones in the cluster formation of drones based on a flight trajectory of a lead drone in the cluster formation of drones comprises:
when the flight track of the piloting unmanned aerial vehicle is a straight line, determining a yaw angle of the following unmanned aerial vehicle according to an included angle between the acquired flight track and the due north direction and a transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, and determining the flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle and the acquired longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle;
when the flight track of the piloting unmanned aerial vehicle is a circular arc, determining the yaw angle of the following unmanned aerial vehicle according to the acquired included angle between the line of the following unmanned aerial vehicle and the circle center and the due north direction, and determining the flight rate of the following unmanned aerial vehicle according to the flight rate of the piloting unmanned aerial vehicle, the flight radius of the piloting unmanned aerial vehicle and the acquired included angle between the line of the following unmanned aerial vehicle and the circle center and the line of the piloting unmanned aerial vehicle and the circle center.
3. The method of claim 2, wherein determining the yaw angle of the following drone based on the angle of the acquired flight trajectory from the due north direction and the lateral distance of the following drone from the piloting drone comprises:
determining the following unmanned aerial vehicle yaw angle byf
Figure FDA0002566778660000011
In the formula, yawlineIs the flight track and the true north directionThe angle of,
Figure FDA0002566778660000012
to follow the maximum adjustment of the yaw angle of the drone,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1],ydifffor following the horizontal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta y is following unmanned aerial vehicle and pilot unmanned aerial vehicle's horizontal distance target value.
4. The method of claim 2, wherein determining the flight rate of the following drone as a function of the flight rate of the pilot drone and the acquired longitudinal distance of the following drone from the pilot drone comprises:
determining the flight velocity v of the following drone according to the formulaf
Figure FDA0002566778660000013
In the formula, vlTo pilot the flight rate of the drone,
Figure FDA0002566778660000014
to follow the maximum adjustment in the rate of flight of the drone,
Figure FDA0002566778660000021
vin order to follow the maximum flight rate of the drone,vto follow the convergent speed control of the unmanned aerial vehicle flight rate,v∈[0,1],xdifffor following the longitudinal distance of unmanned aerial vehicle and pilot unmanned aerial vehicle, delta x is the longitudinal distance target value of following unmanned aerial vehicle and pilot unmanned aerial vehicle.
5. The method of claim 2, wherein the angle yaw between the flight path and true north is determined as followsline
Figure FDA0002566778660000022
In the formula, qnDue to the north component of the direction vector of the flight path, qeIs the righteast component of the flight trajectory direction vector,
Figure FDA0002566778660000023
6. the method of claim 2, wherein the lateral distance y of the following drone from the piloting drone is determined as followsdiffAnd a longitudinal distance xdiff
Figure FDA0002566778660000024
In the formula, yawlineThe angle between the flight path and the north direction, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle in a north-east coordinate system.
7. The method of claim 2, wherein determining the yaw angle of the following drone according to the obtained included angle between the line connecting the following drone and the circle center and the due north direction comprises:
determining the following unmanned aerial vehicle yaw angle byf
Figure FDA0002566778660000025
In the formula, thetafTo follow the angle between the connecting line of the unmanned plane and the circle center and the true north direction, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlIn order to pilot the flight radius of the drone,
Figure FDA0002566778660000031
rho is flight railThe flight direction of the track, delta y is the target value of the transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle,
Figure FDA0002566778660000032
dist is the distance between the unmanned aerial vehicle and the center of the flight path, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively a north coordinate and an east coordinate under a north-east coordinate system following the unmanned aerial vehicle,yawto follow the convergence speed control of the yaw angle of the drone,yaw∈[0,1]。
8. the method of claim 2, wherein determining the flight rate of the following drone according to the flight rate of the piloting drone, the flight radius of the piloting drone, and the obtained included angle between the line connecting the following drone and the circle center and the line connecting the piloting drone and the circle center comprises:
obtaining the difference value between the included angle between the following unmanned aerial vehicle and the circle center connecting line and the piloting unmanned aerial vehicle and the circle center connecting line and the target included angle
Figure FDA0002566778660000033
Based on the
Figure FDA0002566778660000034
Determining the flight speed v of the following unmanned aerial vehicle according to the following formulaf
Figure FDA0002566778660000035
In the formula, rf=rl-ρΔy,rfTo follow the flight radius of the drone, rlIn order to pilot the flight radius of the drone,
Figure FDA0002566778660000036
rho is the flight direction of the flight track, delta y is the target value of the transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, vlTo pilot the flight rate of the drone,
Figure FDA0002566778660000037
Figure FDA0002566778660000038
for following the maximum adjustment of the flight rate of the drone, vTo follow the maximum flight rate of the drone.
9. A method according to claim 2 or 7, wherein the following drone and the line connecting the centre of the circle are determined to be at an angle θ to true north according to the following equationf
Figure FDA0002566778660000041
In the formula, cnAnd ceRespectively a north coordinate and an east coordinate of the center of a flight path under a north-east coordinate system, nfAnd efRespectively the north coordinate and the east coordinate of the following unmanned aerial vehicle under a north-east coordinate system,
Figure FDA0002566778660000042
10. a method according to claim 2 or 8, wherein the angle between the line connecting the following drone and the centre of the circle and the line connecting the piloting drone and the centre of the circle is determined as follows
Figure FDA0002566778660000043
Figure FDA0002566778660000044
In the formula, nlAnd elRespectively the north coordinate and east coordinate of the piloting unmanned plane under the north-east coordinate systemSymbol, nfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively are the north coordinate and the east coordinate of the circle center of the flight path under a north-east coordinate system, dist is the distance between the following unmanned aerial vehicle and the circle center,
Figure FDA0002566778660000045
11. the method of claim 8, wherein the obtaining of the difference between the target angle and the angle between the line connecting the following drone and the circle center and the line connecting the piloting drone and the circle center is obtained
Figure FDA0002566778660000046
The method comprises the following steps:
determining a judgment value omega of the front-back position relation of the following unmanned aerial vehicle and the piloting unmanned aerial vehicle according to the following formula:
ω=sign[(el-ce)nf-(nl-cn)ef+nlce-elcn]
in the formula, nlAnd elRespectively a north coordinate and an east coordinate, n, of the piloted unmanned plane in a north-east coordinate systemfAnd efNorth and east coordinates, c, respectively, of the following drone in a north-east coordinate systemnAnd ceRespectively representing a north coordinate and an east coordinate of the circle center of a flight track under a north-east coordinate system, wherein sign is a symbolic function, wherein omega is 1, which represents that the piloting unmanned aerial vehicle is in the clockwise direction of following the unmanned aerial vehicle, omega is-1, which represents that the piloting unmanned aerial vehicle is in the counterclockwise direction of following the unmanned aerial vehicle, and omega is 0, which represents that the piloting unmanned aerial vehicle, the following unmanned aerial vehicle and the circle center are collinear;
based on the ω, determining the ω as follows
Figure FDA0002566778660000047
Figure FDA0002566778660000051
In the formula (I), the compound is shown in the specification,
Figure FDA0002566778660000052
in order to follow the angle between the connecting line of the unmanned aerial vehicle and the circle center and the connecting line of the piloting unmanned aerial vehicle and the circle center,
Figure FDA0002566778660000053
the angle is a target included angle,
Figure FDA0002566778660000054
ωMis a target value of ω, ωMThe value of the transverse distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle is-rho delta x, delta y is the target value of the longitudinal distance between the following unmanned aerial vehicle and the piloting unmanned aerial vehicle, delta x is the direction of the flight track,
Figure FDA0002566778660000055
12. the utility model provides an unmanned aerial vehicle cluster formation flight control device which characterized in that includes:
the speed vector calculation unit is used for determining the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation based on the flight tracks of the piloted unmanned aerial vehicles in the unmanned aerial vehicle cluster formation;
and the flight control unit is used for controlling the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation according to the yaw angle and the flight rate of the following unmanned aerial vehicles in the unmanned aerial vehicle cluster formation.
CN202010633464.1A 2020-07-02 2020-07-02 Unmanned aerial vehicle cluster formation flight control method and device Pending CN111880557A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010633464.1A CN111880557A (en) 2020-07-02 2020-07-02 Unmanned aerial vehicle cluster formation flight control method and device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010633464.1A CN111880557A (en) 2020-07-02 2020-07-02 Unmanned aerial vehicle cluster formation flight control method and device

Publications (1)

Publication Number Publication Date
CN111880557A true CN111880557A (en) 2020-11-03

Family

ID=73151455

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010633464.1A Pending CN111880557A (en) 2020-07-02 2020-07-02 Unmanned aerial vehicle cluster formation flight control method and device

Country Status (1)

Country Link
CN (1) CN111880557A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113311859A (en) * 2021-05-10 2021-08-27 北京航空航天大学 Finite-time affine formation flight control method for unmanned aerial vehicle cluster
CN114115356A (en) * 2022-01-25 2022-03-01 北京神导科技股份有限公司 Method for calculating formation reference data for airplane flight performance
CN116974291A (en) * 2023-09-25 2023-10-31 农业农村部南京农业机械化研究所 Control error determining method and device for master-slave cooperative navigation agricultural machinery

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007016905A1 (en) * 2005-08-09 2007-02-15 Eads Deutschland Gmbh Method for flight control of a plurality of aircraft flying in formation
CN102591358A (en) * 2012-03-12 2012-07-18 北京航空航天大学 Multi-UAV (unmanned aerial vehicle) dynamic formation control method
CN107608385A (en) * 2017-10-25 2018-01-19 南京航空航天大学 Depopulated helicopter formation control method and control system
CN107807663A (en) * 2017-11-29 2018-03-16 南京航空航天大学 Unmanned plane based on Self Adaptive Control, which is formed into columns, keeps control method
CN108388269A (en) * 2018-03-17 2018-08-10 青岛理工大学 UAV Formation Flight control method based on quadrotor
CN111176333A (en) * 2020-04-07 2020-05-19 成都纵横自动化技术股份有限公司 Flight control method and device, autopilot and aircraft
CN111295627A (en) * 2017-05-05 2020-06-16 上海峰飞航空科技有限公司 Underwater piloting unmanned aerial vehicle system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007016905A1 (en) * 2005-08-09 2007-02-15 Eads Deutschland Gmbh Method for flight control of a plurality of aircraft flying in formation
CN102591358A (en) * 2012-03-12 2012-07-18 北京航空航天大学 Multi-UAV (unmanned aerial vehicle) dynamic formation control method
CN111295627A (en) * 2017-05-05 2020-06-16 上海峰飞航空科技有限公司 Underwater piloting unmanned aerial vehicle system
CN107608385A (en) * 2017-10-25 2018-01-19 南京航空航天大学 Depopulated helicopter formation control method and control system
CN107807663A (en) * 2017-11-29 2018-03-16 南京航空航天大学 Unmanned plane based on Self Adaptive Control, which is formed into columns, keeps control method
CN108388269A (en) * 2018-03-17 2018-08-10 青岛理工大学 UAV Formation Flight control method based on quadrotor
CN111176333A (en) * 2020-04-07 2020-05-19 成都纵横自动化技术股份有限公司 Flight control method and device, autopilot and aircraft

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
WEN-DI WU 等: "Multi-UAV surveillance implementation under hierarchical dynamic task scheduling architecture", JOURNAL OF CENTRAL SOUTH UNIVERSITY, no. 27, pages 2614 - 2627 *
杨希祥;张家实;: "基于路径跟踪的平流层飞艇柔性编队控制", 国防科技大学学报, no. 05, pages 43 - 47 *
邵壮: "多无人机编队路径规划与队形控制技术研究", 中国博士学位论文全文数据库 工程科技Ⅱ辑, pages 4 - 5 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113311859A (en) * 2021-05-10 2021-08-27 北京航空航天大学 Finite-time affine formation flight control method for unmanned aerial vehicle cluster
CN113311859B (en) * 2021-05-10 2022-05-10 北京航空航天大学 Finite-time affine formation flight control method for unmanned aerial vehicle cluster
CN114115356A (en) * 2022-01-25 2022-03-01 北京神导科技股份有限公司 Method for calculating formation reference data for airplane flight performance
CN116974291A (en) * 2023-09-25 2023-10-31 农业农村部南京农业机械化研究所 Control error determining method and device for master-slave cooperative navigation agricultural machinery

Similar Documents

Publication Publication Date Title
CN111880557A (en) Unmanned aerial vehicle cluster formation flight control method and device
CN107390691B (en) AGV path tracking method
US20060015247A1 (en) Bezier curve flightpath guidance using moving waypoints
CN106681327B (en) A kind of the intelligent driving transverse and longitudinal decoupling control method and system of big inertial electrodynamic car
CN108983816B (en) Multi-rotor unmanned aerial vehicle variable-scale cooperative monitoring formation flight control method
CN107515617B (en) Method for controlling smooth switching of air route of fixed-wing unmanned aerial vehicle
US10643346B2 (en) Target tracking method performed by a drone, related computer program, electronic system and drone
US20100168937A1 (en) Method for Flight Control of a Plurality of Aircraft Flying in Formation
CN109085849A (en) A kind of autonomous control method of Shipborne UAV accuracy
CN112198886B (en) Unmanned aerial vehicle control method for tracking maneuvering target
CN108388269A (en) UAV Formation Flight control method based on quadrotor
CN105045284A (en) Anti-interference drone path tracking control method
CN111696339A (en) Car following control method and system for automatic driving fleet and car
US11490056B2 (en) Drone system and method of capturing image of vehicle by drone
CN112198885B (en) Unmanned aerial vehicle control method capable of meeting autonomous landing requirement of maneuvering platform
CN110032214B (en) Vector field-based fast Standoff target tracking method
Mills et al. Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers
CN114237298B (en) Control method and system for unmanned aerial vehicle formation in-flight plane to follow long plane
CN109211260A (en) The driving path method and device for planning of intelligent vehicle, intelligent vehicle
CN113867393B (en) Unmanned aerial vehicle formation reconstruction method with controllable flight path
CN109814550A (en) It is a kind of for closing the unmanned transport vehicle of garden
CN105786015A (en) Unmanned plane formation control system based on Arkbird A flight control system, and control method
US20180032074A1 (en) Navigating an unmanned aerial vehicle
CN111081072A (en) Accurate FAF circular approach method based on equiangular route
US10459456B2 (en) Autonomous helicopter posture regulation to moving reference frames

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