CN103995539A - Unmanned aerial vehicle autonomous formation evaluation index and MPC formation control method - Google Patents
Unmanned aerial vehicle autonomous formation evaluation index and MPC formation control method Download PDFInfo
- Publication number
- CN103995539A CN103995539A CN201410205709.5A CN201410205709A CN103995539A CN 103995539 A CN103995539 A CN 103995539A CN 201410205709 A CN201410205709 A CN 201410205709A CN 103995539 A CN103995539 A CN 103995539A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- centerdot
- formation
- sigma
- tau
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 174
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000011156 evaluation Methods 0.000 title claims abstract description 19
- 230000002265 prevention Effects 0.000 claims abstract description 52
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000005457 optimization Methods 0.000 claims description 17
- 238000005096 rolling process Methods 0.000 claims description 12
- 238000005259 measurement Methods 0.000 claims description 11
- 238000005070 sampling Methods 0.000 claims description 8
- 230000004044 response Effects 0.000 claims description 5
- 238000012546 transfer Methods 0.000 claims description 4
- 101150036841 minJ gene Proteins 0.000 claims description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims 1
- 238000013461 design Methods 0.000 abstract description 13
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 9
- 238000004364 calculation method Methods 0.000 abstract 1
- 238000004088 simulation Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 6
- 230000009471 action Effects 0.000 description 4
- 238000013459 approach Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000012423 maintenance Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 206010057855 Hypotelorism of orbit Diseases 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- QSHDDOUJBYECFT-UHFFFAOYSA-N mercury Chemical compound [Hg] QSHDDOUJBYECFT-UHFFFAOYSA-N 0.000 description 2
- 230000035515 penetration Effects 0.000 description 2
- 238000000926 separation method Methods 0.000 description 2
- 238000012876 topography Methods 0.000 description 2
- 206010021703 Indifference Diseases 0.000 description 1
- 238000003889 chemical engineering Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000013011 mating Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000001915 proofreading effect Effects 0.000 description 1
- 125000006850 spacer group Chemical group 0.000 description 1
- 238000005309 stochastic process Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
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)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses an unmanned aerial vehicle autonomous formation evaluation index and model prediction control (MPC) formation control method and belongs to the technical field of flight control. According to the method, a definition relevant to unmanned aerial vehicle autonomous formation, a computing method of the collision prevention probability of unmanned aerial vehicle autonomous formation and an unmanned aerial vehicle autonomous formation evaluation index are provided, and the MPC formation control method applicable to unmanned aerial vehicles is provided. The method solves the problem how to give out the collision prevention quantitative index which should be followed by design of an autonomous formation flight control system when it is known that the unmanned aerial vehicle autonomous formation scale is M, the average expectation distance between unmanned aerial vehicles in formation is dr, and the collision probability of the whole formation is required to be smaller than Pc. The method provides a quantitative index basis for engineering design of the unmanned aerial vehicle autonomous formation control system, and the collision problem the unmanned aerial vehicles in dense formation is solved.
Description
Technical field
The invention belongs to flight control technology field, relate to a kind of foundation of unmanned plane autonomous formation evaluation index and the method for designing of MPC (Model Predictive Control, Model Predictive Control) formation control device.
Background technology
Carry out intensive autonomous formation flight at multiple UAVs, distance between unmanned plane and unmanned plane approaches minimum safe distance, and for a certain specific unmanned plane in forming into columns, because it is distributed with other unmanned plane around, lack free movement space, this make the collision prevention of this unmanned plane motor-driven (for example evading the unexpected motion that contiguous unmanned plane produces due to various random disturbance or some emergency case or fault) than more difficult and complicated in loose formation situation.How to judge the dense degree of autonomous formation, and the performance that how to design and evaluate formation control device is that the Control System Design of unmanned plane autonomous formation needs one of problem that emphasis considers.
Summary of the invention
The present invention, in order to solve problems of the prior art, provides a kind of unmanned plane autonomous formation evaluation index, and a kind of MPC formation control method is provided simultaneously.
The invention provides a kind of unmanned plane autonomous formation evaluation index and MPC formation control method, wherein, the unmanned plane autonomous formation evaluation index providing is:
Wherein, Δ d
f(t) represent the average connection safe distance surplus that the t moment forms into columns; σ (t) is t moment unmanned plane autonomous formation evaluation index, is Δ d
f(t) mean square deviation.
Described MPC formation control method comprises the steps:
The first step, sets up unmanned plane formation motion model;
Second step, realizes MPC formation control, comprising: forecast model, rolling optimization and feedback compensation.
The described first step is set up unmanned plane formation motion model, specifically:
If two unmanned plane W and L, speed is respectively V
wand V
l, flight path drift angle is respectively
with
unmanned plane W is d to the distance of unmanned plane L, x
0, y
0for apart from d at unmanned plane W flight path axis system x, the component on y axle;
and V
wcbe respectively the instruction of flight path drift angle and the speed command of unmanned plane W,
and V
lcbe respectively the instruction of flight path drift angle and the speed command of unmanned plane L,
be respectively the time constant of unmanned plane L and the response of unmanned plane W flight path drift angle,
the time constant that is respectively unmanned plane L and unmanned plane W speed responsive, the motion model of unmanned plane L and unmanned plane W is as follows:
Forecast model in described second step, specifically:
Utilize the unmanned plane formation motion model of the first step as forecast model, get state
controlled being input as
the flight path drift angle of node L and speed are regarded as can measurements interference
output
wherein
Δ V=V
l– V
w, while ignoring D, the discrete form of unmanned plane formation motion model is:
Wherein, X (k) represents the state of moment k, and u (k) represents the controlled input of moment k, and Y (k) represents the output of moment k, and A, B and C represent matrix of coefficients; If u (k+i|k) is illustrated in the controlled input value u in the following k+i moment of moment k supposition; X (k+i|k), Y (k+i|k) is illustrated respectively in moment k, utilizes u (k+j|k), (j=0,1 ..., i-1) to X, the predicted value that Y makes; The predictive equation of the state X obtaining is:
Wherein, P is prediction time domain, and N is for controlling time domain, and u (k-1) represents the controlled input in k-1 moment, difference DELTA u (k+j|k)=u (k+j|k)-u (k+j-1|k);
The predictive equation of output Y is:
Y(k+j|k)=CX(k+j|k),j=1,2,...,P
Rolling optimization in described second step, specifically:
If formation flight at the cost function J of moment k is:
Wherein, ω
yfor output punishment weight matrix, ω
y(l, m) represents the output punishment weight that time domain is corresponding to (l, m); Y
m(k+l|k) be under control time m, the predicted value in k+l moment of calculating in k moment; Ref is spacing hold instruction, ref
m(k+l) the spacing hold instruction in the k+l moment of be under control time m, the k moment calculating; ω
Δ ufor input slew rate punishment weight matrix, ω
Δ u(l, m) represents the input slew rate punishment weight that time domain is corresponding to (l, m); Δ u
m(k+l|k) be the k+l moment input slew rate calculating in the k moment under control time m; Make each time domain equate the weight of (l, m), ω
yand ω
Δ udeteriorate to respectively a row vector;
Constrained optimization problem below the controlled quentity controlled variable u of moment k (k) is:
Δu
opt=arg?minJ
Wherein,
with
be respectively flight path drift angle and speed command restriction; Δ u
optfor first controlled quentity controlled variable of optimal sequence, u
1, u
2be respectively
and V
c; I
2 × 2represent 2 × 2 unit matrix, O
(N-1) × (N-1)represent 0 matrix of (N-1) × (N-1);
Feedback compensation in described second step, comprising: (1) is the original state using X (k) as system directly; (2) the flight path drift angle of unmanned plane L and speed being regarded as can measurements interference
by network delivery to unmanned plane W and append to the predicted value of forecast model.
Advantage of the present invention and good effect are:
(1) the autonomous formation evaluation index proposing in the present invention is for evaluating the density of formation, and the present invention has put forward the collision prevention quantizating index that autonomous formation Design of Flight Control should be followed;
(2) the MPC formation control method proposing in the present invention has solved the collision prevention problem of unmanned plane close/intra;
(3) this collision prevention method for designing for autonomous formation control system proposed by the invention, for the practical implementation of unmanned plane autonomous formation Control System Design provides the index reference quantizing.
Brief description of the drawings
Fig. 1 is the safe distance schematic diagram of unmanned plane member in the present invention;
Fig. 2 is the possible position graph of a relation of unmanned plane i and neighbour's unmanned plane j in the present invention;
Fig. 3 is the internodal relative motion relation of forming into columns;
Fig. 4 is Model Predictive Control block diagram;
Fig. 5 is Model Predictive Control principle;
Fig. 6 is the simulation result of PID formation control device in the present invention, and a and b are respectively unmanned plane relative distance d at certain unmanned aerial vehicle flight path coordinate system x, the component on y axle, and c is the schematic diagram of unmanned plane relative distance d;
Fig. 7 is the simulation result figure that adopts MPC formation control method of the present invention, and A and B are respectively unmanned plane relative distance d at certain unmanned aerial vehicle flight path coordinate system x, the component on y axle, and C is the schematic diagram of unmanned plane relative distance d.
Embodiment
Below in conjunction with drawings and Examples, the present invention is described in detail.
Model of the present invention unmanned plane autonomous formation evaluation index.
The probability bumping when hypotelorism between the unmanned plane of tight formation flight is higher, and unmanned plane all can be determined a safe distance d according to the actual conditions of self conventionally
s.D
sbe so a kind of distance, in the time that the distance of certain unmanned plane and another unmanned plane or threat is less than this distance, this unmanned plane must be taked corresponding measure.Distance when between two unmanned planes is greater than d
stime, the collision opportunity between unmanned plane is less, at this moment forms into columns that it is loose to think, i.e. less demanding to tail clearance retentive control device; Distance when between unmanned plane approaches d
stime, unmanned plane needs to evade possible collision threat at any time, and at this moment, to the having relatively high expectations of tail clearance retentive control device, formation can be thought closely.
The present invention will address the problem: be M in the scale that requires autonomous formation to have, the average expectation spacing between the unmanned plane in formation is d
r, the collision probability of whole formation is less than P
cin situation, how to provide the collision prevention quantizating index that autonomous formation Design of Flight Control should be followed.
Utilize topography and geomorphology shielding, in long and narrow escape way, carry out penetration cruise with flat close/intra form, saturation attack mode with highly dense intensity surprise attack formula is the main patterns of warfare that unmanned plane is formed into columns, now in this flat close/intra between unmanned plane, unmanned plane and obstacle or threaten between the probability that bumps increase, pursuing under high penetraton probability principle, for forming into columns, collaborative guidance controller performance has proposed very high requirement.Flat close/intra form is equivalent to whole formation does not almost have the motor-driven free space of collision prevention in the vertical direction, it is motor-driven that whole formation can only be carried out collision prevention in the horizontal direction, this be equivalent to be longitudinally unlimited intensive, there is no a motor-driven free space of collision prevention, be can not by adjusting the method for flying height, to carry out collision prevention motor-driven, therefore in two-dimensional level face, the collision prevention problem of close/intra be the most complicated Basic Problems.To expand to easily three-dimensional formation problem to close/intra way to solve the problem and conclusion in two-dimensional level face.
The density degree (abbreviation density) that unmanned plane is formed into columns be one describe form into columns in the key concept of distance size characteristic between unmanned plane member, it has material impact for the collaborative guidance of unmanned plane autonomous formation Control System Design, will the density of unmanned plane autonomous formation be analyzed below.
In order to describe the density of unmanned plane autonomous formation, given first form into columns in unmanned plane member safe distance concept and definition.Conventionally be suitable for unmanned plane formation at some and carry out in saturation attack task, need to utilize topography and geomorphology shielding, to form into columns form penetration cruise in narrow escape way, geography, the weather environment of formation flight are complicated and changeable.If the hypotelorism in forming into columns between unmanned plane, between unmanned plane and obstacle, the probability bumping so will increase, thereby the flight safety that threatens whole unmanned plane to form into columns reduces the fighting efficiency that unmanned plane is formed into columns.
How to be definite suitable safe distance between the unmanned plane in formation flight, be one of the basic link of collaborative guidance Control System Design of forming into columns.Conventionally determine a safe distance d according to unmanned plane actual conditions separately
si, and utilize it to control the distance between unmanned plane member in formation (be called for short machine spacing) d (t)
ij(t).Here d,
ij(t)=d
ji(t), and i ≠ j, the distance between unmanned plane i and unmanned plane j represented, d
si(t) safe distance of expression unmanned plane i.D
ij(t) number
wherein i, j=1,2 ..., M (t), is the numbering of unmanned plane member in forming into columns, i namely unmanned plane i of unmanned plane member, and M (t) is current t moment unmanned plane sum.
Definition 1: unmanned plane member's safe distance d
si(t) be so a kind of distance, as the machine spacing d between other any unmanned plane j in i frame unmanned plane and formation
ij(t) when being less than it, i.e. d
ij(t) < d
si(t), i frame unmanned plane must be taked corresponding collision prevention measure; Work as d
ij(t)=d
si(t), time, i frame unmanned plane is in taking the standby condition of corresponding collision prevention measure.
Definition 2: unmanned plane member's safe distance surplus Δ d
ij(t), refer to the machine spacing d of unmanned plane member in formation
ij(t) with its safe distance d
si(t) poor.Be Δ d
ij(t)=d
ij(t)-d
si(t).
As shown in Figure 1, unmanned plane member's safe distance d in impact formation
si(t) factor mainly contains three: sensor measurement error component, mobility component and the network is guided component.Unmanned plane member's sensor measurement error component is mainly by the sensor technology Determines of unmanned plane self, if the distance between two unmanned planes is less than sensor measurement error component, thinks that collision has occurred for they.Mobility component has reflected that unmanned plane member has the ability of evading the collision threat that happens suddenly.In the time of single frame unmanned plane solo hop, generally in the time that safe distance is less than sensor measurement error component and mobility component sum, unmanned plane will be taked collision prevention measure.The network is guided component be due to formation supporting network to information transmit the factor such as time delay, packet loss to form into columns in unmanned plane member safe distance newly-increased restriction.
Except above-mentioned employing machine spacing d
ij(t) with safe distance d
si(t) the safe distance surplus Δ d of magnitude relationship
ij(t) describe outside the density of formation, also should investigate unmanned plane member free space situation around in formation, investigate the dense degree (abbreviation closeness) of forming into columns.Because the machine spacing d between i frame unmanned plane member and other unmanned planes
ij(t) be less than its safe distance d
si(t), i.e. safe distance surplus Δ d
ij(t) when < 0, it is motor-driven that this unmanned plane need to carry out collision prevention for the collision threat facing, and this evasion manoeuvre is usually towards its free space around.If when now i frame unmanned plane does not around have free space again, so it this how to carry out collision threat evasion manoeuvre? as can be seen here, except needs use safe distance d
si(t) concept is weighed outside the density of formation, also needs to introduce a variable of describing unmanned plane member free space around in formation, is called the variable n of connection degree
ci(t), reflecting that formation may have many " close " on earth, how is the closeness of forming into columns?
Connection degree n
ci(t) refer to that on two dimensional surface, distance unmanned plane i approaches d
si(t) number of adjacent unmanned plane.Find by analysis, in two dimensional surface, the i frame unmanned plane member of close/intra around distance approaches d
si(t) mean value of adjacent number of members is about 6 to 7 left and right, the connection degree n of thick in forming into columns
ci(t) be about 6 to 7 left and right.In order to describe the average closeness level of whole formation, introduce average connection degree
therefore, according to the average connection degree n forming into columns
c(t), can carry out to judge approx the dense degree of formation.
Collision prevention problem between unmanned plane member is one of the basic problem that the formation flight of highly dense intensity needs emphasis to solve, and it is directly connected to independence that unmanned plane forms into columns and the fighting efficiency of concertedness level and entirety thereof.Provide one below and take the relational expression between the motor-driven probability of collision prevention and density and closeness about unmanned plane member and formation.
Unmanned plane member's safe distance surplus Δ d in formation
ij(t)=d
ij(t)-d
si(t) be ergodic stochastic process, below by with the variable of time correlation in will save the time and write a Chinese character in simplified form, for example Δ d
ij(t) be abbreviated as Δ d
ij, other is also done this and writes a Chinese character in simplified form.According to central limit theorem, suppose under the combined action of various mutual inapparent enchancement factors unmanned plane member's safe distance surplus Δ d
ijthe approximate safe distance surplus Δ d obeying taking formation as its setting
rijfor mathematical expectation, with σ
ij 2for the normal distribution of variance,
in forming into columns, unmanned plane member's machine spacing is not more than its safe distance, i.e. Δ d
ij≤ 0 o'clock, unmanned plane member just needed or prepares to take the motor-driven measure of collision prevention, as shown in Figure 2.Therefore, between unmanned plane i and unmanned plane j, need or prepare the Probability p of taking collision prevention motor-driven
b(i, j) is:
p
b(i,j)=P{Δdi
j≤0}
Between unmanned plane i and unmanned plane j without taking the motor-driven probability q of collision prevention
b(i, j) is:
q
b(i,j)=P{Δd
ij>0}
In formula,
safe distance surplus ratio,
for normal probability integral.
Above formula is the motor-driven new probability formula of collision prevention of only having considered density factor, because all likely bump danger in any direction of unmanned plane i, so also closeness should be reflected the impact of the motor-driven probability of collision prevention, so the motor-driven Probability p of the collision prevention of unmanned plane i oneself
b(i) be:
Wherein, n
cifor unmanned plane i neighbour's number around, i.e. degree of connection,
for number of combinations.For connection degree n
ci=1 o'clock, the Probability p that collision prevention is motor-driven
b(i) adopt formula (1) to calculate.
Especially, compare λ in the safe distance surplus of setting of forming into columns
rij=0, by the safe distance of unmanned plane member i as under the expectation machine spacer conditions of setting, as connection degree n
ci, utilize formula (3) can calculate the motor-driven Probability p of collision prevention of unmanned plane member i at=2 o'clock
b(i)=0.75; But as connection degree n
ci=6 o'clock, p
b(i)=0.984375.That is to say, if the surplus of setting compares λ
rij=0, so for having compared with for the formation of high density and closeness, unmanned plane member i almost must take the motor-driven measure of collision prevention.
The motor-driven Probability p of collision prevention is taked in whole formation
bfor:
In formula, q
b(i)=1-p
b(i) for unmanned plane member i is without taking the motor-driven probability of collision prevention, the nodes that M is whole formation, k is the number of nodes that needs or prepare to take the motor-driven measure of collision prevention in whole formation.
From formula (1)-Shi (4), safe distance surplus compare λ
rijunder stable condition, the motor-driven Probability p of collision prevention is taked in whole formation
balong with connection degree n
ciincrease with the increase of formation scale M.
Especially, work as p
bwhen (i, j)=α (0≤α≤1) is normal value, formula (3) and formula (4) become respectively:
Wherein, β=1-α, q=1-p.
If by unmanned plane member's safe distance d
sibe set as its sensor measurement error component, the safe distance surplus that order is set compares λ
rij=0, the probability that what calculated formula (1)-(6) so is exactly probability that corresponding unmanned plane member collides with each other and formation bump.
Just utilize the concept that formation dynamic stability characteristic is had to the motor-driven probability of collision prevention of crucial influence below, from safe distance surplus and around free space two aspects unmanned plane autonomous formation is carried out to class definition.According to density and closeness concept, unmanned plane autonomous formation can be divided into three types: loosen and form into columns, closely form into columns and close/intra.
Definition 3: the safe distance surplus that loose formation refers to all unmanned plane members than be all not less than 3 or all between 2 and 3 and on average degree of connection be not more than 3 unmanned plane formation.Be λ
rij>=3 or 2≤λ
rij< 3 & n
c≤ 3, that is to say, all unmanned plane members' safe distance surplus be all not less than its mean square deviation of 3 times or all between the mean square deviation of 2 times and 3 times and on average degree of connection be not more than 3, i.e. Δ d
rij>=3 σ
ijor 2 σ
ij≤ Δ d
rij< 3 σ
ijaMP.AMp.Amp n
c≤ 3.In the time that unmanned plane is formed into columns the loose formation flight of employing, in formation, unmanned plane member need to take the motor-driven probability of collision prevention lower, between unmanned plane member, there is hardly the chance bumping, the density of forming into columns and closeness are all in very low state, and the performance requirement of the collaborative guidance controller of forming into columns for unmanned plane is in the case not high.
Definition 4: the safe distance surplus that refers to all unmanned plane members of closely forming into columns is than all between between 2 and 3 and the on average unmanned plane formation of degree of connection between 3 and 6.I.e. 2≤λ
rij< 3 and 3 < n
c< 6.That is to say, all unmanned plane members' safe distance surplus all between the mean square deviation of its 2 times and 3 times and on average degree of connection between 3 and 6, i.e. 2 σ
ij≤ Δ d
rij< 3 σ
ijand 3 < n
c< 6.From the density of forming into columns, different from loose formation, in the time adopting tight formation flight, in formation, unmanned plane member need to take the motor-driven probability of collision prevention larger, exists the probability bumping higher between unmanned plane member; And from form into columns closeness, due to form into columns average connection degree be less than 6, these unmanned planes member towards periphery needed free space of evasion manoeuvre exists, these free spaces for unmanned plane member towards periphery evasion manoeuvre be moderate.Compared with loose formation situation, the performance requirement of the collaborative guidance controller of at this moment unmanned plane being formed into columns is higher.
Definition 5: the safe distance surplus that close/intra refers to all unmanned plane members than be all less than 2 or all between 2 and 3 and on average degree of connection be not less than 6 unmanned plane formation.Be λ
rij< 2 or 2≤λ
rij< 3 & n
c>=6.That is to say, all unmanned plane members' safe distance surplus be all less than the mean square deviation of its twice or on average degree of connection be not less than 6, i.e. Δ d
rij< 2 σ
ijor 2 σ
ij≤ Δ d
rij< 3 σ
ijaMP.AMp.Amp n
c>=6.From the density of forming into columns, close/intra and the not too large difference of closely forming into columns, just make machine spacing d
ijfurther close to its safe distance d
si, make unmanned plane member need to take the tight formation of the motor-driven likelihood ratio of collision prevention further to increase.Meanwhile, because the closeness of forming into columns improves, the average connection degree of forming into columns is not less than 6, causes unmanned plane member almost there is no the needed free space of evasion manoeuvre towards periphery, exists the probability bumping very high between unmanned plane member.Therefore,, compared with tight formation situation, the performance requirement of the collaborative guidance controller that tight formation flight is formed into columns to unmanned plane is higher.
Definition 6: the average safe distance d of formation
sf(t), refer to all unmanned plane member safe distance d in formation
si(t) mean value.?
Definition 7: the average junctor spacing d of formation
f(t), refer to the machine spacing d of all unmanned plane members in formation and its contiguous unmanned plane
ij(t) mean value.?
Definition 8: the average connection safe distance surplus Δ d of formation
f(t), refer to the average junctor spacing d of formation
f(t) with average safe distance d
sf(t) poor.That is:
Δd
f(t)=d
f(t)-d
sf(t)
Formula (1)-(6) also can be used as the judgement schematics of the collaborative guidance controller performance of forming into columns.For the formation with same regular formation, as the safe distance d of unmanned plane
siwith the formation setpoint distance d forming into columns
rijall identical, safe distance surplus Δ d
ijone timing, the size of the mean square deviation of available average machine spacing is as evaluating the collaborative guidance controller performance index of forming into columns, i.e. index σ:
Wherein,
ex represents to ask for the mean value of x, and the less expression formation of the value performance of σ is better.
The MPC formation control method of unmanned plane provided by the invention, comprises the steps:
The first step, sets up unmanned plane formation motion model.
The flight formation control system of present stage, is all based on lead aircraft-wing plane pattern, adopts wing plane to follow the formation mode of lead aircraft, and lead aircraft can be that true lead aircraft can be also virtual lead aircraft.As Fig. 3, each node represents a unmanned plane, V
wand V
lbe respectively the speed of node W and node L,
with
be respectively the flight path drift angle of node W and node L, d is the distance of node W to node L, the difference of the flight path drift angle of node W and node L
x and y are the Orthogonal Decomposition of d on node W velocity reversal.(in Fig. 3, be numbered N with node W
w) flight path axis system (velocity reversal of node W is x axle, with the direction of speed vertical-right be y axle) for relative coordinate system, ground coordinate is fixed coordinate system, utilize the absolute velocity=relative velocity+convected velocity relation in theoretical mechanics, the kinematical equation of setting up node L and node W is as follows:
Wherein,
represent respectively the velocity vector of node L, node W,
represent the distance vector of node W to node L.
Above formula is decomposed in the flight path axis system of node W:
Wherein x, y is that the distance d of the relative node L of node W is at node W flight path axis system x, the component on y axle.Linearization obtains to above formula (9) to adopt low-angle and microvariations hypothesis:
X
0, y
0for distance d under a certain disturbance is at unmanned plane W flight path axis system x, the component on y axle.
The motion model of node L and node W:
Wherein,
and V
wcbe respectively the instruction of flight path drift angle and the speed command of node W,
and V
lcbe respectively the instruction of flight path drift angle and the speed command of node L,
and V
lc, V
wcfor flight path drift angle and the speed controlled quentity controlled variable of outer shroud, act on interior ring flight control system as instruction,
be respectively the time constant of node L and the response of node W flight path drift angle,
be respectively the time constant of node L and node W speed responsive.
Second step, realizes MPC formation control, and design is based on MPC formation control device.
For formation flight control, can be found out by formula (11), movement mechanism between two unmanned planes is clear, model simple, therefore be well suited for application model PREDICTIVE CONTROL, and along with the fast development of robot calculator software and hardware technology, calculate and carrying cost more and more lower, MPC method is applied in the such rapid system of flight control system more and more widely, and therefore the present invention will design the formation control device based on state space MPC according to the feature of formation flight.
MPC control method based on model has three major parts conventionally: forecast model, rolling optimization and feedback compensation, as shown in Figure 4.When in network inducement delay situation, forecast model obtains as shown in step 2.4.
Step 2.1: forecast model.
Forecast model is only focused on the function of model, and do not focus on the form of model, as long as have the model of forecast function, as state equation, this quasi-tradition model of transport function, and for example step response, this class nonparametric model of impulse response etc. all can be used as forecast model use.In formation control of the present invention, utilize formula (11) as forecast model.
Choose state according to formula (11)
wherein x, y is the projection in node W flight path axis system of the relative distance of node L and node W;
for the flight path drift angle of node W; V
wfor the speed of node W; Controlled being input as
wherein
and V
wcbe respectively the instruction of flight path drift angle and the speed command of node W.For alleviating computation burden, here the flight path drift angle of node L and speed being regarded as can measurements interference
do not use first order modeling to predict it, directly transmit flight path drift angle and the speed of node L by supporting network; Output
wherein
while ignoring D (D can be added in forecast model subsequently, is considered as the correction of model), the discrete form of formation motion model is:
A, B and C represent matrix of coefficients, namely k the sampling period of moment k herein, if X (k|k)=X (k) is illustrated in moment k, according to the state value of Y (k) and u (k-1) acquisition, because u (k) does not now also calculate; U (k+i|k) is illustrated in the input value u in the following k+i moment of moment k supposition; X (k+i|k), Y (k+i|k) is illustrated in moment k, utilizes u (k+j|k), (j=0,1 ..., i-1) to X, the predicted value that Y makes; P is prediction time domain; N is for controlling time domain, i.e. u (k+i|k)=u (k+N-1|k) N < i < P-1, can obtain by iterative (12):
That is:
Because u (k) is unknown in the k moment, and u (k-1) is known, establishes difference
Δu(k+j|k)=u(k+j|k)-u(k+j-1|k) (15)
Have:
Have for 1≤j≤N:
In formula, I is unit matrix, further obtains:
Have for N≤j≤P:
That is:
The predictive equation that to sum up can obtain state X is always:
Finally, the predictive equation of output Y is:
Y(k+j|k)=CX(k+j|k),j=1,2,...,P (22)
Step 2.2: rolling optimization.
Rolling optimization is the main feature of MPC, the cost function that is mainly manifested in rolling optimization with the maximum difference of common optimal control algorithm (LQR) is not unalterable overall situation function, but in each sampling instant, cost function only relates to the limited period (prediction time domain and control time domain) from present to future, and to next sampling instant, prediction time domain is passed forward as shown in Figure 5.Therefore MPC each time be carved with a cost function with respect to this moment, the relative form of cost function is not identical in the same time, but its absolute form (is comprised time zone, weight etc.) be different, optimizing is not that an off-line completes, but repeatedly carry out online, the implication of Here it is rolling optimization, is also the essential characteristics that MPC is different from traditional optimum control.MPC adopt this limited period to optimize to take into account due to model mismatch, time the uncertainty that causes such as change, interference, make up in time the impact that these factors cause, and all the time new optimization is based upon on the basis of real process, for leading machine formation control, the equilibrium point of model, the interference of lead aircraft is in continuous variation, therefore, is based upon the feature that Rolling optimal strategy on the limited period meets formation flight more.
If formation flight at the cost function J of moment k is:
Wherein, P is prediction time domain; N is for controlling time domain; Y
m(k+l|k) be under control time m, the predicted value in k+l moment of calculating in k moment; Ref is spacing hold instruction, ref
m(k+l) the spacing hold instruction in the k+l moment of be under control time m, the k moment calculating; ω
yfor output punishment weight matrix, reflect the dynamics of mating of the maintenance dynamics of node W and L spacing and flight path drift angle, speed, be the of paramount importance weight of maintenance of adjusting the distance, ω
y(l, m) represents the output punishment weight that time domain is corresponding to (l, m); ω
Δ ufor input slew rate punishment weight matrix, reflect the size of instruction rate of change, there is the character of integration, make system realize indifference control, ω
Δ u(l, m) represents the input slew rate punishment weight that time domain is corresponding to (l, m); Δ u
m(k+l|k) be the k+l moment input slew rate calculating in the k moment under control time m.For simplifying solving of quadratic programming (Quadratic programming, QP), make each time domain equate the weight of (l, m) here, two weight matrix deteriorate to respectively row vector
with
ω
x, ω
yrepresent the maintenance dynamics of node W and L spacing,
ω
Δ Vrepresent the flight path drift angle of node W, the coupling dynamics of speed,
ω
Δ Vcrepresent the size of controlled input slew rate.Visible in the situation that not adding end conswtraint, the physical significance of weight is very clear and definite, but in order to ensure the stable of system, has taked larger prediction time domain here, gets P=50 through design of Simulation; N=40; ω
y=(200,250,200,50); ω
Δ u=(5,0.1).
Finally, the constrained optimization problem of MPC below the controlled quentity controlled variable u of moment k (k) is:
Wherein,
for the restriction of flight path drift angle,
represent respectively minimum, maximum yaw angle,
for speed command restriction, V
min, V
maxrepresent respectively minimum speed and maximal rate.Δ u
optfor first controlled quentity controlled variable of optimal sequence, u1, u
2be respectively
and V
c.I
2 × 2represent 2 × 2 unit matrix, O
(N-1) × (N-1)represent 0 matrix of (N-1) × (N-1).
Shape can turn to QP typical problem (quadratic programming problem) suc as formula the cost function of (24), when weight is positive, is Strict Convex, and detailed process adopts more ripe KWIK Algorithm for Solving, is not repeating herein.KWIK algorithm reference paper: Schmid, C., L.T.Biegler.Quadratic programming methods for reduced hessian SQP[J] .Computers & Chemical Engineering, 18 (9): 817832,1994.
Step 2.3: feedback compensation.
In real system, exist non-linear, time the factor such as change, model mismatch, interference, can not conform to completely with actual conditions based on the prediction of varying model not, therefore, feedback policy is indispensable.Rolling optimization is only based upon on the basis of feedback compensation, just can embody its superiority.Therefore, MPC is determining by optimization after the control action in a series of futures, control departing from perfect condition in order to prevent that model mismatch or environmental interference from causing, be not that these control actions are all implemented one by one, and just apply the control action of current time, first controlled quentity controlled variable of the optimal control sequence of trying to achieve, to next sampling instant, first the actual output of monitoring target, and by various feedback policy correction forecast models or compensated, and then carry out new optimization.
In sum, MPC comprehensive utilization historical information and model information, constantly carry out rolling optimization to cost function, and revise or compensation prediction model according to the actual object output recording.
Obtain the current state X (k) of system by supporting network at each computation period, may not be inconsistent with the predicted value X of state (k|k-1), but state space MPC method is the original state using X (k) as system directly, and this has played the effect of similar feedback compensation; In addition as previously mentioned, the flight path drift angle of node L and speed being regarded as can measurements interference
also append in the predicted value of forecast model by formula (11) to node W by network delivery, also played the effect of proofreading and correct, and typical PID controller does not process to the interference input of node L.
Step 2.4: have the forecast model in network inducement delay situation.
In the time that network inducement delay be can not ignore, the discretize of linear movement model need to be considered the impact of time delay, investigates the general type of linear time invariant continuous system:
Its time solution is:
T
0the initial time of expression system, in the time there is network inducement delay τ, because the input u of MPC is discrete, the sampling period of establishing u is T
s, in the time that new state does not arrive, u will equal the input in a upper moment, so have
Work as kT
s≤ t < kT
swhen+τ, consider that state X is from kT
stransfer to kT
s+ τ, has:
Work as kT
s+ τ≤t < (k+1) T
stime, consider that state X is from kT
s+ τ transfers to (k+1) T
s, have:
Wherein:
In the situation that not there is not ambiguity, k represents k sampling period, if any Z (k)=Z (kT
s), establish
Exist in the situation of network inducement delay, the discretization model of MPC is:
Wherein
Then can obtain forecast model.
Below MPC formation control method of the present invention is verified and evaluated.
First, by safe distance surplus compare λ
ritake the motor-driven probability of collision prevention with calculating to form into columns.Suppose the safe distance d of unmanned plane
si=200m, meansquaredeviationσ
ij=10m, the formation setpoint distance d of formation
rij=230m, wherein i, j=1,2 ..., 7.Safe distance surplus ratio
according to definition 3, this formation belongs to loose and forms into columns.Between unmanned plane member i and j, need the Probability p of taking collision prevention motor-driven
b(i, j)=α=Φ (3)=0.00135.If forming regular formation by 7 unmanned planes is polygonal formation, i.e. N=7, n
c=6, calculate unmanned plane member by formula (5) and formula (6) and take the motor-driven Probability p of collision prevention
b(i)=0.008073 < 1%, forms into columns and takes the motor-driven Probability p of collision prevention
b=0.05516 < 6%.If other assumed condition is constant, only by the formation setpoint distance of forming into columns closer to safe distance d
si(t), change d into
rij(t)=210m, λ
rij=1, according to definition 5, this formation belongs to close/intra, p
b(i, j)=α=Φ (1)=0.1587, in the case, unmanned plane member takes the motor-driven Probability p of collision prevention
b(i)=0.64543 > 60%, forms into columns and takes the motor-driven Probability p of collision prevention
b=0.999295 ≈ 100%.That is to say, by safe distance surplus than by 3 being reduced to 1 (be safe distance surplus be reduced to 1 σ by 3 σ), form into columns and need to take the motor-driven probability of collision prevention just to increase to close to 100% from being less than 6%, formation type also becomes close/intra from loose formation.Formation need to take the motor-driven probability of collision prevention close to 1, forms into columns and almost must take the motor-driven measure of collision prevention.Visible, safe distance surplus compare λ
ribeing not only the significant parameter of dividing formation type, and being the variable that affects the dynamic stability characteristic of forming into columns, is to judge the density of formation and the important indicator of closeness, is also the important parameter of the collaborative guidance of examination formation controller performance.
Suppose to have the unmanned plane of N=32 to form into columns, on average degree of connection n
c(t)=7, the safe distance d of unmanned plane
si=200m, the formation setpoint distance d of formation
rij=230m, wherein i, j=1,2 ..., 32.
Unmanned plane member's safe distance surplus ratio
if require the collision probability of forming into columns to be not more than 30% in statistical significance, i.e. p
b≤ 30%.Can calculate according to formula (1)-Shi (6)
according to definition 5, this formation belongs to close/intra, proposes the collaborative meansquaredeviationσ of controller to 32 unmanned aerial vehicle (UAV) control precision that guide of formation of meter
ijshould be not more than 10.17m.
Then,, for the directive function of unmanned plane autonomous formation evaluation index for formation control device design is described, select typical PID formation control device and MPC formation control device proposed by the invention to carry out contrast simulation checking.
Two-shipper is formed into columns and is tested flight path scene: minimum speed 50m/s; Maximal rate 200m/s; Initial velocity 100m/s; Formation keeping is apart from x=100m; Y=-173.2m; D=200m; Negative 60 degree of flight path deflection when t=5s; When t=30s, deflection positive 60 is spent again.
(1) PID formation control device simulation result, as shown in a of Fig. 6, b and c, c is the schematic diagram of unmanned plane relative distance d, a and b be respectively unmanned plane apart from d at certain unmanned aerial vehicle flight path coordinate system x, the component on y axle;
(2) MPC formation control device simulation result, as shown in the A of Fig. 7, B and C, C is the schematic diagram of unmanned plane relative distance d, A and B are respectively unmanned plane relative distance d at certain unmanned aerial vehicle flight path coordinate system x, the component on y axle.
In the simulation time of test flight path 70s, adopt the poor σ=32.7089m of separation criteria of PID formation control device; Adopt the poor σ=0.8393m of separation criteria of MPC formation control device of the present invention.Simulation result shows, PID formation control device differs at most and has exceeded 60m with desired spacing in the process of maintenance of forming into columns, and within MPC formation control device and desired spacing maintain 2.75m, verify the advantage of MPC formation control method provided by the invention in formation flight control.
Claims (5)
1. unmanned plane autonomous formation evaluation index and Model Predictive Control (MPC) formation control method, is characterized in that:
Described unmanned plane autonomous formation evaluation index is as follows:
Wherein, Δ d
f(t) represent the average connection safe distance surplus that the t moment forms into columns; σ (t) is t moment unmanned plane autonomous formation evaluation index, is Δ d
f(t) mean square deviation; Parameter Δ d
ef(t)=E[Δ d
f(t)];
Described MPC formation control method, specific implementation step is as follows:
The first step, set up unmanned plane formation motion model:
If two unmanned plane W and L, speed is respectively V
wand V
l, flight path drift angle is respectively
with
unmanned plane W is d to the distance of unmanned plane L, x
0, y
0for apart from d at unmanned plane W flight path axis system x, the component on y axle; The motion model of unmanned plane L and unmanned plane W is as follows:
and V
wcbe respectively the instruction of flight path drift angle and the speed command of unmanned plane W,
and V
lcbe respectively the instruction of flight path drift angle and the speed command of unmanned plane L,
be respectively the time constant of unmanned plane L and the response of unmanned plane W flight path drift angle,
be respectively the time constant of unmanned plane L and unmanned plane W speed responsive;
Second step, realizes MPC formation control, comprising: forecast model, rolling optimization and feedback compensation;
Step 2.1: forecast model;
Utilize formula (2) as forecast model, get state
controlled being input as
the flight path drift angle of node L and speed are regarded as can measurements interference
output
wherein
while ignoring D, the discrete form of unmanned plane formation motion model is:
Wherein, X (k) represents the state of moment k, and u (k) represents the controlled input of moment k, and Y (k) represents the output of moment k, and A, B and C represent matrix of coefficients; If u (k+i|k) is illustrated in the controlled input value u in the following k+i moment of moment k supposition, X (k+i|k), Y (k+i|k) is illustrated respectively in moment k, utilize u (k+j|k), (j=0,1, ..., i-1) to X, the predicted value that Y makes; The predictive equation of the state X obtaining is:
Wherein, P is prediction time domain, and N is for controlling time domain, and u (k-1) represents the controlled input in k-1 moment, difference DELTA u (k+j|k)=u (k+j|k)-u (k+j-1|k);
The predictive equation of output Y is: Y (k+j|k)=CX (k+j|k), and j=1,2 ..., P;
Step 2.2: rolling optimization;
If formation flight at the cost function J of moment k is:
Wherein, ω
yfor output punishment weight matrix, ω
y(l, m) represents the output punishment weight that time domain is corresponding to (l, m); Y
m(k+l|k) be under control time m, the predicted value in k+l moment of calculating in k moment; Ref is spacing hold instruction, ref
m(k+l) the spacing hold instruction in the k+l moment of be under control time m, the k moment calculating; ω
Δ ufor input slew rate punishment weight matrix, ω
Δ u(l, m) represents the input slew rate punishment weight that time domain is corresponding to (l, m); Δ u
m(k+l|k) be the k+l moment input slew rate calculating in the k moment under control time m; Make each time domain equate the weight of (l, m), ω
yand ω
Δ udeteriorate to respectively a row vector;
Constrained optimization problem below the controlled quentity controlled variable u of moment k (k) is:
Δu
opt=arg?minJ
Wherein,
with
be respectively flight path drift angle and speed command restriction; Δ u
optfor first controlled quentity controlled variable of optimal sequence, u
1u
2be respectively
and V
c; I
2 × 2represent 2 × 2 unit matrix, O
(N-1) × (N-1)represent 0 matrix of (N-1) × (N-1);
Step 2.3: feedback compensation, comprising: (1) is the original state using X (k) as system directly; (2) the flight path drift angle of unmanned plane L and speed being regarded as can measurements interference
by network delivery to unmanned plane W and append to the predicted value of forecast model.
2. unmanned plane autonomous formation evaluation index according to claim 1 and MPC formation control method, is characterized in that: the average connection safe distance surplus Δ d that the described t moment forms into columns
f(t) acquisition methods is:
Δd
f(t)=d
f(t)-d
sf(t)
Wherein, d
f(t) represent the average junctor spacing that the t moment forms into columns, d
sf(t) represent the average safe distance that the t moment forms into columns, M (t) is t moment unmanned plane sum, d
ij(t) represent the distance between unmanned plane i and unmanned plane j, d
si(t) safe distance of expression unmanned plane i, n
ci(t) the connection degree of expression t moment unmanned plane i.
3. unmanned plane autonomous formation evaluation index according to claim 1 and 2 and MPC formation control method, is characterized in that: described unmanned plane autonomous formation is evaluated, by formula (6)-(11) below as judgement schematics, specifically:
If d
ij(t) represent the distance between unmanned plane i and unmanned plane j, d
si(t) safe distance of expression unmanned plane i, the safe distance surplus Δ d of unmanned plane i and unmanned plane j
ij(t)=d
ij(t)-d
si(t), below the time t in the variable relevant to time t is saved and write a Chinese character in simplified form;
If unmanned plane member's safe distance surplus Δ d
ijnormal Distribution
Δ d
rijfor the safe distance surplus of setting, σ
ij 2for variance; As Δ d
ij≤ 0 o'clock, unmanned plane member just needed or prepares to take the motor-driven measure of collision prevention, needs or prepare the Probability p of taking collision prevention motor-driven between unmanned plane i and unmanned plane j
b(i, j) is:
p
b(i,j)=P{Δd
ij≤0}
Between unmanned plane i and unmanned plane j without taking the motor-driven probability q of collision prevention
b(i, j) is:
q
b(i,j)=P{Δd
ij>0}
In formula,
safe distance surplus ratio,
for normal probability integral;
Closeness is reflected to the motor-driven Probability p of collision prevention of unmanned plane i oneself to the impact of the motor-driven probability of collision prevention
b(i) be:
Wherein, n
cifor the connection degree of unmanned plane i,
for number of combinations; For connection degree n
ci=1 o'clock, the Probability p that collision prevention is motor-driven
b(i) employing formula (6) is calculated;
The motor-driven Probability p of collision prevention is taked in whole formation
bfor:
In formula, q
b(i)=1-p
b(i) for unmanned plane member i is without taking the motor-driven probability of collision prevention, the unmanned plane number that M is whole formation;
Especially, work as p
bwhen (i, j)=α (0≤α≤1) is normal value, formula (8) and formula (9) become respectively formula (10) and formula (11):
Wherein, β=1-α, q=1-p.
4. unmanned plane autonomous formation evaluation index according to claim 1 and MPC formation control method, is characterized in that: the forecast model in described second step, exist in network inducement delay situation, and concrete acquisition methods is:
In the time that network inducement delay can not be ignored, the discretize of linear movement model need to be considered the impact of time delay, and the general type of investigating linear time invariant continuous system is:
Its time solution is:
T
0the initial time of expression system, in the time there is network inducement delay τ, because the input u of MPC is discrete, the sampling period of establishing u is T
s, in the time that new state does not arrive, u will equal the input in a upper moment, so have:
Work as kT
s≤ t < kT
swhen+τ, consider that state X is from kT
stransfer to kT
s+ τ, has:
Work as kT
s+ τ≤t < (k+1) T
stime, consider that state X is from kT
s+ τ transfers to (k+1) T
s, have
Wherein parameter:
K represents k sampling period, Z (k)=Z (kT
s), establish
Exist in the situation of network inducement delay, the discretization model of MPC is:
Wherein,
Finally obtain forecast model according to the discretization model of formula (19) and (20).
5. according to the unmanned plane autonomous formation evaluation index described in claim 1 or 4 and MPC formation control method, it is characterized in that: described prediction time domain P=50; Described control time domain N=40; Described output punishment weights omega
y=(200,250,200,50), described input slew rate punishment weights omega
Δ u=(5,0.1).
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410205709.5A CN103995539B (en) | 2014-05-15 | 2014-05-15 | A kind of unmanned plane autonomous formation evaluation index and MPC formation control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410205709.5A CN103995539B (en) | 2014-05-15 | 2014-05-15 | A kind of unmanned plane autonomous formation evaluation index and MPC formation control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103995539A true CN103995539A (en) | 2014-08-20 |
CN103995539B CN103995539B (en) | 2016-04-20 |
Family
ID=51309731
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410205709.5A Active CN103995539B (en) | 2014-05-15 | 2014-05-15 | A kind of unmanned plane autonomous formation evaluation index and MPC formation control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103995539B (en) |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104216382A (en) * | 2014-09-19 | 2014-12-17 | 北京航天长征飞行器研究所 | Spatial small aircraft formation flying control system |
CN104503457A (en) * | 2014-10-24 | 2015-04-08 | 南京航空航天大学 | Turning anti-collision control method for UAV formation flight |
CN104656663A (en) * | 2015-02-15 | 2015-05-27 | 西北工业大学 | Vision-based UAV (unmanned aerial vehicle) formation sensing and avoidance method |
CN105739304A (en) * | 2016-01-28 | 2016-07-06 | 北京理工大学 | Multi-UCAV on-line striking target allocation method of opposition-based genetic algorithm(GA) |
CN106094524A (en) * | 2016-07-07 | 2016-11-09 | 西北工业大学 | The rapid model prediction control method compensated based on input trend |
CN106352738A (en) * | 2016-06-08 | 2017-01-25 | 北京理工大学 | Multi-missile cooperative guidance method based on output consistency |
CN107390706A (en) * | 2017-07-26 | 2017-11-24 | 北京航空航天大学 | A kind of unmanned plane short range combat decision-making technique based on the motor-driven algorithm of preview |
CN108646734A (en) * | 2018-04-27 | 2018-10-12 | 天津大学 | Nonlinear model predictive control method based on quanta particle swarm optimization |
CN109032136A (en) * | 2018-07-23 | 2018-12-18 | 西北工业大学 | The more unmanned boat formation trackings of drive lacking based on master-salve distributed Model Predictive Control |
CN109254592A (en) * | 2018-09-17 | 2019-01-22 | 中国人民解放军国防科技大学 | Unmanned aerial vehicle formation change control method and system |
CN109491403A (en) * | 2018-11-03 | 2019-03-19 | 上海电力学院 | A kind of collaboration Altitude Long Endurance Unmanned Air Vehicle connection control method |
CN109582040A (en) * | 2019-01-25 | 2019-04-05 | 中国人民解放军国防科技大学 | Unmanned aerial vehicle cluster formation and performance vulnerability assessment method and system |
CN109598088A (en) * | 2018-12-20 | 2019-04-09 | 中国矿业大学 | A kind of belt conveyor belt speed setting control method |
CN109871032A (en) * | 2019-03-04 | 2019-06-11 | 中科院成都信息技术股份有限公司 | A kind of multiple no-manned plane formation cooperative control method based on Model Predictive Control |
CN109885096A (en) * | 2019-04-08 | 2019-06-14 | 哈尔滨工程大学 | A kind of autonomous underwater robot path trace closed loop control method based on Lyapunov-MPC technology |
CN109917806A (en) * | 2019-03-14 | 2019-06-21 | 北京航空航天大学 | A kind of unmanned plane cluster formation control method based on noninferior solution dove group's optimization |
CN109960148A (en) * | 2019-03-20 | 2019-07-02 | 中国科学院软件研究所 | A kind of the independence appraisal procedure and system of intelligent Unmanned Systems |
CN110109476A (en) * | 2019-05-06 | 2019-08-09 | 中国人民解放军军事科学院国防科技创新研究院 | Isomery unmanned vehicle independent anti-collision warning method based on collision probability |
CN110134135A (en) * | 2019-05-27 | 2019-08-16 | 郑州轻工业学院 | Based on the quadrotor control method for improving MPC-PID |
CN110162035A (en) * | 2019-03-21 | 2019-08-23 | 中山大学 | A kind of clustered machine people is having the cooperative motion method in barrier scene |
CN110832420A (en) * | 2018-07-19 | 2020-02-21 | 深圳市大疆创新科技有限公司 | Unmanned aerial vehicle control method and device and unmanned aerial vehicle |
CN111813086A (en) * | 2020-07-15 | 2020-10-23 | 北京航空航天大学云南创新研究院 | Model-based unmanned system autonomy evaluation method |
CN111830826A (en) * | 2020-05-29 | 2020-10-27 | 中国科学技术大学 | Networked dual-mode self-adaptive time domain model control method and system |
CN112911225A (en) * | 2021-01-19 | 2021-06-04 | 深圳科盾量子信息科技有限公司 | Video monitoring method based on quantum encryption |
CN113467507A (en) * | 2021-06-28 | 2021-10-01 | 中交遥感载荷(江苏)科技有限公司 | Atmospheric environment sampling method based on unmanned aerial vehicle system and unmanned aerial vehicle system thereof |
CN113885554A (en) * | 2021-09-13 | 2022-01-04 | 汕头大学 | Distributed enclosure control method and system for unmanned aerial vehicle cluster |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101371158A (en) * | 2006-01-19 | 2009-02-18 | 泰勒斯公司 | Device controlling relative position(s) using power measurements for use by a spacecraft in a group of spacecraft in formation |
BRPI0904274A2 (en) * | 2008-11-04 | 2011-02-01 | Saab Ab | avoidance shunt generator for an aircraft |
EP2466569A1 (en) * | 2010-12-14 | 2012-06-20 | The Boeing Company | Loss of separation avoidance maneuvering |
CN102591358A (en) * | 2012-03-12 | 2012-07-18 | 北京航空航天大学 | Multi-UAV (unmanned aerial vehicle) dynamic formation control method |
US20120209457A1 (en) * | 2007-09-28 | 2012-08-16 | The Boeing Company | Aircraft Traffic Separation System |
CN103631141A (en) * | 2013-12-11 | 2014-03-12 | 北京航空航天大学 | Light transmission hypothesis based intensive autonomous aerial vehicle formation control method |
CN103777640A (en) * | 2014-01-15 | 2014-05-07 | 北京航空航天大学 | Method for distributed control of centralized clustering formation of unmanned-plane cluster |
-
2014
- 2014-05-15 CN CN201410205709.5A patent/CN103995539B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101371158A (en) * | 2006-01-19 | 2009-02-18 | 泰勒斯公司 | Device controlling relative position(s) using power measurements for use by a spacecraft in a group of spacecraft in formation |
US20120209457A1 (en) * | 2007-09-28 | 2012-08-16 | The Boeing Company | Aircraft Traffic Separation System |
BRPI0904274A2 (en) * | 2008-11-04 | 2011-02-01 | Saab Ab | avoidance shunt generator for an aircraft |
EP2466569A1 (en) * | 2010-12-14 | 2012-06-20 | The Boeing Company | Loss of separation avoidance maneuvering |
CN102591358A (en) * | 2012-03-12 | 2012-07-18 | 北京航空航天大学 | Multi-UAV (unmanned aerial vehicle) dynamic formation control method |
CN103631141A (en) * | 2013-12-11 | 2014-03-12 | 北京航空航天大学 | Light transmission hypothesis based intensive autonomous aerial vehicle formation control method |
CN103777640A (en) * | 2014-01-15 | 2014-05-07 | 北京航空航天大学 | Method for distributed control of centralized clustering formation of unmanned-plane cluster |
Non-Patent Citations (1)
Title |
---|
杜阳等: "飞航导弹编队队形变换控制器设计", 《北京航空航天大学学报》, vol. 40, no. 2, 28 February 2014 (2014-02-28), pages 240 - 245 * |
Cited By (41)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104216382A (en) * | 2014-09-19 | 2014-12-17 | 北京航天长征飞行器研究所 | Spatial small aircraft formation flying control system |
CN104503457A (en) * | 2014-10-24 | 2015-04-08 | 南京航空航天大学 | Turning anti-collision control method for UAV formation flight |
CN104656663B (en) * | 2015-02-15 | 2017-12-01 | 西北工业大学 | A kind of unmanned plane formation of view-based access control model perceives and bypassing method |
CN104656663A (en) * | 2015-02-15 | 2015-05-27 | 西北工业大学 | Vision-based UAV (unmanned aerial vehicle) formation sensing and avoidance method |
CN105739304A (en) * | 2016-01-28 | 2016-07-06 | 北京理工大学 | Multi-UCAV on-line striking target allocation method of opposition-based genetic algorithm(GA) |
CN105739304B (en) * | 2016-01-28 | 2018-09-25 | 北京理工大学 | A kind of more UCAV based on antithetical ideas improved adaptive GA-IAGA strike target distribution method online |
CN106352738A (en) * | 2016-06-08 | 2017-01-25 | 北京理工大学 | Multi-missile cooperative guidance method based on output consistency |
CN106094524A (en) * | 2016-07-07 | 2016-11-09 | 西北工业大学 | The rapid model prediction control method compensated based on input trend |
CN107390706A (en) * | 2017-07-26 | 2017-11-24 | 北京航空航天大学 | A kind of unmanned plane short range combat decision-making technique based on the motor-driven algorithm of preview |
CN107390706B (en) * | 2017-07-26 | 2020-01-17 | 北京航空航天大学 | Unmanned aerial vehicle near combat decision method based on rehearsal maneuver rule system |
CN108646734A (en) * | 2018-04-27 | 2018-10-12 | 天津大学 | Nonlinear model predictive control method based on quanta particle swarm optimization |
CN108646734B (en) * | 2018-04-27 | 2021-04-02 | 天津大学 | Nonlinear model prediction control method based on quantum particle swarm algorithm |
CN110832420A (en) * | 2018-07-19 | 2020-02-21 | 深圳市大疆创新科技有限公司 | Unmanned aerial vehicle control method and device and unmanned aerial vehicle |
CN109032136A (en) * | 2018-07-23 | 2018-12-18 | 西北工业大学 | The more unmanned boat formation trackings of drive lacking based on master-salve distributed Model Predictive Control |
CN109032136B (en) * | 2018-07-23 | 2020-09-08 | 西北工业大学 | Under-actuated multi-unmanned ship formation tracking method based on master-slave distributed model predictive control |
CN109254592A (en) * | 2018-09-17 | 2019-01-22 | 中国人民解放军国防科技大学 | Unmanned aerial vehicle formation change control method and system |
CN109491403A (en) * | 2018-11-03 | 2019-03-19 | 上海电力学院 | A kind of collaboration Altitude Long Endurance Unmanned Air Vehicle connection control method |
CN109491403B (en) * | 2018-11-03 | 2021-09-07 | 上海电力学院 | Cooperative high-altitude long-endurance unmanned aerial vehicle connection control method |
CN109598088A (en) * | 2018-12-20 | 2019-04-09 | 中国矿业大学 | A kind of belt conveyor belt speed setting control method |
CN109598088B (en) * | 2018-12-20 | 2022-02-11 | 中国矿业大学 | Belt speed setting control method for belt conveyor |
CN109582040B (en) * | 2019-01-25 | 2021-08-06 | 中国人民解放军国防科技大学 | Unmanned aerial vehicle cluster formation and performance vulnerability assessment method and system |
CN109582040A (en) * | 2019-01-25 | 2019-04-05 | 中国人民解放军国防科技大学 | Unmanned aerial vehicle cluster formation and performance vulnerability assessment method and system |
CN109871032A (en) * | 2019-03-04 | 2019-06-11 | 中科院成都信息技术股份有限公司 | A kind of multiple no-manned plane formation cooperative control method based on Model Predictive Control |
CN109917806A (en) * | 2019-03-14 | 2019-06-21 | 北京航空航天大学 | A kind of unmanned plane cluster formation control method based on noninferior solution dove group's optimization |
CN109917806B (en) * | 2019-03-14 | 2020-08-11 | 北京航空航天大学 | Unmanned aerial vehicle cluster formation control method based on non-inferior solution pigeon swarm optimization |
CN109960148A (en) * | 2019-03-20 | 2019-07-02 | 中国科学院软件研究所 | A kind of the independence appraisal procedure and system of intelligent Unmanned Systems |
CN109960148B (en) * | 2019-03-20 | 2020-06-09 | 中国科学院软件研究所 | Autonomy evaluation method and system for intelligent unmanned system |
CN110162035A (en) * | 2019-03-21 | 2019-08-23 | 中山大学 | A kind of clustered machine people is having the cooperative motion method in barrier scene |
CN109885096A (en) * | 2019-04-08 | 2019-06-14 | 哈尔滨工程大学 | A kind of autonomous underwater robot path trace closed loop control method based on Lyapunov-MPC technology |
CN110109476A (en) * | 2019-05-06 | 2019-08-09 | 中国人民解放军军事科学院国防科技创新研究院 | Isomery unmanned vehicle independent anti-collision warning method based on collision probability |
CN110134135A (en) * | 2019-05-27 | 2019-08-16 | 郑州轻工业学院 | Based on the quadrotor control method for improving MPC-PID |
CN110134135B (en) * | 2019-05-27 | 2022-03-18 | 郑州轻工业学院 | Four-rotor aircraft control method based on improved MPC-PID |
CN111830826A (en) * | 2020-05-29 | 2020-10-27 | 中国科学技术大学 | Networked dual-mode self-adaptive time domain model control method and system |
CN111830826B (en) * | 2020-05-29 | 2022-09-06 | 中国科学技术大学 | Networked dual-mode self-adaptive time domain model control method and system |
CN111813086A (en) * | 2020-07-15 | 2020-10-23 | 北京航空航天大学云南创新研究院 | Model-based unmanned system autonomy evaluation method |
CN111813086B (en) * | 2020-07-15 | 2023-08-25 | 北京航空航天大学云南创新研究院 | Model-based unmanned system autonomy assessment method |
CN112911225A (en) * | 2021-01-19 | 2021-06-04 | 深圳科盾量子信息科技有限公司 | Video monitoring method based on quantum encryption |
CN113467507A (en) * | 2021-06-28 | 2021-10-01 | 中交遥感载荷(江苏)科技有限公司 | Atmospheric environment sampling method based on unmanned aerial vehicle system and unmanned aerial vehicle system thereof |
CN113467507B (en) * | 2021-06-28 | 2024-02-23 | 中交遥感载荷(江苏)科技有限公司 | Atmospheric environment sampling method based on unmanned aerial vehicle system and unmanned aerial vehicle system |
CN113885554A (en) * | 2021-09-13 | 2022-01-04 | 汕头大学 | Distributed enclosure control method and system for unmanned aerial vehicle cluster |
CN113885554B (en) * | 2021-09-13 | 2023-07-25 | 汕头大学 | Distributed capture control method and system for unmanned aerial vehicle clusters |
Also Published As
Publication number | Publication date |
---|---|
CN103995539B (en) | 2016-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103995539B (en) | A kind of unmanned plane autonomous formation evaluation index and MPC formation control method | |
Wu et al. | Distributed trajectory optimization for multiple solar-powered UAVs target tracking in urban environment by Adaptive Grasshopper Optimization Algorithm | |
CN112114521B (en) | Intelligent prediction control entry guidance method for spacecraft | |
CN103941728A (en) | Formation changing method for intensive autonomous formations of unmanned aerial vehicle | |
Wu et al. | Adaptive neural control based on high order integral chained differentiator for morphing aircraft | |
CN107220403A (en) | The control association modeling method of aircraft Elastic mode | |
CN105138006A (en) | Cooperated tracking control method of time-lag non-linear multi-agent systems | |
Mashkov et al. | Improvement of variational-gradient method in dynamical systems of automated control for integro-differential models | |
Sun et al. | Observability and performance analysis of a model-free synthetic air data estimator | |
CN112947534A (en) | Adaptive pseudo-spectral method trajectory optimization method for depression section of hypersonic aircraft | |
Casado et al. | Identification and initial characterization of sources of uncertainty affecting the performance of future trajectory management automation systems | |
CN107065897A (en) | Three Degree Of Freedom helicopter explicit model forecast Control Algorithm | |
Zhifei et al. | Target maneuver trajectory prediction based on RBF neural network optimized by hybrid algorithm | |
Zhao et al. | Reinforcement Learning‐Based Collision Avoidance Guidance Algorithm for Fixed‐Wing UAVs | |
Wen et al. | Design of LPV‐Based Sliding Mode Controller with Finite Time Convergence for a Morphing Aircraft | |
Wu et al. | Learning-based fixed-wing UAV reactive maneuver control for obstacle avoidance | |
Hao et al. | Effect of network structure on the stability margin of large vehicle formation with distributed control | |
CN110851911B (en) | Terminal state calculation model training method, control sequence searching method and device | |
Garcia et al. | Online artificial neural network model‐based nonlinear model predictive controller for the meridian UAS | |
CN111580389A (en) | Three-degree-of-freedom helicopter explicit model prediction control method based on deep learning | |
Shahrooei et al. | Falsification of learning-based controllers through multi-fidelity Bayesian optimization | |
Yao et al. | Hierarchical path generation for distributed mission planning of UAVs | |
Wu et al. | Multi-phase trajectory optimization for an aerial-aquatic vehicle considering the influence of navigation error | |
Hood et al. | Model fidelity studies for rapid trajectory optimization | |
Huang et al. | Optimal satellite formation reconfiguration using co-evolutionary particle swarm optimization in deep space |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |