HAL Id: hal-00786843
https://hal.archives-ouvertes.fr/hal-00786843
Submitted on 30 Mar 2021
HAL is a multi-disciplinary open access archive for the deposit and dissemination of sci- entific research documents, whether they are pub- lished or not. The documents may come from teaching and research institutions in France or abroad, or from public or private research centers.
L’archive ouverte pluridisciplinaire HAL, est destinée au dépôt et à la diffusion de documents scientifiques de niveau recherche, publiés ou non, émanant des établissements d’enseignement et de recherche français ou étrangers, des laboratoires publics ou privés.
Conditional Servo-compensator of an Airlaunch System
Cuong Nguyen Van, Gilney Damm
To cite this version:
Cuong Nguyen Van, Gilney Damm. Conditional Servo-compensator of an Airlaunch System. 10th
IEEE International Conference on Networking, Sensing and Control (ICNSC 2013), Apr 2013, Evry,
France. pp.734–739, �10.1109/ICNSC.2013.6548829�. �hal-00786843�
Conditional Servo-compensator of an Airlaunch System*
Van Cuong Nguyen and Gilney Damm
Abstract— A Multiple Input Multiple Output (MIMO) con- troller based on the conditional servo-compensator technique is designed for the robust stabilization of a new satellite launching strategy called (unmanned) airlaunch. This strategy consists in using a two-stages launching system. The first stage is composed of an airplane (manned or unmanned) that carries a rocket launcher which constitute the subsequent stages. The control objective is to stabilize the aircraft in the launch phase. It is developed separately for two nonlinear motion modes of the model, the longitudinal and lateral modes, and is applied to the full multi-input multi-output model of the aircraft.
The controller is indeed able to assure system stability for rather large disturbances. Performance of the proposed control algorithm is illustrated through simulations.
I. I NTRODUCTION
This work presents the design of a controller for the robust stabilization of a new satellite launching strategy called (unmanned) airlaunch. This strategy consists in using a two-stages launching system. The first stage is composed of an airplane that carries a rocket launcher which constitutes the subsequent stage. The aircraft brings the rocket to a desired drop area, consequently avoiding many costs and risks related to land rocket launching. On the other hand, this procedure brings up many other difficulties connected to the instant of releasing the rocket.
Currently, several airlaunch systems are under develop- ment (see [14], [3]). Most current airlaunch projects use standard or lightly modified airplanes as first stage. For example, there has been tests using F15, C17, B52, L-1011 in Rascal, QuickReach, Proteus and Pegasus projects. Unlike those, other projects aim to develop an airlaunch system that uses an unmanned aerial vehicle (UAV) instead of a standard aircraft with a human pilot inboard. The objective is then to use an UAV to fly the launcher to the desired drop point. There are many advantages in doing so, in first place safety since no human lives are involved during the delicate launching phase. In addition, since there is no need for life supporting devices, weight is restricted to the strict minimum. Finally, mission may take as long as necessary without human restrictions as tiredness.
The present paper addresses the stabilization of the drop phase. It intends to introduce a robust control scheme for this complex procedure. In fact, airlaunch may be very delicate for many reasons. For example, since the rocket may be
*The research leading to these results has received funding from the European Union Seventh Framework Programme [FP7/2007-2013] under grant agreement n257462 HYCON2 Network of excellence
Van Cuong Nguyen is with IBISC - Universit´e d’Evry Val d’Essonne, Evry, France [email protected]
Gilney Damm is with IBISC - Universit´e d’Evry Val d’Essonne, Evry, France [email protected]
almost as heavy as the UAV, this means that the aircraft will instantaneously lose almost half of its mass. Current air- launch systems present a much smaller ratio launcher/aircraft and rely on human pilot to stabilize the aircraft during and immediately after the launching instant. The proposed system must replace the human pilot in this stabilization task, with a much more adverse mass ratio. In the same way, the two-stages system is strongly nonlinear and can even for small perturbations be brought quite far from the initial equilibrium point. Furthermore, available models are based on experiments for different flight conditions, with lookup tables and polynomial interpolation between these points. For this reason, parameters and even models are not very well known, and need very robust control schemes like those found in [5].
Our previous works proposed a new strategy based on MIMO conditional integrator (see [2]) for the nonlinear model to stabilize the airlaunch system after the launching phase, which is modeled by the Initial conditions aproach [12] and by Perturbation on aerodynamic force and moment in [11]. The designed controller resulted in a better behavior in these extreme situation that are nevertheless expected in the unmanned airlaunch. This paper is an extension of the previous works using the MIMO Conditional Servocompen- sator based controller developed in a series of papers ([7], [4] and [1]) to stabilize the airlaunch system in the case where the launching phase is modeled by perturbation on aerodynamic force and moment (see [11]).
The paper is organized as follows: in section II, we describe the nonlinear mathematical system model based on [13],[16] and [10]. The control design literature is discussed in section III, and its application to the full nonlinear system model in section IV. The paper is completed by some computer simulations and conclusions.
II. M ODELING
Drop phase is delicate to model, and requires a large amount of data and previous knowledge about the real sys- tem. It can also be represented as a hybrid system composed by two (or three) continuous models that are switched. These models represents the system before, (possible during) and after the separation phase. In the present work we have adopted this strategy, we have considered three phases, using two aircraft models.
1) before the separation ⇒ The first aircraft model (rep- resenting the UAV and the rocket) is in an stable operating condition
2) during the separation ⇒ a second aircraft model
representing only the UAV, starting on the previous
operating condition is disturbed by impulses on forces and moments. These disturbances are inside a time interval T int and represent a not perfect separation.
Furthermore the initial conditions, inherited from the first phase, are not an equilibrium point for the second aircraft model.
3) after the separation ⇒ the disturbances stop (UAV and rocket are not in physical contact anymore). It can be shown that the effect of launching the rocket from the UAV impacts most the lift force, and the roll and pitch moments. We suppose that these perturbing force and moments are constant during interval T int , and we represent then F z
p, L p and M p for the perturbations on the lift force, on the roll moment and pitch moment respectively. In the present work we will study a worst case of disturbance. We consider that the separation phase is not simultaneous in all links that attach the rocket and the UAV. For this reason, the rocket remains attached to one end of the UAV during T int . We have then studied how long the disturbance could last and that the control algorithm could still stabilize the aircraft back.
We have then assumed that:
•
the perturbation on lift force during T int is equal the rocket’s mass times gravity, that means F z
p= mg.
•
the perturbation on pitch moment during T int is M p = mgl r /2 where l r is the rocket length.
•
the perturbation on roll moment during T int is small, because of the geometry of the rocket (thin and long).
•
the model following the launch phase is that of an F- 16. Its initial condition is the equilibrium point of the model previous the launch phase. This is taken as the F-16 model with twice the F-16’s mass.
Fig. 1. Frames: Body fixed axes OX
BY
BZ
B, Stability axes OX
SY
SZ
S, Aerodynamic axes OX
WY
WZ
WFollowing this procedure, the F-16 aircraft in the instant following the dynamic airlaunch is described in the aerody- namic axes (the aerodynamic axes OX W Y W Z W in the Fig.
1) i.e. the reference frame attached to the airspeed vector (V ). The system dynamics can be expressed as (see [16]
and [17]):
In (1), I xx , I yy , I zz , I xz are the moments of inertia, m is the mass of the system (kg) and g the gravity constant.
α, β, V, p, q, r, φ, θ, ψ are the state variables of the airlaunch aircraft model, they are the angle of attack, sideslip, airspeed, roll rate, pitch rate, yaw rate, roll angle, pitch angle and yaw angle respectively. α, β, φ, θ, ψ are expressed in rad, p, q, r in rad/s and V in m/s. T is the thrust force, F x , F y , F z and L, M, N are aerodynamic forces and moments respectively.
All forces and moments are expressed in N and Nm.
˙
α = − cos α tan βp + q − sin α tan βr
−
mVsincosαβ(T + F
x) +
mVcosαcosβF
z+
Vcosg β[sin α cos θ + cos α cos φ cos θ]
β ˙ = sin αp − cos αr −
cosmVαsinβ[T + F
x] +
cosβmVF
y−
sinαmVsinβF
z+
Vg[cos α sin β sin θ + cos β cos θ sin φ − sin α sin β cosφ cos θ]
V ˙ =
cosαmcosβ[T + F
x] +
sinmβF
y+
sinαmcosβF
z+ g[cos α cos β sin θ + sin β sin φ cos θ + sin α cos β cosφ cos θ]
˙
p =
I 1xxIzz−I2xz
[(I
yyI
zz− I
zz2− I
xz2)rq − I
xz(I
xx+I
zz− I
yy)pq + I
zzL − I
xzN]
˙ q =
I1yy
[(I
zz− I
xx)pr + I
xz(p
2− r
2) + M]
˙
r =
I 1xxIzz−Ixz2
[(−I
xxI
yy+ I
zz2+ I
xz2)pq +I
xz(I
xx+ I
zz− I
yy)rq + I
xxN − I
xzL]
φ ˙ = p + tan θ(q sin φ + r cos φ) θ ˙ = q cos φ − r sin φ
ψ ˙ =
qsinφ+rcosθcosφ(1)
These aerodynamic forces and moments are function of all the considered states. In this model, these aerodynamic forces and moments are under look-up table from wind tunnel data measurements as may be found in [10]. Finally, the control inputs are respectively the aileron (δ a ), rudder (δ r ) and elevator (δ e ) angles.
This model is based on wind tunnel data from NASA, considering the following conditions:
•
angle of attack is in the range of [−10
◦, 45
◦] and sideslip of [−30
◦, 30
◦]
•
flag deflection is ignored
•
physical constraints for aileron (|δ a | ≤ 21.5
◦), rudders (|δ e | ≤ 25
◦) and elevator (|δ r | ≤ 30
◦)
•
all actuators are modeled as a first order model (τ = 1/0.0495s) with limit rates 60
◦/s for aileron and ele- vator, and 120
◦/s for rudder.
In particular, we use the low quality mode of the F- 16 model, and the aerodynamic data is interpolated and extrapolated linearly in simulation from tables found in [10].
III. C ONTROL DESIGN
A. Conditional servo-compensator control design
The MIMO conditional servo-compensator controller de-
sign for the output regulation of a class of minimum-
phase nonlinear systems in case of asymptotically constant
references is studied in [7], [4] and [2]. These papers
concern a servo-compensator performing as a sliding mode
controller outside the boundary layer, and performing as a
conditional one that provides servo-compensation only inside
the boundary layer. First results have studied the SISO case
with a scalar sliding surface and the asymptotic stability
of the system inside a boundary layer. These results were
extended in [15] and [8] for linearized MIMO systems under some additional assumptions. Our present work is dedicated to use a nonlinear extension of these results developed in [1], for stabilizing an unmanned aircraft after the airlaunch phase.
Consider the system:
e ˙ 1 = e 2
˙
e 2 = f (e 1 , e 2 ) + g(e 1 , e 2 )u (2) where e 1 (t) ∈ R n is an output error vector, e 2 = ˙ e 1 , u ∈ R n
control input and f (e 1 , e 2 ) ∈ R n , g(e 1 , e 2 ) ∈ R n×n are
continuous functions.
Let us define the sliding surface as:
s = K 0 σ + K 1 e 1 + e 2 (3) where σ ∈ R n is the output of the conditional servo- compensator
˙
σ = −K 0 σ + µsat(s/µ) (4) in which µ is the boundary layer, K 0 is a positive definite matrix, K 1 ∈ R n×n is chosen such a way that K 1 + sI n is Hurwitz.
The saturation function is determined as:
sat(s/µ) =
s/ksk if ksk ≥ µ
s/µ if ksk < µ (5) The previous work [2] has shown that system (2) is exponentially stabilized by the controller called Conditional Integrator in the case where K 0 is a scalar. The paper [1]
extends the result for the case of K 0 being a matrix. The controller is called Conditional Servo-compensator controller that we remind as below.
We denote O µ as the region neighborhood of (e 1 , e 2 ) = (0, 0) with a radius R µ for ksk < µ
O µ = {e = (e 1 , e 2 ) ∈ R n × R n | kek ≤ R µ } (6)
We state the following assumptions on the forcing terms f (e 1 , e 2 ) and g(e 1 , e 2 ) to design the control algorithm.
Assumption 3.1: f (e 1 , e 2 ) is bounded by a function of γ(ke 1 k + ke 2 k) (where γ(·) is a class K function) and a positive constant ∆ 0 :
kf (e 1 , e 2 )k ≤ γ(ke 1 k + ke 2 k) + ∆ 0
and as a consequence,
kf (e 1 = 0, e 2 = 0)k = kf (0, 0)k ≤ ∆ 0
for (e 1 , e 2 ) ∈ R n × R n . Inside the boundary layer, the function f (e 1 , e 2 ) is required to be Lipschitz for (e 1 , e 2 ) ∈ O µ , as a consequence
kf(e 1 , e 2 ) − f (0, 0)k ≤ L 1 ke 1 k + L 2 ke 2 k
γ(ke 1 k+ke 2 k) is also required to be Lipschitz for (e 1 , e 2 ) ∈ O µ :
γ(ke 1 k + ke 2 k) ≤ γ 1 ke 1 k + γ 2 ke 2 k
Assumption 3.2: Function g(e 1 , e 2 ) is continuous and in- vertible for all (e 1 , e 2 ) ∈ R n × R n .
Following these conditions, the controller u defined below can be applied to (2) to stabilize the system:
u = −Π(e 1 , e 2 )sat(s/µ)
Π(·) = g
−1(·)(Π 0 + µK 0 + (γ(·) + ∆ 0 )I n ) (7) Π 0 is a positive definite matrix, µ is the boundary layer and K 0 is a positive definite matrix as defined above.
The stability of the control law (7) for system (2) can be demonstrated following the results of [1].
B. Longitudinal control design
In the longitudinal control design, we assume that all lateral state variables are null or constant, only longitudinal states are time varying. Moreover it is assumed that the airspeed’s response is much slower than other states, and that the control surface deflection has no effects on the aerodynamic force components (lift and drag) but only on moments.
Aerodynamic forces F x , F z and moment M can be calculated by its aerodynamic coefficients (see more in [6]).
F x = (C x (α) + ¯ cC x
q(α)q/(2V ))¯ qS, F z = (C z (α, β) +
¯
cC z
q(α)q/(2V ))¯ qS, M = (C m (α) + C m
q(α)q¯ c/(2V ) + C m
δe(α)δ e )¯ qS ¯ c . By replacing F x , F z , moment M and β = 0, φ = 0, p = 0, r = 0 in (1). The model for longitudinal dynamic can be written as:
˙
α= mV 1 [− sin α(T + C x (α)¯ qS) + cos αC z (α)¯ qS]
+q + 4m ρS (− sin αC x
q(α)¯ c + cos αC z
q(α)¯ c)q + V g cos (θ 0 − α)
˙
q =I 7 qS(C ¯ m (α)¯ c + C m
q(α)¯ cq + C m
δe(α)¯ cδ e ) θ ˙ =q
(8)
in which S is wing area, q ¯ air pressure, c ¯ equivalent width, I 7 = 1/I yy , C x (α), C x
q(α), C z (α), C z
q(α), C m (α), C m
q(α) C m
δe(α) are aerodynamic coefficients taken from [9].
Equation (8) can be rearranged as:
θ ˙ = q
˙
α = f 11 α (α) + (1 + f 12 α (α))q + f 13 α (α, θ)
˙
q = f 21 α (α) + f 22 α (α)q + g α 2 (α)δ e
(9)
where f 11 α (α), f 12 α (α), f 13 α (α, θ), f 21 α (α), f 22 α (α) and g α 2 (α) represent the terms of (8) respectively.
Let us define x α 1 = α, x α 2 = ˙ x α 1 = ˙ α and u α = δ e , which allow us to rewrite (9) into:
θ ˙ = η α (x α 1 , x α 2 , θ) (10a)
˙ x α 1 = x α 2
˙
x α 2 = F α
0(x α 1 , x α 2 , θ) + G α
0(x α 1 , x α 2 )u α (10b) where
η
α(·) =(x
α2− f
11α(x
α1) − f
13α(x
α1, θ))/(1 + f
12α(x
α1)) F
α0
(·)=
∂f11∂xα(xαα1)1
x
α2+
∂f13α∂x(xαα1) 1x
α2+(1 + f
12α(x
α1))f
21α(x
α1) + (
∂(1+f∂x12αα(xα1)) 1x
α2+(1 + f
12α(x
α1))f
22α(x
α1))
(xα2−f(1+f11α(xαα1)−f13α(xα1))12(xα1))
G
α0
(·)=(1 + f
12α(x
α1))g
2α(x
α1)
(11)
We define now the reference for the angle of attack α ref
considered as constant in this study, and the error vector of angle of attack e α 1 = x α 1 −x α 1ref = α−α ref and the variable e α 2 = ˙ e α 1 . Equation (10b) can be transformed into (12):
e ˙ α 1 = e α 2
˙
e α 2 = F α (e α 1 , e α 2 , θ) + G α (e α 1 , e α 2 )u α (12) Here we remark that G α (x α 1 , x α 2 ) is invertible, and that F α (x α 1 , x α 2 , θ) and G α (x α 1 , x α 2 ) are Lipschitz for the entire domain of actuation of the system.
Applying the control algorithm presented in (7) for system (12) (in this case a nonlinear single input single output system) gives the controller:
u α = −Π α (·)sat(s α /µ α )
Π α (·) = (G α )
−1(·)(Π α 0 + µ α K 0 α + γ α (·) + ∆ α 0 ) (13) with
s α = K 0 α σ α + K 1 α e α 1 + e α 2
˙
σ α = −K 0 α σ α + µ α sat(s α /µ α ) (14) where µ α , K 1 α are positive constants. Π α 0 and K 0 α are positive constant.
The controller can be shown to assure the stability of angle of attack and its derivative. For the sake of brevity we skip the proof, that is straightforward and based on a Lyapunov function. It can be shown to go to a residual set that can be attenuated by higher gain. The conclusions we can have are that all errors will be ultimately bounded, where the remaining signals stands for the disturbance on the aircraft speed. It is interesting to remark that variable θ was left free, in order to allow situations as a looping, where θ is continuously varying. Its derivative on the other hand is bounded, and also goes to a residual set (by equation 12).
Since the airspeed control is only a secondary objective, we design a simple PI controller for the thrust to regulate airspeed. Its form is:
T = −k P (V − V r ) − k I ( ˙ V − V ˙ r )
where V r is the airspeed reference, k P = 711 and k I = 6.3.
C. Lateral control design
As in the case of longitudinal control design, in the lateral case it is considered that only lateral state variables are time varying.
β= ˙
mV1(− cos(α
0) sin(β)(T + C
x(α
0)¯ qS)
+ cos(β)C
y(β)¯ qS − sin(α
0) sin(β)C
z(α
0, β)¯ qS) + sin(α
0)p − cos(α
0)r +
4mρS(cos(β)C
yp(α
0)¯ bp + cos(β)C
yr(α
0)¯ br) +
Vg(cos(α
0) sin(β) sin(θ
0) + cos(β) cos(θ
0) sin(φ) − sin(α
0) sin(β) cos(φ)) φ=p ˙ + cos(φ) tan(θ
0)r
˙
p=I
3C
l(α
0, β)¯ qS ¯ b + I
4C
n(α
0, β)¯ qS ¯ b +
ρV S4 ¯b[(I
3C
lp(α
0) +I
4C
np(α
0))p + (I
3C
lr(α
0) + I
4C
nr(α
0))r]
+¯ qS[(I
3C
lδa(α
0) + I
4C
nδa(α
0))δ
a+ (I
3C
lδr(α
0) +I
4C
nδr(α
0))δ
r]
˙
r =I
4C
l(α
0, β)¯ qS ¯ b + I
9C
n(α
0, β)¯ qS ¯ b +
ρV S4 ¯b[(I
4C
lp(α
0) +I
9C
np(α
0))p + (I
4C
lr(α
0) + I
9C
nr(α
0))r]
+¯ qS[(I
4C
lδa(α
0) + I
9C
nδa(α
0))δ
a+ (I
4C
lδr(α
0) +I
9C
nδr(α
0))δ
r]
(15)
in which ¯ b is equivalent length, I 3 = (I I
zzxx
I
zz−Ixz2) , I 4 = (I I
xzxx
I
zz−Ixz2) , I 9 = (I I
xxxx
I
zz−Ixz2) . C y (α, δ e ), C y
p(α 0 ), C y
r(α 0 ), C l (α 0 , β), C n (α 0 , β), C l
p(α 0 ), C n
p(α 0 ), C l
r(α 0 ), C n
r(α 0 ), C l
δa(α 0 ), C n
δa(α 0 ), C l
δr(α 0 ), C n
δr(α 0 ) are lat- eral aerodynamic coefficients taken from [9].
Aerodynamic force F y and moments L, N are calculated by their aerodynamic coefficients (see more in [6]). F y = (C y (β ) + (C y
p(α)p + +C y
r(α)r)¯ b/(2V ))¯ qS , L = (C l (β) + C l
p(α, β)p ¯ b/(2V ) + C l
r(α, β)r ¯ b/(2V ) + C l
δa(α)δ a + C l
δr
(α)δ r )¯ qS ¯ b, N = (C n (β) + C n
p(α, β)p ¯ b/(2V ) + C n
r(α, β)r ¯ b/(2V ) + C n
δa(α)δ a + C n
δr(α)δ r )¯ qS ¯ b. By re- placing F y , moments L, N and α = α 0 , θ = θ 0 in (1). The lateral nonlinear dynamic model used for the control design procedure is consequently reduced as (15).
Equation (15) can be rearranged as:
β ˙
φ ˙
=f 11 β (β, φ) + f 12 β (β, φ) p
r p ˙
˙ r
=f 21 β (β, φ) + f 22 β (β, φ) p
r
+ g β 2 (β, φ) δ a
δ r
(16)
where f 11 β (·), f 12 β (·), f 13 β (·), f 21 β (·), f 22 β (·), and g 2 β (·) repre- sent the terms of (15) respectively. Equation (16) is mainly used for controller design and stability analysis.
Let us define x β 1 = [β, φ] T , x β 2 = ˙ x β 1 = [ ˙ β, φ] ˙ T and u β = (δ a , δ r ) T , that allow us to rewrite equation (16) to:
( x ˙ β 1 = x β 2
˙
x β 2 = F β
0
(x β 1 , x β 2 ) + G β
0
(x β 1 , x β 2 )u β (17) where
F β
0
(·) = ( ∂f
11β(·)
∂x
β1+ (f β (·) + f 12 β (·)f 22 β (·))(f 12 β (·))
−1)x β 2
−(f β (·) + f 12 β (·)f 22 β (·))(f 12 β (·))
−1f 11 β (·) + f 12 β (·)f 21 β (·) G β
0
(·) = f 12 β (·)g 2 β (·) f β (·) [p, r] T = ∂(f
β
12