CN113157000A - Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field - Google Patents

Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field Download PDF

Info

Publication number
CN113157000A
CN113157000A CN202110499631.2A CN202110499631A CN113157000A CN 113157000 A CN113157000 A CN 113157000A CN 202110499631 A CN202110499631 A CN 202110499631A CN 113157000 A CN113157000 A CN 113157000A
Authority
CN
China
Prior art keywords
formula
formation
unmanned aerial
control
virtual
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
Application number
CN202110499631.2A
Other languages
Chinese (zh)
Other versions
CN113157000B (en
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.)
Northwestern Polytechnical University
AVIC Chengdu Aircraft Design and Research Institute
Original Assignee
Northwestern Polytechnical University
AVIC Chengdu Aircraft Design and Research Institute
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 Northwestern Polytechnical University, AVIC Chengdu Aircraft Design and Research Institute filed Critical Northwestern Polytechnical University
Priority to CN202110499631.2A priority Critical patent/CN113157000B/en
Publication of CN113157000A publication Critical patent/CN113157000A/en
Application granted granted Critical
Publication of CN113157000B publication Critical patent/CN113157000B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Abstract

The invention relates to a flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field, belongs to the field of formation flight control, and is used for formation obstacle avoidance control of multiple unmanned aerial vehicles and processing the influence of dynamics uncertainty of an unmanned aerial vehicle model. The method adopts a virtual formation structure and an artificial potential field strategy, and combines a target track of a formation reference point and a formation virtual structure mass point kinematics model to obtain a virtual mass point motion track under collision avoidance and obstacle avoidance as an expected instruction of a closed-loop system. And the control input of the unmanned aerial vehicle is designed by adopting a backstepping method, so that the target tracking control under formation accurate maintenance and effective obstacle avoidance is realized. The dynamics uncertainty of the neural network estimation model is utilized, a serial-parallel model is established to obtain a parallel estimation state, a learning evaluation index of a prediction error mining system is established, and a neural network weight updating law is designed by combining a tracking error. The invention enhances the accuracy of uncertain estimation and provides a new technical approach for improving the formation flight performance.

