Summary of the invention
The object of the embodiment of the present invention is to provide the non-linear flight control system robust adaptive of a kind of nonaffine fault-tolerant control system, is intended to solve the relevant little problem of achievement in research of fault-tolerant control of current non-affine nonlinear systems.
The embodiment of the present invention is to realize like this, the non-linear flight control system robust adaptive of a kind of nonaffine fault-tolerant control system, the non-linear flight control system robust adaptive of this nonaffine fault-tolerant control system comprises: reference model, controller, the non-linear controlled device of nonaffine, wave filter, backup system;
Reference model connects controller, and controller connects the non-linear controlled device of nonaffine and wave filter, and backup system connects controller and the non-linear controlled device of nonaffine.
Further, the non-linear flight control system robust adaptive of this nonaffine fault-tolerant control system is considered following non-affine nonlinear systems:
Wherein: x ∈ R
rfor state vector, u ∈ R
nfor input vector, d ∈ R
rfor the external disturbance vector of unknown bounded, f (.) is nonlinear function, is represented by the fault model obtaining after each input channel Actuators Failures:
Wherein σ
ifor the unknown inefficacy factor,
for the known inefficacy factor sigma of definition
imaximin, work as σ
i=1 represents that non-fault occurs, so control inputs exists Actuators Failures representation for fault to be:
u(t)=[u
1(t),u
2(t),……,u
n(t)]
T=∑u
c(t) (5.3)
Wherein ∑=diag (σ
1..., σ
n), so the non-affine nonlinear systems (5.1) under fault is expressed as:
Equation (5.4) is write as general type:
Wherein σ=[σ
1..., σ
n]
t, be convenient to carrying out of work, provide a hypothesis below;
Suppose 1:f (x, u
c, σ) and be x, u
c, the smooth continuous derivatived functions of σ, and control inputs u
cbounded, the output reference model of system (5.1) is:
Wherein: x
m∈ R
rfor the state vector of reference model, A
mbe a stable model reference system matrix, r ∈ R
lfor the input of reference model;
The object of robust Fault-Tolerant Control designs fault-tolerant control inputs u exactly
c(t), in the situation that there is external disturbance and Actuators Failures fault, guarantee || x (t)-x
m(t) ||≤ε;
Can be found out by (5.5), the fault parameter of the non-affine nonlinear systems under actuator failures and control inputs variable do not show and are contained in function.
Further, the implementation method of backup system comprises:
Definition
for the estimated value of σ, by hypothesis 1, by function f (x, u
c, σ)
near carry out single order Taylor series expansion, obtain:
Wherein:
Based on (5.7) and (5.8), (5.5) are write again as following equation:
Wherein:
υ(t)=ξ(t)+d(t) (5.11)
Find out that υ (t) is unknown and bounded, is defined as
Definition ε=z-x, wherein z is the observed reading of state x, for (5.9), observer is as follows:
And drawn by following adaptive law
Wherein γ
1> 0, P=P
t> 0 and P are A
tthe solution of P+PA=-Q, wherein Q=Q
t> 0, A is a Hurwitz matrix, guarantees the minimum value of estimated value in setting
and maximal value
between, the design of sliding formwork item is as follows;
Time-varying parameter m (t) is upgraded and is obtained by following adaptive law:
Definition inefficacy factor evaluated error is
by observer equation (5.12) and equation (5.9), obtain observational error dynamic equation and be:
Further, by observer
adaptive updates rule
With sliding formwork item
Observational error dynamic equation
asymptotically stable in the large,, to arbitrary initial value ε (0), guarantees lim
t → ∞ε (t)=0, damage Fault Estimation error
bounded;
Serialization sliding formwork item is as follows:
Wherein: ρ=ρ
0+ ρ
1|| ε ||, and ρ
0and ρ
1for being greater than 0 constant.
Further, the implementation method of controller and stability analysis comprises:
Based on observer
utilize the non-affine nonlinear systems controller implementation method of putting forward early stage, first definition
observer
Write as following obtaining:
Choose u
nat u
cnear, and will
at u
nplace carries out Taylor series expansion and obtains:
Wherein:
Definition
(5.18) are expressed as again:
Found out by (5.19), if u
nmore approach u
c, the higher order indefinite small O (t) of Taylor series more trends towards 0,
Due to u in reality
cbe that the controller being designed calculates, current time is unknown, so cannot directly obtain near the u it
nso, introduce wave filter here for estimating and definite u
n, the wave filter of introducing is as follows:
Therefore by wave filter (5.23), obtain lim
ζ → ∞u
n=u
c, i.e. lim
ζ → ∞o (t)=0, so by above analysis, observer dynamic equation (5.18) is expressed as:
Definition observer state variable
tracking error be
utilize dynamic inverse, as follows based on equation (5.24) design control law:
Ride gain K can be obtained by following Riccati Solving Equations:
K
TP
1+P
1K=-Q
1 (5.26)
Wherein
Further, define system tracking error e=x-x
m, failure system
at controller
And observer
under the closed-loop system of composition, can ensure system asymptotic tracking reference locus, i.e. lim
ζ → ∞, t → ∞e=0;
Prove: will in control law (5.25) substitution (5.24), obtain observer error dynamics equation:
Select following Lyapunov equation:
To V
1differentiate, and utilize Young inequality 2ab≤ε a
ta+ ε
-1b
tb obtains:
Wherein:
λ
min(.), λ
max(.) is minimax eigenvalue matrix, therefore uses the consistent final bounded lemma of the overall situation, obtains V
1exponential convergence, and
finally can converge to following territory:
Because lim
ζ → ∞o (t)=0, can obtain
again by the result of theorem
so be easy to obtain lim
ζ → ∞, t → ∞e (t)=0.
Further,
contrary may existence, for avoiding this kind of situation to occur, often adopt in practice following formula to replace
that is:
Wherein α is positive definite matrix.
The non-linear flight control system robust adaptive of nonaffine provided by the invention fault-tolerant control system, has the nonlinear system of nonaffine form, and exists observer in wide variation situation still can have quite desirable robustness in parameter for parameter; Observer all implies failure message and disturbance information wherein, then based on observer dynamic design fault-tolerant controller, because system is non-affine nonlinear systems, the design of controller is also not easy, non-affine nonlinear systems is approximately to an Affine Incentive nonlinear system with time-varying parameter, and the required parameter of knowing is carried out On-line Estimation by a wave filter.Utilize a nonaffine flight control system to verify the validity of institute's extracting method, can realize the robust Fault-Tolerant Control of non-affine nonlinear systems.The present invention has realized the fault-tolerant control of robust adaptive of non-affine nonlinear systems, and is applied in flight control system, and simulation result shows the validity of institute's extracting method.
Embodiment
In order to make object of the present invention, technical scheme and advantage clearer, below in conjunction with embodiment, the present invention is further elaborated.Should be appreciated that specific embodiment described herein, only in order to explain the present invention, is not intended to limit the present invention.
Below in conjunction with drawings and the specific embodiments, application principle of the present invention is further described.
As shown in Figure 1, the non-linear flight control system robust adaptive of the nonaffine of embodiment of the present invention fault-tolerant control system mainly by: reference model 1, controller 2, the non-linear controlled device 3 of nonaffine, wave filter 4, backup system 5 form;
Reference model 1 connects controller 2, and controller 2 connects the non-linear controlled device 3 of nonaffine and wave filter 4, and backup system 5 connects controller 2 and the non-linear controlled device 3 of nonaffine;
Specific embodiments of the invention:
1, problem is described:
Consider following non-affine nonlinear systems:
Wherein: x ∈ R
rfor state vector, u ∈ R
nfor input vector, d ∈ R
rfor the external disturbance vector of unknown bounded, f (.) is nonlinear function, in the present invention, using Actuators Failures as research situation, do not considering in Actuator dynamic situation, the fault model that can be obtained after each input channel Actuators Failures by previous section can represent:
Wherein σ
ifor the unknown inefficacy factor,
for the known inefficacy factor sigma of definition
imaximin, work as σ
i=1 represents that non-fault occurs, so control inputs exists Actuators Failures fault to be expressed as:
u(t)=[u
1(t),u
2(t),……,u
n(t)]
T=∑u
c(t) (5.3)
Wherein ∑=diag (σ
1..., σ
n), so the non-affine nonlinear systems (5.1) under fault can be expressed as:
Equation (5.4) can be write as general type:
Wherein σ=[σ
1..., σ
n]
t, be convenient to carrying out of work, provide a hypothesis below;
Suppose 1:f (x, u
c, σ) and be x, u
c, the smooth continuous derivatived functions of σ, and control inputs u
cbounded, the output reference model of system (5.1) is:
Wherein: x
m∈ R
rfor the state vector of reference model, A
mbe a stable model reference system matrix, r ∈ R
lfor the input of reference model;
The object of robust Fault-Tolerant Control designs fault-tolerant control inputs u exactly
c(t), in the situation that there is external disturbance and Actuators Failures fault, guarantee || x (t)-x
m(t) ||≤ε;
Can be found out by (5.5), the fault parameter of the non-affine nonlinear systems under actuator failures and control inputs variable do not show and are contained in function, this brings very large difficulty to the estimation of fault parameter and the design of controller, the present invention provides based on adaptive sliding mode Design of Observer parameter estimation algorithm, and provide a kind of new nonaffine Design of non-linear controllers method, design a kind of fault-tolerant controller of non-affine nonlinear systems;
2, fault-tolerant control system:
2.1, backup system:
Definition
for the estimated value of σ, by hypothesis 1, by function f (x, u
c, σ)
near carry out single order Taylor series
Launch, can obtain:
Wherein:
Based on (5.7) and (5.8), (5.5) can be write again as following equation:
Wherein:
υ(t)=ξ(t)+d(t) (5.11)
Can find out that υ (t) is unknown and bounded, is defined as
Definition ε=z-x, wherein z is the observed reading of state x, for (5.9), designs following observer:
And drawn by following adaptive law
Wherein γ
1> 0, P=P
t> 0 and P are A
tthe solution of P+PA=-Q, wherein Q=Q
t> 0, A is a Hurwitz matrix, it can guarantee the minimum value of estimated value in setting
and maximal value
between, the design of sliding formwork item is as follows;
Time-varying parameter m (t) is upgraded and is obtained by following adaptive law:
Definition inefficacy factor evaluated error is
by observer equation (5.12) and equation (5.9), can obtain observational error dynamic equation and be:
Theorem 5.1: by observer (5.12), adaptive updates rule (5.13) and sliding formwork item (5.14), can observational error dynamic equation (5.16) asymptotically stable in the large, to arbitrary initial value ε (0), guarantee lim
t → ∞ε (t)=0, damage Fault Estimation error
bounded;
Prove: the similar theorem 3.1 of proof procedure;
Card is finished.
Serialization sliding formwork item is as follows:
Wherein: ρ=ρ
0+ ρ
1|| ε ||, and ρ
0and ρ
1for being greater than 0 constant;
Remarks 5.1: the present invention exists
near dynamic equation (5.5) is carried out to single order Taylor series expansion, here (parameter changes greatly the approximate inaccurate problem of model of avoiding parameter to change causing greatly, the higher order term that Taylor series approximation is ignored will be larger, at this moment higher order term just can not be left in the basket), and the method that the present invention carries, because approximate model is a parameter time varying affine nonlinear system, and as long as parameter estimation algorithm can have convergence faster than observer in the observer of design, just can ensure the accuracy of approximate model;
2.2, controller design and stability analysis:
Based on observer (5.12), utilize the non-affine nonlinear systems controller design method of carrying early stage, first definition
observer (5.12) can be write as following obtaining:
Choose u
nat u
cnear, and will
at u
nplace carries out Taylor series expansion and obtains:
Wherein:
Definition
(5.18) can be expressed as again:
Can be found out by (5.19), if u
nmore approach u
c, the higher order indefinite small O (t) of Taylor series gets over
To in 0,
Due to u in reality
cbe that the controller being designed calculates, current time is unknown, so cannot directly obtain near the u it
nso, introduce wave filter here for estimating and definite u
n, the wave filter of introducing is as follows:
Therefore by wave filter (5.23), can obtain lim
ζ → ∞u
n=u
c, i.e. lim
ζ → ∞o (t)=0, so by above analysis, observer dynamic equation (5.18) can be expressed as:
Definition observer state variable
tracking error be
utilize dynamic inverse, as follows based on equation (5.24) design control law:
Ride gain K can be obtained by following Riccati Solving Equations:
K
TP
1+P
1K=-Q
1 (5.26)
Wherein
Theorem 5.2: define system tracking error e=x-x
m, failure system (5.5) is in controller (5.25), and under the closed-loop system of observer (5.12)-(5.14) composition, can ensure system asymptotic tracking reference locus, i.e. lim
ζ → ∞, t → ∞e=0;
Prove: will in control law (5.25) substitution (5.24), can obtain observer error dynamics equation:
Select following Lyapunov equation:
To V
1differentiate, and utilize Young inequality 2ab≤ε a
ta+ ε
-1b
tb obtains:
Wherein:
λ
min(.), λ
max(.) is minimax eigenvalue matrix, therefore uses the consistent final bounded lemma of the overall situation, can obtain V
1exponential convergence, and
finally can converge to following territory:
Because lim
ζ → ∞o (t)=0, can obtain
again by the result of theorem 5.1
so be easy to obtain lim
ζ → ∞, t → ∞e (t)=0;
Card is finished.
Remarks 5.2:
contrary may existence, for avoiding this kind of situation to occur, often adopt in practice following formula to replace
that is:
Wherein α is positive definite matrix;
For convenience of reader understanding, provide design frame chart of the present invention here as Fig. 1.
By following simulating, verifying, effect of the present invention is further described:
Next, utilize document
[137,160]provide the validity that unmanned aerial vehicle flight path angle and speed control system carry out emulation proof institute extracting method;
Dynamic model is:
Definition flying speed V, path angle γ, position angle, path χ is state variable, thrust T, load factor n, and pitch angle μ is control inputs, resistance D computing formula is as follows:
Model parameter is as shown in table 1:
Table 1 model parameter value
Definition status variable x=[V, γ, χ]
t, control inputs is u=[T, n, μ]
t, the Actuators Failures factor is σ=[σ
1, σ
2, σ
3]
t, external disturbance is d=[d
1, d
2, d
3]
t=[0.2cos (2t), 0.0002sin (t), 0.0002cos (t)]
t, equation (5.33) can be expressed as:
Wherein:
c
12=-2kgW/ (ρ S), c
13=-g, c
14=g/W, c
21=-g, c
22=g, c
31=g, the reference locus of setting speed v is 300m/s, path angle γ, the reference locus of position angle, path χ is exported by two following reference models:
Wherein r
χ(t)=30sin (π t/18) deg;
Suppose that Actuators Failures fault occurs as follows:
State initial value is V (0)=300m/s, γ (0)=0deg, χ (0)=0deg, m (0)=0.15, σ (0)=[1,1,1]
t, design aiding system parameter is A=diag (2 ,-2 ,-2), γ
1=2, Г=1000, ρ
0=5, designing filter parameter is ζ=50, controller gain K=diag (1,1,1), P=diag (0.3,1800,2000);
Situation 1: consider under normal circumstances, the control of designed controller to non-affine nonlinear systems, controller is designed to:
As shown in Figure 2, the nonaffine control method carried is as seen from Figure 2 effectively to the response curve of system tracking error, can realize preferably and estimate to follow the tracks of.
Situation 2: after fault (5.38) occurs, what controller still used is (5.39), system keeps track mistake
Poor response curve is shown in Fig. 3, can find out in the situation of not carrying out fault-tolerant control, can not realize the input track reference track of system;
Situation 3: after fault (5.38) occurs, adopt the fault-tolerant controller of the present invention's design, system tracking error response curve is shown in Fig. 4, the estimation of parameter σ
with sliding formwork item v (t) response curve as shown in Figure 5, can find out that the present invention proposes fault-tolerant control and can make system under failure condition, still can ensure that system has good tracking performance.
The present invention is directed to exist and disturb and the uncertain non-affine nonlinear systems of parameter, under given Fault-tolerant Control System Design framework, provide a kind of nonaffine Nonlinear Fault Tolerant controller design method, designed observer can be applicable to parameter and have the nonlinear system of nonaffine form, and exist observer in wide variation situation still can have quite desirable robustness in parameter, observer all implies failure message and disturbance information wherein, then based on observer dynamic design fault-tolerant controller, because system is non-affine nonlinear systems, the design of controller is also not easy, the present invention provides a kind of dynamically non-affine nonlinear systems approximation method, non-affine nonlinear systems is approximately to an Affine Incentive nonlinear system with time-varying parameter, and the required parameter of knowing is carried out On-line Estimation by a wave filter, utilize a nonaffine flight control system to verify the validity of institute's extracting method, can realize the robust Fault-Tolerant Control of non-affine nonlinear systems.
The foregoing is only preferred embodiment of the present invention, not in order to limit the present invention, all any amendments of doing within the spirit and principles in the present invention, be equal to and replace and improvement etc., within all should being included in protection scope of the present invention.