Description

Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field
Technical Field
The invention relates to a multi-aircraft tracking control method, in particular to a flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field, and belongs to the field of formation flight control.
Background
With the wide application of unmanned aerial vehicles in military and civil use, the flight control technology for formation of multiple unmanned aerial vehicles has important application value in realizing tasks such as cooperative reconnaissance and battle, pesticide spraying and the like. Aiming at multi-unmanned aerial vehicle cooperative tracking control, the strategy based on the virtual structure integrally describes group behaviors and simplifies task description and distribution, and higher formation control accuracy can be obtained. Aiming at collision avoidance and formation obstacle avoidance control of unmanned aerial vehicles between formations, a cooperative control algorithm is designed by combining an artificial potential field and a virtual structure to realize accurate formation maintenance and effective obstacle avoidance. Considering the influence of dynamics uncertainty and nonlinearity existing in an unmanned aerial vehicle system on formation flight tracking performance, an intelligent control algorithm for estimating by using the approximation capability of a neural network is widely researched. However, the current intelligent control can only ensure the stability of the system and neglects the evaluation of the expected nonlinear estimation performance. In order to improve the performance of cooperative tracking control and ensure the nonlinear estimation effect, the research on the compound learning strategy based on parallel estimation has important significance on formation flight safety.
Composite Learning finish-Time Control With Application to Quadrotors (B.xu, IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2018, volume 48, No. 10) designs a Finite-Time neural network Control algorithm aiming at an under-actuated unmanned aerial vehicle, and the research goal of the thesis is to realize the tracking of the unmanned aerial vehicle individual to an expected track instruction. Virtual leaders, intellectual features and coordinated Control of groups (Leonard N E, Fiorelli E, IEEE Conference on Decision and Control, 2001) design a multi-agent formation Control algorithm based on artificial potential fields and Virtual agents. The thesis takes the virtual leader as a reference point, and controls the formation of the multi-agent by adjusting the artificial potential field. However, the control algorithm designed by the paper depends on the dynamic characteristics of the model, and the rapid and stable control of the system is difficult to realize.
Disclosure of Invention
Technical problem to be solved
Aiming at maintaining and avoiding control of formation of multiple unmanned aerial vehicles and considering the influence of model dynamics uncertainty on control precision, the invention provides a flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field.
Technical scheme
A flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field is characterized by comprising the following steps:
step 1: adopting a dynamic model of the unmanned aerial vehicle:
Figure BDA0003052981660000021
wherein x, y, z are positions,
Figure BDA0003052981660000022
roll angle, theta pitch angle, psi yaw angle, m mass, g gravitational acceleration, Ix,Iy,IzFor the inertial matrix, l is the distance from the center of mass of the unmanned aerial vehicle to the center of the rotor, JrIs the moment of inertia of the motor, omegar＝ω2+ω4-ω1-ω3，ωiThe rotation speed of the ith motor is 1,2,3, 4; u shape1,U2,U3,U4The control inputs for vertical, roll, pitch, and yaw motions, respectively, are:
Figure BDA0003052981660000023
wherein b is a lift coefficient, and d is a moment coefficient;
step 2: decoupling the unmanned aerial vehicle dynamic model to obtain a position subsystem and an attitude subsystem; definition of xj，1＝zj，
Figure BDA0003052981660000031
The jth drone altitude subsystem dynamics may be written as:
Figure BDA0003052981660000032
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000033
τj，1＝Uj，1in order to control the input of the electronic device,
Figure BDA0003052981660000034
for the unknown smooth function obtained from equation (1),
Figure BDA0003052981660000035
a known function obtained by the formula (1), wherein j is the number of the unmanned aerial vehicles in the formation, j is 1, … N, and N is the number of the unmanned aerial vehicles in the flying formation;
definition of xj,3＝xj，xj,4＝yj，
Figure BDA0003052981660000036
Figure BDA0003052981660000037
Assuming that the attitude angle near the equilibrium position is small; the jth horizontal motion dynamics of the unmanned aerial vehicle can be simplified as follows:
Figure BDA0003052981660000038
the jth drone attitude subsystem dynamics may be written as:
Figure BDA0003052981660000039
in the formula (I), the compound is shown in the specification,
Figure BDA00030529816600000310
τj,2＝[Uj,2,Uj,3,Uj,4]in order to control the input of the electronic device,
Figure BDA00030529816600000311
for the unknown smooth function obtained from equation (1),
Figure BDA00030529816600000312
a known function derived from formula (1);
and step 3: the positions and the yaw angles of the unmanned aerial vehicle formation particles are designed as follows:
Figure BDA00030529816600000313
in the formula, xj,rd,yj,rd,zj,rdPosition signal of formation particle for jth drone, psij,rdYaw angle signal, x, for the jth drone formation particled,yd,zdFor position expectation command of formation reference point, #dAn instruction is expected for the yaw angle of the formation,
Figure BDA00030529816600000314
for the relative position of the jth drone formation particle and the reference point,
Figure BDA00030529816600000315
forming a relative yaw angle of a particle and a reference point for the jth unmanned aerial vehicle;
the virtual structure particle model is described as:
Figure BDA0003052981660000041
in the formula, xj,d,yj,d,zj,dIs the position signal of the jth virtual dot, μj,1,μj,2,μj,3A control input signal of the jth virtual dot;
the virtual particle control inputs are designed as:
Figure BDA0003052981660000042
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000043
is a negative gradient term of the artificial potential field, V (-) is a total potential energy function of the particle,
Figure BDA0003052981660000044
Figure BDA0003052981660000045
for formation obstacle avoidance, Vm(. is obstacle avoidance potential energy of mass point, c11＞0，c12＞0，c21＞0，c22＞0，c31＞0，c32More than 0 is a design parameter;
assuming particle j is in the potential field generated by neighboring particles, the total potential energy function of the jth particle is defined as:
Figure BDA0003052981660000046
in the formula, the kth drone is a neighbor node of the ith drone, and Φ (·) is a potential energy function represented as follows:
Figure BDA0003052981660000047
k is a potential field intensity coefficient, a proper value is selected according to the inertia of the unmanned aerial vehicle and the control output of an actuating mechanism, and R is a potential field action range;
defining the obstacle avoidance potential energy function of the mass point as:
Figure BDA0003052981660000051
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000052
the coordinates of the projection point of the mass point j on the obstacle avoidance area (O)xm,Oym,Ozm) Position surrounding the centre of the circle for the m-th obstacle, RkThe radius of a circle is enclosed, M is an obstacle number, M is 1, …, M is the number of obstacles;
the desired heading angle of the virtual particle is defined as:
ψj，d＝ψj,rd+ψj，t (12)
in the formula, #j,tIs an equal azimuth heading angle, which can be expressed as:
Figure BDA0003052981660000053
wherein, Deltae0 is the designed forward-looking distance;
and 4, step 4: defining an altitude tracking error e for the altitude subsystem (3)j,1＝xj,1-zj,d(ii) a Designing virtual control quantities
Figure BDA0003052981660000054
Comprises the following steps:
Figure BDA0003052981660000055
in the formula, kj,1The more than 0 is the design parameter,
Figure BDA0003052981660000056
is the derivative of the highly desired instruction;
the first order filter is designed as follows:
Figure BDA0003052981660000057
in the formula, τj,1The parameters > 0 of the filter are the parameters of the filter,
Figure BDA0003052981660000058
design of the compensation signal zj,1Comprises the following steps:
Figure BDA0003052981660000059
in the formula, zj,2Given in subsequent designs;
tracking error after compensation is defined as:
vj,1＝ej,1-zj,1 (17)
defining a tracking error as
Figure BDA0003052981660000061
Designing the actual control input τj,1Comprises the following steps:
Figure BDA0003052981660000062
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000063
for the optimal weight estimation value of the neural network,
Figure BDA0003052981660000064
is a vector of basis functions of the neural network, kj,2More than 0 is a design parameter;
design of the compensation signal zj,2Comprises the following steps:
Figure BDA0003052981660000065
tracking error after compensation is defined as:
vj,2＝ej,2-zj,2 (20)
the prediction error is defined as:
Figure BDA0003052981660000066
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000067
for parallel estimation of states, it is obtained by the following serial-parallel model:
Figure BDA0003052981660000068
wherein, betaj,1More than 0 is a design parameter;
designing a neural network adaptive updating law as follows:
Figure BDA0003052981660000069
in the formula, λj,1＞0，kj,ω1> 0 and deltaj,f1More than 0 is a design parameter;
and 5: for horizontal motion (4), the design PD controller calculates the expected acceleration as:
Figure BDA00030529816600000610
in the formula, kj,3＞0，kj,4＞0，kj,5＞0，kj,6The more than 0 is the design parameter,
Figure BDA00030529816600000611
the derivative of the desired command for horizontal position;
obtaining the desired roll and pitch angles as:
Figure BDA0003052981660000071
step (ii) of6: for the attitude sub-system (5), defining an attitude angle tracking error as ej,X1＝Xj,1-Xj,dWherein
Figure BDA0003052981660000072
An attitude angle expectation command; designing virtual control quantities
Figure BDA0003052981660000073
Comprises the following steps:
Figure BDA0003052981660000074
in the formula, kj,7The more than 0 is the design parameter,
Figure BDA0003052981660000075
a derivative of the desired command for attitude angle;
the first order filter is designed as follows:
Figure BDA0003052981660000076
in the formula, τj,2The parameters > 0 of the filter are the parameters of the filter,
Figure BDA0003052981660000077
design of the compensation signal zj,3Comprises the following steps:
Figure BDA0003052981660000078
in the formula, zj,4Given in subsequent designs;
tracking error after compensation is defined as:
νj,3＝ej,X1-zj,3 (29)
defining a tracking error as
Figure BDA0003052981660000079
Designing the actual control input τj,2Comprises the following steps:
Figure BDA00030529816600000710
in the formula (I), the compound is shown in the specification,
Figure BDA00030529816600000711
is an estimation value of the optimal weight of the neural network,
Figure BDA00030529816600000712
is a vector of basis functions of the neural network, kj,8More than 0 is a design parameter;
design of the compensation signal zj,4Comprises the following steps:
Figure BDA00030529816600000713
tracking error after compensation is defined as:
vj,4＝ej,X2-zj,4 (32)
the prediction error is defined as:
Figure BDA0003052981660000081
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000082
for parallel estimation of states, it is obtained by the following serial-parallel model:
Figure BDA0003052981660000083
wherein, betaj,2More than 0 is a design parameter;
designing a neural network adaptive updating law as follows:
Figure BDA0003052981660000084
in the formula, λj,2＞0，kj,ω2> 0 and deltaj,f2More than 0 is a design parameter;
and 7: the obtained control input U of the vertical, rolling, pitching and yawing motionj,1,Uj,2,Uj,3,Uj,4Returning to the dynamics model of the unmanned aerial vehicle system, and realizing the expected instruction x under formation maintenance and obstacle avoidanced,yd，zdAnd performing tracking control.
A computer system, comprising: one or more processors, a computer readable storage medium, for storing one or more programs, which when executed by the one or more processors, cause the one or more processors to implement the above-described method.
A computer-readable storage medium having stored thereon computer-executable instructions for performing the above-described method when executed.
A computer program comprising computer executable instructions which when executed perform the method described above.
Advantageous effects
The invention provides a flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field. The dynamics uncertainty of the unmanned aerial vehicle model is estimated by adopting a neural network algorithm, a serial-parallel model is established to obtain a parallel estimation state and construct prediction error evaluation estimation capability, and the tracking error is applied to a self-adaptive updating law, so that the uncertainty learning capability of the unmanned aerial vehicle is improved, and the system control performance is improved. The beneficial effects are as follows:
(1) the invention adopts a coordination strategy of a virtual formation structure and combines a formation reference point to form an expected organization formation; acquiring a particle track signal of a virtual structure as an expected instruction of a closed-loop system by the action of attractive force and repulsive force between unmanned aerial vehicles based on an artificial potential field strategy;
(2) the dynamics uncertainty of the under-actuated unmanned aerial vehicle is considered, the unknown nonlinearity is estimated by adopting a neural network algorithm, the control input is designed based on a backstepping method and fed forward to an unmanned aerial vehicle model, and the target tracking under formation accurate maintenance and obstacle avoidance is realized;
(3) the method deeply analyzes system dynamics, establishes a serial-parallel model to obtain a parallel estimation state so as to construct a prediction error mining estimation evaluation index, designs a self-adaptive updating law by combining tracking error design, and improves uncertain learning precision.
Drawings
The drawings are only for purposes of illustrating particular embodiments and are not to be construed as limiting the invention, wherein like reference numerals are used to designate like parts throughout.
Fig. 1 is a flow chart of a flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention will be described in further detail below with reference to the accompanying drawings and examples. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. In addition, the technical features involved in the embodiments of the present invention described below may be combined with each other as long as they do not conflict with each other.
Referring to fig. 1, the invention relates to a flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field, which is realized by the following steps:
(a) adopting a dynamic model of the unmanned aerial vehicle:
Figure BDA0003052981660000101
wherein x, y, z are positions,
Figure BDA0003052981660000102
roll angle, theta pitch angle, psi yaw angle, m 2.3kg mass, g 9.81m/s2As acceleration of gravity, Ix＝1.676×10-2kg·m2，Iy＝1.676×10-2kg·m2，Iz＝2.314×10- 2kg·m2Is an inertia matrix, l is the distance from the center of mass of the unmanned aerial vehicle to the center of the rotor wing, J is 0.1725mr＝3.36×10-5kg·m2Is the moment of inertia of the motor, omegar＝ω2+ω4-ω1-ω3，ωiThe rotation speed of the ith motor is 1,2,3 and 4. U shape1,U2,U3,U4The control inputs for vertical, roll, pitch, and yaw motions, respectively, are:
Figure BDA0003052981660000103
wherein, b is 2.92 multiplied by 10-6kg · m is the lift coefficient, d 1.12 × 10-7kg·m2Is a moment coefficient.
(b) Decoupling the unmanned aerial vehicle dynamic model to obtain a position subsystem and an attitude subsystem. Definition of xj,1＝zj，
Figure BDA0003052981660000104
The jth drone altitude subsystem dynamics may be written as:
Figure BDA0003052981660000105
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000106
τj,1＝Uj,1in order to control the input of the electronic device,
Figure BDA0003052981660000107
j is the serial number of the unmanned aerial vehicle in the formation, j is 1, … N, and N is 5.
Definition of xj,3＝xj，xj,4＝yj，
Figure BDA0003052981660000111
Figure BDA0003052981660000112
The attitude angle around the equilibrium position is assumed to be small. The jth horizontal motion dynamics of the unmanned aerial vehicle can be simplified as follows:
Figure BDA0003052981660000113
the jth drone attitude subsystem dynamics may be written as:
Figure BDA0003052981660000114
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000115
τj,2＝[Uj，2，Uj,3，Uj,4]in order to control the input of the electronic device,
Figure BDA0003052981660000116
(c) the positions and the yaw angles of the unmanned aerial vehicle formation particles are designed as follows:
Figure BDA0003052981660000117
in the formula, xj,rd,yj,rd,zj,rdPosition signal of formation particle for jth drone, psij,rdFormation of jth UAVYaw angle signal, x, of a particled＝yd＝zd100m is the position expectation command for the formation reference point, #dPi/16 rad is the yaw angle expectation command in formation,
Figure BDA0003052981660000118
for the relative position of the jth drone formation particle and the reference point,
Figure BDA0003052981660000119
Figure BDA00030529816600001110
Figure BDA0003052981660000121
for the relative yaw angle of the jth drone formation particle and the reference point,
Figure BDA0003052981660000122
Figure BDA0003052981660000123
the virtual structure particle model is described as:
Figure BDA0003052981660000124
in the formula, xj,d,yj，d,zj,dIs the position signal of the jth virtual dot, μj,1,μj,2,μj,3The control input signal of the jth virtual dot.
The virtual particle control inputs are designed as:
Figure BDA0003052981660000125
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000126
for artificial potential fieldsThe negative gradient term of (c), V (-) is the total potential energy function of the particle,
Figure BDA0003052981660000127
Figure BDA0003052981660000128
for formation obstacle avoidance, Vm(. is obstacle avoidance potential energy of mass point, c11＝5，c12＝1，c21＝5，c22＝1，c31＝5，c32＝1。
Assuming particle j is in the potential field generated by neighboring particles, the total potential energy function of the jth particle is defined as:
Figure BDA0003052981660000129
in the formula, the kth drone is a neighbor node of the ith drone, and Φ (·) is a potential energy function represented as follows:
Figure BDA00030529816600001210
wherein, k-4 is the potential field intensity coefficient, and R-10 m is the potential field action range.
Defining the obstacle avoidance potential energy function of the mass point as:
Figure BDA0003052981660000131
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000132
the coordinates of the projection point of the mass point j on the obstacle avoidance area (O)xm,Oym,Ozm) For the position of the m-th obstacle surrounding the centre of the circle, Ox1＝800m,Oy1＝50m,Oz1＝300m，Ox1＝800m,Oy1＝250m,Oz1＝750m，Rk60m is the radius of the enclosing circle, m is the obstacle number,m＝1,2。
the desired heading angle of the virtual particle is defined as:
ψj,d＝ψj,rd+ψj,t (47)
in the formula, #j,tIs an equal azimuth heading angle, which can be expressed as:
Figure BDA0003052981660000133
wherein, Deltae10 is the designed look-ahead distance.
(d) For the height subsystem (3), a height tracking error is defined as. Designing virtual control quantities
Figure BDA0003052981660000134
Comprises the following steps:
Figure BDA0003052981660000135
in the formula, kj,1＝3，
Figure BDA0003052981660000136
The derivative of the highly desirable instruction.
The first order filter is designed as follows:
Figure BDA0003052981660000137
in the formula, τj,10.05 is the filter parameter,
Figure BDA0003052981660000138
design of the compensation signal zj,1Comprises the following steps:
Figure BDA0003052981660000139
in the formula, zj,2Given in the subsequent design, zj,1(0)＝0。
Tracking error after compensation is defined as:
νj,1＝ej,1-zj,1 (52)
defining a tracking error as
Figure BDA0003052981660000141
Designing the actual control input τj,1Comprises the following steps:
Figure BDA0003052981660000142
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000143
is an estimation value of the optimal weight of the neural network,
Figure BDA0003052981660000144
is a vector of basis functions of the neural network,
Figure BDA0003052981660000145
kj,2＝3。
design of the compensation signal zj,2Comprises the following steps:
Figure BDA0003052981660000146
in the formula, zj,2(0)＝0。
Tracking error after compensation is defined as:
νj,2＝ej,2-zj,2 (55)
the prediction error is defined as:
Figure BDA0003052981660000147
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000148
for parallel estimation of states, it is obtained by the following serial-parallel model:
Figure BDA0003052981660000149
wherein, betaj,1＝0.1。
Designing a neural network adaptive updating law as follows:
Figure BDA00030529816600001410
in the formula, λj,1＝0.1，kj,ω1100 and δj,f1＝0.1。
(e) For horizontal motion (4), the design PD controller calculates the expected acceleration as:
Figure BDA0003052981660000151
in the formula, kj,3＝1，kj,4＝1，kj,5＝1，kj,6＝1，
Figure BDA0003052981660000152
The derivative of the command is expected for horizontal position.
Obtaining the desired roll and pitch angles as:
Figure BDA0003052981660000153
(f) for the attitude sub-system (5), defining an attitude angle tracking error as ej，X1＝Xj，1-Xj，dWherein
Figure BDA0003052981660000154
The command is expected for the attitude angle. Designing virtual control quantities
Figure BDA0003052981660000155
Comprises the following steps:
Figure BDA0003052981660000156
in the formula, kj,7The number 5 is a design parameter,
Figure BDA0003052981660000157
the derivative of the desired command is the attitude angle.
The first order filter is designed as follows:
Figure BDA0003052981660000158
in the formula, τj,20.05 is the filter parameter,
Figure BDA0003052981660000159
design of the compensation signal zj,3Comprises the following steps:
Figure BDA00030529816600001510
in the formula, zj,4Given in the subsequent design, zj,3(0)＝0。
Tracking error after compensation is defined as:
vj,3＝ej,X1-zj,3 (64)
defining a tracking error as
Figure BDA00030529816600001511
Designing the actual control input τj,2Comprises the following steps:
Figure BDA00030529816600001512
in the formula (I), the compound is shown in the specification,
Figure BDA00030529816600001513
is an estimation value of the optimal weight of the neural network,
Figure BDA00030529816600001514
is a vector of basis functions of the neural network,
Figure BDA00030529816600001515
kj,8＝5。
design of the compensation signal zj,4Comprises the following steps:
Figure BDA0003052981660000161
in the formula, zj,4(0)＝0。
Tracking error after compensation is defined as:
vj,4＝ej,X2-zj,4 (67)
the prediction error is defined as:
Figure BDA0003052981660000162
in the formula (I), the compound is shown in the specification,
Figure BDA0003052981660000163
for parallel estimation of states, it is obtained by the following serial-parallel model:
Figure BDA0003052981660000164
wherein, betaj,2＝0.1。
Designing a neural network adaptive updating law as follows:
Figure BDA0003052981660000165
in the formula, λj,2＝0.1，kj,ω2100 and δj,f2＝0.1。
(g) According to the obtained control input U of vertical, rolling, pitching and yawing motionj,1,Uj,2,Uj,3,Uj,4Returning to the dynamics model of the unmanned aerial vehicle system, and realizing the expected instruction x under formation maintenance and obstacle avoidanced,yd,zdAnd performing tracking control.
While the invention has been described with reference to specific embodiments, the invention is not limited thereto, and various equivalent modifications or substitutions can be easily made by those skilled in the art within the technical scope of the present disclosure.

Claims (4)

1. A flight formation cooperative obstacle avoidance self-adaptive control method based on a virtual structure and an artificial potential field is characterized by comprising the following steps:
step 1: adopting a dynamic model of the unmanned aerial vehicle:
Figure FDA0003052981650000011
wherein x, y, z are positions,
Figure FDA0003052981650000012
roll angle, theta pitch angle, psi yaw angle, m mass, g gravitational acceleration, Ix,Iy,IzFor the inertial matrix, l is the distance from the center of mass of the unmanned aerial vehicle to the center of the rotor, JrIs the moment of inertia of the motor, omegar＝ω2+ω4-ω1-ω3，ωiThe rotation speed of the ith motor is 1,2,3, 4; u shape1,U2,U3,U4The control inputs for vertical, roll, pitch, and yaw motions, respectively, are:
Figure FDA0003052981650000013
wherein b is a lift coefficient, and d is a moment coefficient;
step 2: decoupling the unmanned aerial vehicle dynamic model to obtain a position subsystem and an attitude subsystem; definition of xj,1＝zj，
Figure FDA0003052981650000014
The jth drone altitude subsystem dynamics may be written as:
Figure FDA0003052981650000015
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000016
τj,1＝Uj,1in order to control the input of the electronic device,
Figure FDA0003052981650000017
for the unknown smooth function obtained from equation (1),
Figure FDA0003052981650000021
a known function obtained by the formula (1), wherein j is the number of the unmanned aerial vehicles in the formation, j is 1, … N, and N is the number of the unmanned aerial vehicles in the flying formation;
definition of xj,3＝xj，xj,4＝yj，
Figure FDA00030529816500000211
Figure FDA0003052981650000023
Assuming that the attitude angle near the equilibrium position is small; the jth horizontal motion dynamics of the unmanned aerial vehicle can be simplified as follows:
Figure FDA0003052981650000024
the jth drone attitude subsystem dynamics may be written as:
Figure FDA0003052981650000025
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000026
τj,2＝[Uj,2,Uj,3,Uj,4]in order to control the input of the electronic device,
Figure FDA0003052981650000027
for the unknown smooth function obtained from equation (1),
Figure FDA0003052981650000028
a known function derived from formula (1);
and step 3: the positions and the yaw angles of the unmanned aerial vehicle formation particles are designed as follows:
Figure FDA0003052981650000029
in the formula, xj,rd,yj,rd,zj,rdPosition signal of formation particle for jth drone, psij,rdYaw angle signal, x, for the jth drone formation particled,yd,zdFor position expectation command of formation reference point, #dDesired command for yaw angle for formation,/xi,lyi,lziFor the jth drone formation particle and the relative position of the reference point, lψiForming a relative yaw angle of a particle and a reference point for the jth unmanned aerial vehicle;
the virtual structure particle model is described as:
Figure FDA00030529816500000210
in the formula, xj,d,yj,d,zj,dIs the position signal of the jth virtual dot, μj,1,μj,2,μj,3A control input signal of the jth virtual dot;
the virtual particle control inputs are designed as:
Figure FDA0003052981650000031
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000032
is a negative gradient term of the artificial potential field, V (-) is a total potential energy function of the particle,
Figure FDA0003052981650000033
Figure FDA0003052981650000034
for formation obstacle avoidance, Vm(. is obstacle avoidance potential energy of mass point, c11＞0，c12＞0，c21＞0，c22＞0，c31＞0，c32More than 0 is a design parameter;
assuming particle j is in the potential field generated by neighboring particles, the total potential energy function of the jth particle is defined as:
Figure FDA0003052981650000035
in the formula, the kth drone is a neighbor node of the ith drone, and Φ (·) is a potential energy function represented as follows:
Figure FDA0003052981650000036
k is a potential field intensity coefficient, a proper value is selected according to the inertia of the unmanned aerial vehicle and the control output of an actuating mechanism, and R is a potential field action range;
defining the obstacle avoidance potential energy function of the mass point as:
Figure FDA0003052981650000041
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000042
the coordinates of the projection point of the mass point j on the obstacle avoidance area (O)xm,Oym,Ozm) Position surrounding the centre of the circle for the m-th obstacle, RkThe radius of a circle is enclosed, M is an obstacle number, M is 1, …, M is the number of obstacles;
the desired heading angle of the virtual particle is defined as:
ψj，d＝ψj,rd+ψj，t (12)
in the formula, #j,tIs an equal azimuth heading angle, which can be expressed as:
Figure FDA0003052981650000043
wherein, Deltae0 is the designed forward-looking distance;
and 4, step 4: defining an altitude tracking error e for the altitude subsystem (3)j,1＝xj,1-zj,d(ii) a Designing virtual control quantities
Figure FDA0003052981650000044
Comprises the following steps:
Figure FDA0003052981650000045
in the formula, kj,1The more than 0 is the design parameter,
Figure FDA0003052981650000046
is the derivative of the highly desired instruction;
the first order filter is designed as follows:
Figure FDA0003052981650000047
in the formula, τj,1The parameters > 0 of the filter are the parameters of the filter,
Figure FDA0003052981650000048
design of the compensation signal zj,1Comprises the following steps:
Figure FDA0003052981650000049
in the formula, zj,2Given in subsequent designs;
tracking error after compensation is defined as:
vj,1＝ej,1-zj,1 (17)
defining a tracking error as
Figure FDA0003052981650000051
Designing the actual control input τj,1Comprises the following steps:
Figure FDA0003052981650000052
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000053
for the optimal weight estimation value of the neural network,
Figure FDA0003052981650000054
as a neural networkVector of basis functions, kj,2More than 0 is a design parameter;
design of the compensation signal zj,2Comprises the following steps:
Figure FDA0003052981650000055
tracking error after compensation is defined as:
vj,2＝ej,2-zj,2 (20)
the prediction error is defined as:
Figure FDA0003052981650000056
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000057
for parallel estimation of states, it is obtained by the following serial-parallel model:
Figure FDA0003052981650000058
wherein, betaj,1More than 0 is a design parameter;
designing a neural network adaptive updating law as follows:
Figure FDA0003052981650000059
in the formula, λj,1＞0，kj,ω1> 0 and deltaj,f1More than 0 is a design parameter;
and 5: for horizontal motion (4), the design PD controller calculates the expected acceleration as:
Figure FDA00030529816500000510
in the formula, kj,3＞0，kj,4＞0，kj,5＞0，kj,6The more than 0 is the design parameter,
Figure FDA00030529816500000511
the derivative of the desired command for horizontal position;
obtaining the desired roll and pitch angles as:
Figure FDA0003052981650000061
step 6: for the attitude sub-system (5), defining an attitude angle tracking error as ej,X1＝Xj,1-Xj,dWherein
Figure FDA0003052981650000062
An attitude angle expectation command; designing virtual control quantities
Figure FDA0003052981650000063
Comprises the following steps:
Figure FDA0003052981650000064
in the formula, kj,7The more than 0 is the design parameter,
Figure FDA0003052981650000065
a derivative of the desired command for attitude angle;
the first order filter is designed as follows:
Figure FDA0003052981650000066
in the formula, τj,2The parameters > 0 of the filter are the parameters of the filter,
Figure FDA0003052981650000067
design of the compensation signal zj,3Comprises the following steps:
Figure FDA0003052981650000068
in the formula, zj,4Given in subsequent designs;
tracking error after compensation is defined as:
νj,3＝ej,X1-zj,3 (29)
defining a tracking error as
Figure FDA0003052981650000069
Designing the actual control input τj,2Comprises the following steps:
Figure FDA00030529816500000610
in the formula (I), the compound is shown in the specification,
Figure FDA00030529816500000611
is an estimation value of the optimal weight of the neural network,
Figure FDA00030529816500000612
is a vector of basis functions of the neural network, kj,8More than 0 is a design parameter;
design of the compensation signal zj,4Comprises the following steps:
Figure FDA00030529816500000613
tracking error after compensation is defined as:
vj,4＝ej,X2-zj,4 (32)
the prediction error is defined as:
Figure FDA0003052981650000071
in the formula (I), the compound is shown in the specification,
Figure FDA0003052981650000072
for parallel estimation of states, it is obtained by the following serial-parallel model:
Figure FDA0003052981650000073
wherein, betaj,2More than 0 is a design parameter;
designing a neural network adaptive updating law as follows:
Figure FDA0003052981650000074
in the formula, λj,2＞0，kj,ω2> 0 and
Figure FDA0003052981650000075
is a design parameter;
and 7: the obtained control input U of the vertical, rolling, pitching and yawing motionj,1,Uj,2,Uj,3,Uj,4Returning to the dynamics model of the unmanned aerial vehicle system, and realizing the expected instruction x under formation maintenance and obstacle avoidanced,yd，zdAnd performing tracking control.
2. A computer system, comprising: one or more processors, a computer readable storage medium, for storing one or more programs, wherein the one or more programs, when executed by the one or more processors, cause the one or more processors to implement the method of claim 1.
3. A computer-readable storage medium having stored thereon computer-executable instructions for, when executed, implementing the method of claim 1.
4. A computer program comprising computer executable instructions which when executed perform the method of claim 1.
CN202110499631.2A 2021-05-06 2021-05-06 Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field Active CN113157000B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110499631.2A CN113157000B (en) 2021-05-06 2021-05-06 Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110499631.2A CN113157000B (en) 2021-05-06 2021-05-06 Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field

Publications (2)

Publication Number Publication Date
CN113157000A true CN113157000A (en) 2021-07-23
CN113157000B CN113157000B (en) 2022-08-09

Family

ID=76873803

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110499631.2A Active CN113157000B (en) 2021-05-06 2021-05-06 Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field

Country Status (1)

Country Link
CN (1) CN113157000B (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113485446A (en) * 2021-08-12 2021-10-08 北京航空航天大学 Unmanned airship formation flight control method, system and storage medium
CN114217605A (en) * 2021-11-12 2022-03-22 江苏大学 Formation control method based on virtual structure method and artificial potential field method
CN114326816A (en) * 2022-01-04 2022-04-12 中国人民解放军国防科技大学 Method and device for planning formation flight path of fixed-wing unmanned aerial vehicle based on artificial potential field
CN114415734A (en) * 2022-03-31 2022-04-29 天津大学 Four-rotor unmanned aerial vehicle formation reconfiguration control system based on ADP and obstacle avoidance mechanism
CN114779828A (en) * 2022-06-22 2022-07-22 四川腾盾科技有限公司 Unmanned aerial vehicle cluster topological control and intelligent anti-collision method based on heterogeneous formation datum points
CN115309058A (en) * 2022-06-10 2022-11-08 哈尔滨理工大学 Finite time composite learning control method for dynamic positioning ship
CN117590862A (en) * 2024-01-18 2024-02-23 北京工业大学 Distributed unmanned aerial vehicle preset time three-dimensional target surrounding control method and system
CN114217605B (en) * 2021-11-12 2024-05-14 江苏大学 Formation control method based on virtual structure method and artificial potential field method

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170076617A1 (en) * 2015-09-10 2017-03-16 Christopher Schupp Method and system for pilot target aircraft and target obstacle alertness and awareness
CN108388270A (en) * 2018-03-21 2018-08-10 天津大学 Cluster unmanned plane track posture cooperative control method towards security domain
CN108549407A (en) * 2018-05-23 2018-09-18 哈尔滨工业大学（威海） A kind of control algolithm of multiple no-manned plane collaboration formation avoidance
CN109508035A (en) * 2018-12-24 2019-03-22 南京邮电大学 Multizone stagewise unmanned plane formation paths planning method based on distributed AC servo system
CN112068598A (en) * 2020-09-28 2020-12-11 西北工业大学 Unmanned aerial vehicle formation flying method and control system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170076617A1 (en) * 2015-09-10 2017-03-16 Christopher Schupp Method and system for pilot target aircraft and target obstacle alertness and awareness
CN108388270A (en) * 2018-03-21 2018-08-10 天津大学 Cluster unmanned plane track posture cooperative control method towards security domain
CN108549407A (en) * 2018-05-23 2018-09-18 哈尔滨工业大学（威海） A kind of control algolithm of multiple no-manned plane collaboration formation avoidance
CN109508035A (en) * 2018-12-24 2019-03-22 南京邮电大学 Multizone stagewise unmanned plane formation paths planning method based on distributed AC servo system
CN112068598A (en) * 2020-09-28 2020-12-11 西北工业大学 Unmanned aerial vehicle formation flying method and control system

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113485446A (en) * 2021-08-12 2021-10-08 北京航空航天大学 Unmanned airship formation flight control method, system and storage medium
CN113485446B (en) * 2021-08-12 2023-09-26 北京航空航天大学 Unmanned airship formation flight control method, system and storage medium
CN114217605A (en) * 2021-11-12 2022-03-22 江苏大学 Formation control method based on virtual structure method and artificial potential field method
CN114217605B (en) * 2021-11-12 2024-05-14 江苏大学 Formation control method based on virtual structure method and artificial potential field method
CN114326816A (en) * 2022-01-04 2022-04-12 中国人民解放军国防科技大学 Method and device for planning formation flight path of fixed-wing unmanned aerial vehicle based on artificial potential field
CN114415734A (en) * 2022-03-31 2022-04-29 天津大学 Four-rotor unmanned aerial vehicle formation reconfiguration control system based on ADP and obstacle avoidance mechanism
CN115309058A (en) * 2022-06-10 2022-11-08 哈尔滨理工大学 Finite time composite learning control method for dynamic positioning ship
CN114779828A (en) * 2022-06-22 2022-07-22 四川腾盾科技有限公司 Unmanned aerial vehicle cluster topological control and intelligent anti-collision method based on heterogeneous formation datum points
CN117590862A (en) * 2024-01-18 2024-02-23 北京工业大学 Distributed unmanned aerial vehicle preset time three-dimensional target surrounding control method and system
CN117590862B (en) * 2024-01-18 2024-04-05 北京工业大学 Distributed unmanned aerial vehicle preset time three-dimensional target surrounding control method and system

Also Published As

Publication number Publication date
CN113157000B (en) 2022-08-09

Similar Documents

Publication Publication Date Title
CN113157000B (en) Flight formation cooperative obstacle avoidance self-adaptive control method based on virtual structure and artificial potential field
CN108459612B (en) Unmanned aerial vehicle formation control method and device based on artificial potential field method
Zhihao et al. Virtual target guidance-based distributed model predictive control for formation control of multiple UAVs
CN113220021B (en) Flight formation cooperative self-adaptive tracking control method based on virtual leader
CN113220022B (en) Flight formation finite time self-adaptive control method based on event trigger estimation information transmission
Oh et al. Rendezvous and standoff target tracking guidance using differential geometry
CN111077909B (en) Novel unmanned aerial vehicle self-group self-consistent optimization control method based on visual information
CN110320929B (en) Autonomous unmanned aerial vehicle group target following obstacle avoidance method
CN112230670B (en) Formation control method for multi-four-rotor aircraft with predictor
CN111650963A (en) Visual cluster formation control method for vertical take-off and landing fixed wing unmanned aerial vehicle
CN113110593B (en) Flight formation cooperative self-adaptive control method based on virtual structure and estimation information transmission
CN112947572B (en) Terrain following-based four-rotor aircraft self-adaptive motion planning method
CN110794857A (en) Robust discrete fractional order control method of fixed wing unmanned aerial vehicle considering external wind interference
Li et al. Autonomous maneuver decision-making for a UCAV in short-range aerial combat based on an MS-DDQN algorithm
CN115712308A (en) Multi-machine formation anti-collision method based on distributed model prediction control and formation control
CN115639830A (en) Air-ground intelligent agent cooperative formation control system and formation control method thereof
CN114138022B (en) Unmanned aerial vehicle cluster distributed formation control method based on elite pigeon crowd intelligence
Stepanyan et al. Adaptive disturbance rejection controller for visual tracking of a maneuvering target
CN111007848A (en) Multi-agent cooperative operation control method based on bounded space
CN110162084B (en) Formation control method of flying missile cluster system based on consistency theory
CN116540780A (en) Unmanned aerial vehicle decision control method based on game guidance
Rajasree et al. Optimal formation control of unmanned aerial vehicles with obstacle avoidance
CN113031643B (en) Unmanned aerial vehicle formation and obstacle avoidance method
CN113359824A (en) Unmanned aerial vehicle cluster control method based on fuzzy model
Sadraey Optimal control and line‐of‐sight guidance formation flight

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