You are on page 1of 137

UPC-ETSEIB ESTEC TEC-ECN

MASTERS THESIS

Design of a robust controller for the VEGA TVC


using the synthesis technique

Author: GADEA DIAZ Enrique


ESA Technical Advisor: BENNANI Samir

Noordwijk, October 10, 2011


MASTERS THESIS

Design of a robust controller for the VEGA TVC


using the synthesis technique

Author: GADEA DIAZ Enrique


ESA Technical Advisor: BENNANI Samir
Noordwijk, October 10, 2011

3
Acknowledgments
This Masters Thesis project would not have been possible without the support of many
people. The author wishes to express his gratitude to his supervisor, Dr. Samir Bennani
who was abundantly helpful and oered invaluable assistance, support and guidance and
to all the GNC section team especially to Dr. Guillermo Ortega for his support and help.
The author also wishes to express his gratitude to all the stagiaires and trainees that made
his stay in the Netherlands so incredible.

Special thanks to Marine Parahy and to all his friends from the ETSEIB and SU-
PAERO that brought an inestimable support during these years.

The author wishes to express his love and gratitude to his beloved family members
Eduardo, Josena and Javier; for their understanding and endless love, through the dura-
tion of his studies.

5
Abstract
This study has been developed in the European Space Research and Technology Centre
(ESTEC) in the TEC-ECN section.

The purpose of this study is to design a robust controller for the thrust vector control
of the VEGA launcher using the synthesis design. To reach this objective a rst study
of the equations of motions together with the impact and eect of a classical controller
will be done.

The studied model will include the rigid body motions together with three bending
modes. To get the desired performances it will be necessary to design three dierent con-
trollers. One for the rigid body behaviour, another for ltering the bending modes and
a last one to reduce the angle of attack. In practice the lter for the bending modes is
designed by knowing the shape that it should have, without taking the requirements into
account. Using a synthesis design for the lter denition the requirements introduced
by the weighting functions are satised in the better way.

The main part of the study will be carried out for the pitch axis. However, at the
end of this study a model taking the coupling between pitch and yaw into account will be
presented simultaneously with a controller being able to stabilise overall

7
Contents

1 Introduction 17
1.1 Main Objectives . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
1.2 Study Logic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
1.3 System Description . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 20
1.3.1 The Vega Launcher . . . . . . . . . . . . . . . . . . . . . . . . . . . 20
1.3.2 System elements . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 23

2 Scientific context 32
2.1 Technical specication . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 32
2.1.1 General requirements . . . . . . . . . . . . . . . . . . . . . . . . . . 32
2.1.2 Problems of launchers control . . . . . . . . . . . . . . . . . . . . . . 33
2.2 Control laws used in launch vehicles . . . . . . . . . . . . . . . . . . . . . . 37

3 Classical controller 40
3.1 Launch Vehicle Modelling . . . . . . . . . . . . . . . . . . . . . . . . . . . . 40
3.1.1 Impact of Kp and Kd . . . . . . . . . . . . . . . . . . . . . . . . . . 40
3.1.2 Finding the value of Kp and Kd . . . . . . . . . . . . . . . . . . . . 43
3.1.3 System Behaviour . . . . . . . . . . . . . . . . . . . . . . . . . . . . 46
3.2 Complete Rigid Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 50
3.2.1 feedback . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 55
3.2.2 z feedback . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 58
3.2.3 z feedback . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 60
3.2.4 z + z feedback . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 62
3.2.5 Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 63
3.3 Flexible Launch Vehicle Dynamics . . . . . . . . . . . . . . . . . . . . . . . 64
3.3.1 Bending modes impact . . . . . . . . . . . . . . . . . . . . . . . . . . 65

4 Robust Control 68
4.1 Uncertainty Modelling . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 68
4.1.1 Kp and Kd as a function of a6 . . . . . . . . . . . . . . . . . . . . . 68
4.1.2 Using the PD controller dened by slides . . . . . . . . . . . . . . . 68
4.2 Building a new synthesis model . . . . . . . . . . . . . . . . . . . . . . . . . 70
4.2.1 Weighting Functions . . . . . . . . . . . . . . . . . . . . . . . . . . . 71
4.3 Robustness Analysis . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 75
4.3.1 Robust Stability And Performance . . . . . . . . . . . . . . . . . . . 78

9
4.3.2 Worst Case Performance and Skew . . . . . . . . . . . . . . . . . 79
4.4 Rigid Body controller . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 80
4.5 Bending Modes . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 83
4.6 Drift control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 86
4.7 One controller for all the Pay Loads . . . . . . . . . . . . . . . . . . . . . . 90
4.8 Time simulation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 91

5 Multi-axis controller 93
5.1 Problems due to the coupling . . . . . . . . . . . . . . . . . . . . . . . . . . 93
5.2 Building the system model . . . . . . . . . . . . . . . . . . . . . . . . . . . . 94
5.3 Designing a new controller . . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
5.4 Bending modes and drift control . . . . . . . . . . . . . . . . . . . . . . . . 101
5.4.1 Bending modes . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 101
5.5 Limitations of this approach . . . . . . . . . . . . . . . . . . . . . . . . . . . 104

A Complete rigid body dynamic 110


A.1 Rigid body dynamic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 110
A.2 External Forces and Moments . . . . . . . . . . . . . . . . . . . . . . . . . . 112
A.2.1 Gravity . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 112
A.2.2 Thrust . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 113
A.3 Building the synthesis model . . . . . . . . . . . . . . . . . . . . . . . . . . 116

B Tuning a controller 118


B.1 Introducing time domain constraint . . . . . . . . . . . . . . . . . . . . . . . 118
B.2 Introducing frequency domain constraint . . . . . . . . . . . . . . . . . . . . 120

C Getting the controller in one step 122

D Time Simulation 124


D.1 Interpolation of Controllers . . . . . . . . . . . . . . . . . . . . . . . . . . . 124
D.2 Time Simulation for the classical controller . . . . . . . . . . . . . . . . . . 126
D.2.1 Time simulation with as feedback . . . . . . . . . . . . . . . . . . 126
D.2.2 Time simulation with z as feedback . . . . . . . . . . . . . . . . . . 129
D.2.3 Time simulation with z as feedback . . . . . . . . . . . . . . . . . . 131
D.2.4 Time simulation with z + z as feedback . . . . . . . . . . . . . . . . 133
D.3 Time Simulation for the robust controller . . . . . . . . . . . . . . . . . . . 135
D.3.1 Time simulation for the rigid body controller . . . . . . . . . . . . . 135
D.3.2 Time simulation including the bending modes . . . . . . . . . . . . . 136
D.3.3 Time simulation for the drift control . . . . . . . . . . . . . . . . . . 137

E Robustness 138
E.1 Robustness of the classical controller . . . . . . . . . . . . . . . . . . . . . . 138
E.2 Robustness of the synthesis controller . . . . . . . . . . . . . . . . . . . 140

10
List of Figures

1.1 Study Logic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 19


1.2 Structure of the Vega Launcher . . . . . . . . . . . . . . . . . . . . . . . . . 21
1.3 Vega Mission Prole . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 22
1.4 Launch vehicle forces and torques in ight . . . . . . . . . . . . . . . . . . . 24
1.5 Evolution of k1 and a6 as a function of time . . . . . . . . . . . . . . . . . . 27
1.6 Flexible LV . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 28

2.1 Model with uncertainties . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 33


2.2 Maximum roll rate allowed . . . . . . . . . . . . . . . . . . . . . . . . . . . 35
2.3 Low frequency gain margin as a function of the roll rate . . . . . . . . . . . 36
2.4 Synthesis model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38
2.5 Model with a rst stabilisation (H) . . . . . . . . . . . . . . . . . . . . . . . 39

3.1 Roots evolution depending on Kp value . . . . . . . . . . . . . . . . . . . . 41


3.2 Model with Kp . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 41
3.3 Model with Kd . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 42
3.4 Roots evolution depending on Kd value . . . . . . . . . . . . . . . . . . . . 42
3.5 Model with Kp and Kd . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 43
GK
3.6 Bode and Step response for 1+GK . . . . . . . . . . . . . . . . . . . . . . . . 44
GK
3.7 Black plot for GK(S) Bode and Step response for 1+GK . . . . . . . . . . . 45
3.8 Evolution of k1 and a6 as a function of time . . . . . . . . . . . . . . . . . . 45
3.9 Evolution of W and as a function of time . . . . . . . . . . . . . . . . . . 46
3.10 Evolution of Phase Margin and Roots as a function of time . . . . . . . . . 47
3.11 Frequency evolution . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 47
3.12 Evolution of Kp and Kd as a function of time . . . . . . . . . . . . . . . . . 48
3.13 Delay Margin . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 48
3.14 Rigid body model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 51
GK
3.15 Black plot for GK(S) and Bode and Step response for 1+GK . . . . . . . . 52
GK
3.16 Black plot for GK(S) and Bode and Step response for 1+GK . . . . . . . . 53
3.17 Theta response for a Step in w . . . . . . . . . . . . . . . . . . . . . . . . . 54
3.18 Step response with w = 0.03 and ref = 0 as input . . . . . . . . . . . . . . 55
3.19 Step response with w = 0.03 and ref = 0.08 as input . . . . . . . . . . . . 55
3.20 Root locus depending on parameter K . . . . . . . . . . . . . . . . . . . . . 56
3.21 Alpha response for a step with dierent gain feedback . . . . . . . . . . . . . 57
3.22 Alpha response for a step with dierent gain feedback . . . . . . . . . . . . . 58

11
LIST OF FIGURES

3.23 Root Locus plot . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 59


3.24 and drift response for a ref = 0.08 . . . . . . . . . . . . . . . . . . . . . . 60
3.25 Theta response for a Step in w . . . . . . . . . . . . . . . . . . . . . . . . . 60
3.26 Root Locus . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 61
3.27 Theta response for dierent Kz values . . . . . . . . . . . . . . . . . . . . . 62
3.28 Theta response . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 62
3.29 Step Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 65
3.30 Black plot of G(s) and GK(s) . . . . . . . . . . . . . . . . . . . . . . . . . . 66
GK
3.31 Black plot for GK(S) and Bode and Step response for 1+GK . . . . . . . . 66
3.32 Step Response and close loop Bode plot . . . . . . . . . . . . . . . . . . . . 67

4.1 Evolution and boundaries of Kp and Kd on time . . . . . . . . . . . . . . . 69


4.2 Evolution and boundaries of A6 ,W and k1 as a function of time . . . . . . 69
4.3 Root Locus . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 70
4.4 Nyquist . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 70
4.5 Root Locus . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 71
4.6 W-functions . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 73
4.7 W-functions . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 73
4.8 LFT Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 75
4.9 N-structure . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 76
4.10 M- structure . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 78
4.11 Rigid body controller . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 80
4.12 3D plot of the controllers . . . . . . . . . . . . . . . . . . . . . . . . . . . . 81
4.13 S,T,KS,and Alpha Bode plots . . . . . . . . . . . . . . . . . . . . . . . . . . 82
4.14 Margins . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 83
4.15 Shapes of Wf lex lter . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 85
4.16 Rigid body with bending modes system . . . . . . . . . . . . . . . . . . . . . 85
4.17 Shape of a lter designed using synthesis . . . . . . . . . . . . . . . . . 86
4.18 3D plot of the notch lter and the complete controller . . . . . . . . . . . . 86
4.19 S,T,KS,and Alpha Bode plots . . . . . . . . . . . . . . . . . . . . . . . . . . 87
4.20 Synthesis Model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 88
4.21 Weighting function for the wind input . . . . . . . . . . . . . . . . . . . . . 89
4.22 Comparison between both rigid body controllers . . . . . . . . . . . . . . . . 89
4.23 Shape of the Kdrift controller . . . . . . . . . . . . . . . . . . . . . . . . . . 90

5.1 Pitch response for dierent roll rates (p) . . . . . . . . . . . . . . . . . . . 94


5.2 Yaw response for dierent roll rates (p) . . . . . . . . . . . . . . . . . . . . 94
5.3 Multi-axes rigid body model . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
5.4 Multi-axis rigid body model . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
5.5 Controller shape for dierent roll rates . . . . . . . . . . . . . . . . . . . . 97
5.6 Roll rate prole . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 97
5.7 S,T,KS,and Alpha Bode plots . . . . . . . . . . . . . . . . . . . . . . . . . . 98
5.8 S and T Bode plot from ref . . . . . . . . . . . . . . . . . . . . . . . . . . . 99
5.9 KS, Alpha and Beta bode plot from ref . . . . . . . . . . . . . . . . . . . . 99
5.10 S and T Bode plot from ref . . . . . . . . . . . . . . . . . . . . . . . . . . 100
5.11 S,T,KS,and Alpha bode from ref . . . . . . . . . . . . . . . . . . . . . . . . 100

Enrique Gadea - Robust TVC Control 12


LIST OF FIGURES

5.12 Step response with and without lter . . . . . . . . . . . . . . . . . . . . . . 101


5.13 Multi-axis model . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 101
5.14 S,T and KS from ref . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 103
5.15 S and T bode plot from ref . . . . . . . . . . . . . . . . . . . . . . . . . . . 103
5.16 KS bode plot from ref . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 104

A.1 Thrust Conguration . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 113


A.2 Aerodynamic Conguration . . . . . . . . . . . . . . . . . . . . . . . . . . . 114

B.1 Comparison of the step response before and after using the PD optimization tool 119

C.1 Rigid body and bending modes lter . . . . . . . . . . . . . . . . . . . . . . . 122


C.2 Time simulation with drift control . . . . . . . . . . . . . . . . . . . . . . . 123

D.1 Theta response with 5s of transition duration and 0.1s . . . . . . . . . . . . 124


D.2 3D shape of two dierent controllers . . . . . . . . . . . . . . . . . . . . . . 125
D.3 Time simulation for the dierent controllers . . . . . . . . . . . . . . . . . . 125
D.4 Time simulation for ref = 1 and w = 0 . . . . . . . . . . . . . . . . . . . 126
D.5 Time simulation for ref = 0 and w = 1 . . . . . . . . . . . . . . . . . . . 127
D.6 Time simulation for ref = 0.08 and w = 0.03 . . . . . . . . . . . . . . . . 127
D.7 Time simulation for ref = 1 and w = 0 . . . . . . . . . . . . . . . . . . . 128
D.8 Time simulation for ref = 0 and w = 1 . . . . . . . . . . . . . . . . . . . 128
D.9 Time simulation for ref = 0.08 and w = 0.03 . . . . . . . . . . . . . . . . 129
D.10 Time simulation for ref = 1 and w = 0 . . . . . . . . . . . . . . . . . . . 129
D.11 Time simulation for ref = 1 and w = 0 . . . . . . . . . . . . . . . . . . . 130
D.12 Time simulation for ref = 0 and w = 1 . . . . . . . . . . . . . . . . . . . 130
D.13 Time simulation for ref = 0.08 and w = 0.03 . . . . . . . . . . . . . . . . 131
D.14 Time simulation for ref = 1 and w = 0 . . . . . . . . . . . . . . . . . . . 131
D.15 Time simulation for ref = 1 and w = 0 . . . . . . . . . . . . . . . . . . . 132
D.16 Time simulation for ref = 0 and w = 1 . . . . . . . . . . . . . . . . . . . 132
D.17 Time simulation for ref = 0 and w = 1 . . . . . . . . . . . . . . . . . . . 133
D.18 Time simulation for ref = 0.08 and w = 0 . . . . . . . . . . . . . . . . . . 133
D.19 Time simulation for ref = 0.08 and w = 0 . . . . . . . . . . . . . . . . . . 134
D.20 Time simulation for ref = 0 and w = 0.03 . . . . . . . . . . . . . . . . . . 134
D.21 Time simulation for ref = 0.08 and w = 0.03 . . . . . . . . . . . . . . . . 135
D.22 Time simulation for the rigid body . . . . . . . . . . . . . . . . . . . . . . . 136
D.23 Time simulation for the bending modes . . . . . . . . . . . . . . . . . . . . . 137
D.24 Time simulation for the drift control . . . . . . . . . . . . . . . . . . . . . . 137

Enrique Gadea - Robust TVC Control 13


LIST OF FIGURES

Acronyms
AV U M Altitude and Vernier Upper Module
COG Center Of Gravity
COP Center of Pressure
EOM Equations of Motion
GM Gain Margin
DM Delay Margin
PM Phase Margin
IM U Inertial Measurement Unit
LT I Linear Time Invariant
LT V Linear Time Varying
LP V Linear Parameter Varying
LV Launch Vehicle
SISO Single Input Single Output
M IM O Multi Input Multi Output
P ID Proportional Integral Derivative
RHP Right Half Plane
RS Robust Stability
RP Robust Performance
TV C Thrust Vector Control

List of Symbols
A Aerodynamic center of pressure
D
a1 = L +T
m
L
a2 = mU
T
a3 =m
a4 = mEmEC
a5 = mE ECJlyCG +JE
a6 = CzJyGA
C Nozzle pivot point
CA Coecient of axial aerodynamic force
CL Lift Coecient derivative
CN Coecient of normal aerodynamic force slope w.r.t. the incidence
Cn Local coecient of z-aerodynamic force slope w.r.t. the incidence
D qSCx
F Aerodynamic force
FA Aeroelastic force
G Center of mass of the entire launcher
N Center of mass of the nozzle
JL Launcher inertia without nozzle w.r.t. G
JE Nozzle inertia w.r.t. C

Enrique Gadea - Robust TVC Control 14


LIST OF FIGURES

k1 = T JCG
y
Curvilinear coordinate from the head and positive in backward direction
L Vehicle length
OA Distance between O and A
OC Distance between O and C
OP Distance between O and the payload center of mass P
CG Distance between C and G
GA Distance between G and A
GS Distance between G and S
GU Distance between G and U
EC Distance between N and C
IM U Distance between vehicle head and the Inertial Measurement Unit (IMU)
L = qSCN
m Total mass
| Mc Control torque about C for the nozzle rotation
mE Nozzle mass
mL Launcher mass without nozzle
O Origin of the body frame
q = 12 U 2
qh The generalized coordinate
Qh The generalized forces
S Reference surface
T Thrust
U Longitudinal Speed
Ur Air relative longitudinal speed
w Wind disturbance
Wind Wind vector
[G; xt ; yt , zt ] Trajectory reference frame
[G; xb ; yb ; zb ] Body xed reference frame
[O; x, y, z] Launch Vehicle (LV) geometric reference frame

Matrices
Af Flexible state matrix
Ar Rigid state matrix
Bf Flexible control matrix
Br Rigid control matrix
Cf Flexible output matrix
Cr Rigid output matrix
Df Flexible feed-through matrix
Dr Rigid feed-through matrix

Enrique Gadea - Robust TVC Control 15


Chapter 1

Introduction

World of controllers design is very huge, complex and hard to understand. Each
machine with a minimum level of mechanical complexity and some autonomy needs a
controller to guarantee a good behaviour and stability. Nowadays dierent controller
techniques design exist, including a lot of variations but it is true that depending on the
machine or the system that needs to be controlled one or another procedure can be chosen.
However, when control theory started, the way to avoid the open-loop problems was intro-
ducing feedbacks to control some outputs. The main objective was to stabilise the system
and to guarantee some performances but without looking things like robustness. Systems
were not very complex and perhaps the need to look for robustness was not yet born.
Results were good and with some classical controllers like a PID (Proportional Integral
Derivative) 90% of problems were solved and still do.

In the late 70s early 80s robust control was born and a new set of techniques with it.
Since then, complexity of mechanisms never stop growing and consequently an evolution
in the requirements appeared. Nowadays, systems have to satisfy some performances, be
stable and allow uncertainties in some parameters. For not very well-known, complex or
critical systems (like for example a launch vehicle) this is very important.
Current Launch Vehicles (LV) typically use classical controllers but since mass, thrust and
aerodynamic properties of the LV are varying all the time use of Gain Scheduling is neces-
sary. This procedure (using a classical controller) is cost expensive and has no robustness
at all. As it will be proved, a classical controller is designed in a linearised point of time
domain and do not support any uncertainties in the design. Even more, a variation in
the nominal design value stability cannot be guarantee. This is why robust concept is so
important and necessary in systems like a LV where there are not only some known time
varying parameters but there are also some unknown time varying parameters like wind
speed for example.
In addition LV are exible structures with their own bending modes that can induce to
instability. To avoid this problems, bending modes are ltered. Nevertheless, this lter
design is usually done by a previous experience without taking into account system per-
formances.

17
CHAPTER 1. INTRODUCTION

1.1 Main Objectives


The main purpose of this study is to present the dierent steps to design a robust
controller for the TVC using the synthesis technique and to study the advantages
obtained comparing to a classical one. This will be done for one axis rst then for multi-
axis, taking the coupling between pitch and yaw into account. A robust controller includes
a controller for the rigid body and a lter for the bending modes and a drift control if
necessary. As a tool to better achieve the objective, some controllers will be designed using
the data from the Vega Launcher. These controllers will be the base to show the main
dierences between the robust and the classical control, but in any case they represent a
boundary of what robust control can achieve. For sure some of them can be improved by
investing more time and resources. The main constraint, as it will be explained further,
is the non-convexity of the problem and some times the computational constraint.

Making a robust controller using the synthesis algorithm present the main draw-
back of the non-convexity of the algorithm. That means there is no way to guarantee an
optimal result. The second problem will be the denition of the weighting functions, used
for the synthesis model of the robust controller. To dene this functions it is important
to rst, have an idea of the desired closed-loop shape of the system and second, to adjust
the gains of all them to achieved the desired level of performances and robustness. It is
a trial and error process where the experience of the designer and his know-how has an
important role.

There is also an important computational constraint. When dening the synthesis


model, the number of states dened increases very fast (rigid body, bending modes, weight-
ing functions, controllers,etc.) producing a lot of limitations and forcing to reduce the order
of the elements thus losing in precision and in realism. Even doing so, there were some
points where it was impossible to nd a way to get any result so and interpolation of the
results from the nearest points was necessary.

This problem was not only present for the design of the controller but it also was
an important constraint for the time simulations too where the controllers were always
reduced.

1.2 Study Logic


The study logic of this document is shown in gure 1.1

1. The methodology of this study is focused in the progressive increase of the model
complexity together with the controller complexity. Starting from a very simple
two states rigid body model with a PD controller and evolving until reaching a
multi-axes controller considering the rigid body dynamic with roll coupling, bending
modes and the TVC actuator. This procedure, starting from the most simple model
and evolving into a complex one, will allow to introduce the basic notions of launch
vehicles and to increase the complexity of the system gradually making the impact of

Enrique Gadea - Robust TVC Control 18


CHAPTER 1. INTRODUCTION

Figure 1.1: Study Logic

each new element introduced together with the interaction between all the elements
easier to understand. This kind of approach allows to manage a complex problem
like a multi-axis controller design in a more familiar and easy way.

2. First it is necessary to understand what is a Launch Vehicle and what kind of be-
haviour has, so a rst study of the equations of motion together with the requirements
(to know what kind of result can be expected) is necessary. From this study one
may dene the basic synthesis model to start working with, together with a list of
specications to be satised by the system.

3. With this rst model a rst classical and basic controller is implemented in order
to see how the system reacts and what are the dierent response and behaviours
for dierent inputs and perturbations. The eect of the classical controller (a PD
controller) is studied and it will be used as a way to reach more complex and re-
alistic models. It will allow to have some orders of magnitude of the possibilities
introduced by a controller in the system, i.e error and drift minimization, angle of
attack reduction, etc. On the other hand, all the results obtained with the classical
controller will be used as a reference to the ones obtained by the robust controller.

4. Taking the same equations used in the classical controller and the desired per-
formances, a robust controller is designed. This controller is designed using the

Enrique Gadea - Robust TVC Control 19


CHAPTER 1. INTRODUCTION

synthesis technique and the results are compared with the ones obtained with
the classical controller to show the advantages of a robust controller in front of the
classical controller. One critical point while designing the robust controller is the
denition of the weighting functions. This will be managed thanks to the knowledge
of the system behaviour, acquired during the study and implementation of a classical
controller. With the weighting functions dened, a rst controller is designed and in
function of the performances achieved, the weighting functions will be modied. It is
a trial and error process but knowing the eect produced in the system when modi-
fying the weighting functions, a good solution can be found quickly. The robustness
results of each controller are compiled in annex E.
5. Once the one axis controller is done a new study will be performed introducing
the basis for the multi-axes situation. First of all, the rigid body dynamics will be
reviewed because when introducing the multi-axes there are some couplings eects to
add to the equations. After modifying the rigid body dynamics and using the results
and the knowledge from the classical and the robust controller, a new controller
will be designed in a robust way using the synthesis technique and taking the
roll-coupling into account.
6. For the classical controller and for the robust controller in one axis a rigid body
control is done rst, then the bending modes are taken into account and a drift
control is done at the end. For the drift control design, the bending modes are not
taken into account.
7. For each controller designed a complete time simulation is done. All the plots can
be found in annex D

1.3 System Description


1.3.1 The Vega Launcher
While this study can be used for any launch vehicle or rocket, on rst focus for imple-
mentation is the Vega Launcher.

The Vega Launcher was developed within a European Program organised under the
aegis of the European Space Agency. The launchers prime contractor is ELV S.p.a, a joint
company of Fiat Avio and the Italian Space Agency (ASI) but it also has the support of
Belgium, the Netherlands, Spain, Sweden, Switzerland and France. Although there is a
growing tendency for satellites to become larger, there is still a need for a small launcher to
place 300 to 2000 kg satellites, economically, into the polar and low-Earth orbits used for
many scientic and Earth observation missions. Europes answer to these needs is Vega,
named after the second brightest star in the northern hemisphere. Vega makes access to
space easier, quicker and cheaper.

Costs are being kept to a minimum by using advanced low-cost technologies and by
introducing an optimised synergy with existing production facilities used for Ariane launch-
ers. Vega has been designed as a single body launcher with three solid propulsion stages

Enrique Gadea - Robust TVC Control 20


CHAPTER 1. INTRODUCTION

and an additional liquid propulsion upper module used for attitude and orbit control, and
satellite release. Unlike most small launchers, Vega will be able to place multiple payloads
into orbit. Development of the Vega launcher started in 1998. The rst launch is planned
for December 2011 from Europes Spaceport in French Guiana where the Ariane-1 launch
facilities have been adapted for its use.

History
The origins of the Vega program go back to the early 90th, when some studies were
performed to investigate the possibility of complementing the Ariane family with a small
launch vehicle using Ariane solid booster technology. Vega began as a national Italian
concept. BPD Difesa y Spazio in 1988 proposed a vehicle to the Italian Space Agency to
replace the retired US Scout launcher by a new one based on the Zero motor developed
from the companys Ariane expertise.After about ten years of denition and consolidation
activities, the Italian Space Agency and Italian industry proposed Vega as a European
project based on their know-how in solid propulsion taken from development and pro-
duction Ariane 4 solid strap-on boosters (PAP) and components of the Ariane 5 solid
strap-on boosters (EAP). In April 1998, ESAs Counsil approved a Resolution authorizing
pre-development activity. As a result, the present conguration was chosen with rst stage
that could serve also as an improved Ariane-5 strap-on. The Vega program was approved
by ESA Ariane Programme Board on 27-28 November 2000, and the project ocially
started on 15 December 2000 when seven countries subscribed to the Declaration.

Figure 1.2: Structure of the Vega Launcher

The Vega Launcher has four stages : three with solid rocket motors and one liquid
propellant stage. The term stage is used to refer to a complete element of a launch
vehicle. By complete element is meant propellant tanks, one or more engines and electrical,
mechanical and uid equipment.

Typical mission profiles


A typical mission prole consists of the following three phases:

1. Phase I: Ascent of the rst three stages of the LV into the low elliptic trajectory
(sub-orbital prole);

2. Phase II: Payload and upper stage transfer to the initial parking orbit by rst AVUM
burn, orbital passive ight and orbital manoeuvres of the AVUM stage for payload
delivery to nal orbit;

Enrique Gadea - Robust TVC Control 21


CHAPTER 1. INTRODUCTION

3. Phase III: AVUM deorbitation or orbit disposal manoeuvres.

Figure 1.3: Vega Mission Prole

Phase I: Ascent of the first three stages The ight prole is optimized for each
mission. It is based on the following ight events:

1st stage ight with initial vertical ascent, programmed pitch manoeuvre and a zero-
incidence ight;

2nd stage zero-incidence ight;

3rd stage ight, fairing separation and injection into sub-orbital trajectory.

The typical Vega three-stage ascent proles and associated sequence of events are shown
in gure 1.3

Phase II: AVUM flight profile After third stage separation at the sub-orbital tra-
jectory the multiple AVUM 1 burns are used to transfer the payload to a wide variety of
intermediate or nal orbits, providing the required plane changes and orbit raising. Up to
5 burns can be provided by the AVUM to reach the nal orbit or to deliver the payload
to dierent orbits. Additionally, at the rst burn, AVUM can provide the compensation
of up to 3 errors accumulated during the rst three stage ight.
1
The AVUM is the 4th multifunctional stage of the Vega launch vehicle that is designed to pilot the
first three stage flight, to finalise orbit injection, to increase injection accuracy and to provide orbital
manoeuvres and payload separation.

Enrique Gadea - Robust TVC Control 22


CHAPTER 1. INTRODUCTION

PHASE III - AVUM deorbitation or orbit disposal manoeuvre After spacecraft


separation and following the time delay needed to provide a safe distance between the
AVUM and the spacecraft, the AVUM typically conducts a deorbitation or orbit disposal
manoeuvre. This manoeuvre is carried out by an additional burn of the AVUM main
engine.

1.3.2 System elements


In this study the rst stage is the only one that will be studied, specically the TVC.
Because all the attention is put in the TVC control, the other stages are not important
so they will not be included at any point. To make possible the study it is important
to know the EOM of the launcher including the rigid body dynamics and the bending
modes. These are the two main elements that are going to manage the behaviour of the
launcher during its ight. However, to increase the proximity between the designed model
and reality, the TVC actuator is also included

Rigid Body
The rigid LV dynamics are not the only motion that will appear in the nal EOM, but
are also interesting on their own since they can be used to make preliminary considerations
as regards to controller design.
One can start the derivation of the EOM by considering the forces and torques that
act on the LV during its atmospheric ight. These are shown in gure 1.4 in which the LV
is depicted as ascending along a predetermined trajectory. The reference frames, angles,
forces, torques, etc. appearing in gure 1.4 are the following:

= arctan( zbxW
b
) angle of attack w.r.t. the x-body axis
U velocity vector
W wind vector
U air relative velocity
FA aerodynamic force applied at the aerodynamic point A
T thrust
FE engine nozzle inertia force
ME engine nozzle inertia torque
mg weight

Gravity One force present all over the ight is gravity. The force of gravity will be
present in axes x and z. The expression of this force resolved along the body axes is

Fxg = mg sin
(1.1)
Fzg = mg cos

Thrust The thrust due to the rocket engines is one of the major forces acting on the LV
during its ight. Swivelling of the thrust vector is also the primary means by which the
LV attitude is controlled.

Enrique Gadea - Robust TVC Control 23


CHAPTER 1. INTRODUCTION

Figure 1.4: Launch vehicle forces and torques in ight

The forces and torque generated are given by:

FT x = T (t) cos()
FT z = T (t) sin() (1.2)
MT = T (t)CG sin()

where CG is the distance between the nozzle swivel point C and the center of gravity G.
Equation A.15 emphasize that the thrust is a function of time.

Aerodynamic Forces and Torques The interaction between the LV and the atmo-
sphere in which it ies generates aerodynamic forces and torques. This interaction is only
signicant during the early stages of ight and typically has a destabilizing eect on the
LV dynamics.

The forces and torques due to aerodynamic loads will be derived using quasi-steady-
state aerodynamic theory. The aerodynamic components of interest for plane (pitch)
motion are given by (Axial and Normal):

FAx = q(t)SCA
FAz = q(t)SCN (1.3)
MAy = q(t)SCN GA (t)

S reference surface

Enrique Gadea - Robust TVC Control 24


CHAPTER 1. INTRODUCTION

CA coecient of x-aerodynamic force


CN coecient of z-aerodynamic force

Where it was assumed that FAx and FAz act in the negative xb and zb directions respec-
tively as shown in gure 1.4. It is important to emphasize that the dynamic pressure q
and the distance GA between the aerodynamic center and the COG both depend strongly
on time.

Since the LV is not a lifting body there are no intrinsic aerodynamic torques, so that
the expression of the aerodynamic torque in equation A.16 has the very simple expression
of a force times a length. Furthermore, FAx is simply the aerodynamic drag which is essen-
tially independent from perturbations. Instead, the CN coecient appearing in equation
A.16 is typically a function of the angle of attack , its rate and the pitch rate . A
linear dependence of CN with respect to some steady state values of the aforementioned
variables, can be obtained by classical Taylor series, where the coecients of the series
are the classical stability derivatives. For LV having little or no lifting surfaces the only
stability derivative of real importance is typically the one associated with , which we
denote with CN = CN /. This stability derivative is, however, a function of Mach for
transonic and supersonic speeds. Furthermore, in the case of long slender LV, CN is a
function of position along the vehicle, CN (x) is therefore written that way to emphasize
this fact.

In order to completely dene FAz one can start by introducing the local angle of attack
for the rigid/exible LV,

(OG x) t)
(x, t) (x,
loc (x) = + (1.4)
U x U
where = arctan((zb W )xb ), OG is the distance between the origin and the center of
gravity of the LV and (x, t) is the displacement due to the bending modes.

Since both CN (x) and loc (x) depend on x the whole expression must be integrate on
the whole length L of the LV in order to obtain the desired expression of the aerodynamic
force. This gives:
L
1
FAz = U 2 S CN (x)loc (x) dx
2 0
( L
1 2 1 L
= U S CN (x) dx + CN (x)(OG x) dx (1.5)
2 0 U 0
)
L 1 L
+ CN i (x) dx qi (t) CN i (x) dx qi (t)
0 U 0
i i

The last two terms in equation 1.5 represent the aeroelastic terms.

Enrique Gadea - Robust TVC Control 25


CHAPTER 1. INTRODUCTION

Rigid Launch Vehicle Dynamics The equations of the rigid motion, written with
respect to the the body axes [G; xb , yb , zb ], are given in vector form by:
MG = I
(1.6)
FG = m(V + V )
where FG and MG are the forces and torques; m and I are mass and moment of inertia
and V and are the linear and angular velocity respectively. All the aforementioned
quantities are considered relative to the center of gravity of the whole LV system.

By the moment only the motion of the LV in the xz plane is considered and accepting
an axial symmetry of the LV, the equation1.6 can be specialized to:
Iyy = MG
m(xb + b zb ) = Fx (1.7)
m(zb b xb ) = Fz

where V = [xb , 0, zb ]T and = [0, b , 0]T . Coupling between pitch and yaw will be intro-
duced in 2.1.2

Above equations were written assuming that the variations of the mass (m) and mo-
ment of inertia (Iyy ) with respect to time are small compared to the dynamics of interest.

In order to obtain the nal form of the EOM one must dene the forces and torques
that appear in the above equation. Due to the fact that the LV typically ies at very small
angles of attack max , one can assume that the normal and axial aerodynamic forces are
just the lift and drag respectively.
MG = GA L T CG sin
Fx = T cos D mg sin(b ) (1.8)
Fz = L T sin + mg cos(b )

where L qSCN , D qSCA and the angle of attack is given as = arctan( zbxW
b
).
Combining the equations 1.7 and 1.8 together:
Iyy b = GA L T CG sin
m(xb + b zb ) = T cos D mg sin(b ) (1.9)
m(zb b xb ) = L T sin + mg cos(b )
The above equations can be rewritten in a more LV traditional way by introducing the
aerodynamic parameter a6 = LIyy
GA
and the controllability parameter k1 = T JCG
y
so that
the equation1.9 becomes:
b = a6 k1 sin
T cos D
xb = g sin b b zb (1.10)
m
L T
zb = sin + g cos b + b xb
m m

Enrique Gadea - Robust TVC Control 26


CHAPTER 1. INTRODUCTION

The nominal variations with time of the aerodynamic parameter a6 and the controllability
parameter k1 are shown in 1.5.

3.5 0.2

3 0.18

0.16
2.5

0.14
2
A6

K1
0.12
1.5
0.1

1
0.08

0.5 0.06

0 0.04
10 20 30 40 50 60 70 80 90 10 20 30 40 50 60 70 80 90
time time

(a) a6 evolution (b) k1 evolution

Figure 1.5: Evolution of k1 and a6 as a function of time

For control synthesis purposes it is necessary to linearise the rigid body motion of the
LV about a trajectory xed reference frame and to obtain a perturbed motion about the
reference trajectory, given by a time scheduled look-up table. Introducing the transforma-
tion matrix from the body rates to the local-level coordinates:
[ ]
LO cos sin
[T ] = (1.11)
sin cos

The perturbed equation of motion in body axes can be obtained as:


[ ] [ ] [ ]

x LO xB x
= [T ] L (1.12)
z zB zL

Writing the body states in term of reference variables and assuming small angles the
linear perturbed equations of motions become:

= a6 k1
( )
L T
x = L + L (1.13)
m m
T D L T
z =
m m m

Bending Modes
A schematic of the deected shape of the vehicle in the pitch plane is shown in 1.6.
The elastic deection at any point along the vehicle is given by


(x, t) = qi (t) i (x) (1.14)
i=1

Enrique Gadea - Robust TVC Control 27


CHAPTER 1. INTRODUCTION

Figure 1.6: Flexible LV

where x is the abscissa along the LV longitudinal axis shown in 1.6, i denotes the mass
normalized ith mode shape in the pitch plane. Finally, qi is the generalized coordinate of
ith mode which satises the equation:

qi + 2i i qi + i 2 qi = Qi (1.15)
where Qi is the generalized force associated with the ith mode and is given by:
L ( )
Qi = Fz i (x) + My i (x) dx (1.16)
0

where the local rotation is


i
i = (1.17)
x
Qi is thus a function of the moments and normal forces acting on the LV, and indicates
how a particular bending mode is coupled to all other dynamic modes of the system.
Considering only rst order eects, the ith bending mode is excited primarily by rocket
engine eects:
L[ ]
(x)
Qi = (T + mE EC )i (x) + JE dx
0 x (1.18)
( ) (OC )
= T mE EC i (OC ) + JE
x
where OC is the coordinate of the pivot point.

In order to have a launch vehicle autopilot controlled it is necessary to measure the LV


attitude(angular displacement and/or rate) and position (acceleration). As already men-
tioned, these measurements are typically obtained by an IMU, which, however, measure

Enrique Gadea - Robust TVC Control 28


CHAPTER 1. INTRODUCTION

not only the rigid body motion (the principal quantity interesting for trajectory following)
but also the local elastic distortion at the IMU location OU .
The local rotation due to the bending modes produces an output of the IMU simply
given by :

(x, t) i (x)
imu = = qi (t)
x x=OU x x=OU
i
(1.19)
= qi (t)i (OU )
i

As can be observed in equation 1.19 each mode gives a contribution i to rotation output
of the IMU given by,
i = qi (t) i (OU ) (1.20)
It is possible thus to consider the transfer function from the excitation of the mode
given by to the output at the IMU for the ith mode:
[ ]
(OC )
i m (
E EC i OC ) JE x s2 + T i (OC )
= i (OU ) (1.21)
s2 + 2i i s + i 2
If the engine inertia eects are neglected the above expression simplies to

i T i (OC )i (OU )
= 2 (1.22)
s + 2i i s + i 2

TVC actuator
The dynamic performance of the TVC/Nozzle assembly can be represented as two
serial connected transfer functions: a second order model for simulating the nozzle and a
pure delay for the actuator response:

eT s
WT V C (s) = (1.23)
B2 s2 + B1 s + B0
Nevertheless, the simulated TVC will omit the time delay.

Enrique Gadea - Robust TVC Control 29


Chapter 2

Scientific context

The main point of this study is to design a robust controller for the TVC control, a
lter for the bending modes and to take the coupling between pitch and yaw into account.
However, it is good to take a look to the actual scientic context about this matter not
only to take some references and ideas but also to see the possible deciencies and how
this study can contribute.

2.1 Technical specification


2.1.1 General requirements
It is necessary to know the basic requirements expected for the closed-loop behaviour
of the system. These requirements guarantee the desired behaviour and stability [2]. It is
true that there are much more needed requirements to take into account but a selection
of the most important will be enough to show what is expected to get.

6db Gain Margin for Low Frequency

20db Gain Margin for High Frequency

30 Phase Margin degrees

Stability : Stability must be guarantee

Tracking and drift minimization : This point is quite important for the mission suc-
cess since a launcher not following the desired trajectory, even stable, is useless.

Aerodynamic load minimization. It is important to avoid having excessive loads on


the launcher, and even more important is to avoid overpassing the maximum allowed.

31
CHAPTER 2. SCIENTIFIC CONTEXT

When the launcher enters in the maximum dynamic pressure it is more important
to keep the launcher structurally safe than guarantee any tracking.

2.1.2 Problems of launchers control


Control of launch vehicles has some problems that need to be studied. The main points
are the introduction of uncertainties into the model due of the non-well known parameters
or modes, the time variant parameters like mass, thrust or the aerodynamic coecients
and the coupling between pitch and yaw due to roll.

Introducing the uncertainties


First problem appears when introducing the uncertainties in the model. One possible
solution was presented by Dale F. Enns [10]. In his article, Dale proposed to introduce a
multiplicative uncertainty for the forgiven modes or the truncated ones, two to compensate
the inaccuracy when placing the poles and the zeros of the bending modes and another
one for the aerodynamic parameters (see gure 2.1). Of course it is necessary to introduce
some weighting functions to expand properly the eect all long the frequencies.

Figure 2.1: Model with uncertainties

These uncertainties will be also used for the robustness study.

Enrique Gadea - Robust TVC Control 32


CHAPTER 2. SCIENTIFIC CONTEXT

Coupling between axes


When having some roll, pitch and yaw are coupled following the expression:

= q + p
(2.1)
= r p

Z Ixx
q = a6 ( + ) + (1 ) p r + K1
V Iyy
(2.2)
Y Ixx
r = a6 ( + ) + (1 ) p q + K1
V Iyy

Z
Z = a ( + ) p Y T
V (2.3)
Y
Y = a ( + ) + p Z + T
V
with:
1 CN (xcp xCo G )
a6 = V 2 Sref >0
2 Iyy
(2.4)
1 CN
a = V 2 Sref
2 mass
If roll is null or very small the hypothesis of having two split axis is valid and the
control can be done individually for each axes but if the roll rate is important the coupling
exist.
Two dierent cases where presented by Lazennec [12]
feedback en (, ) for the attitude error,(q,r) for the angular rate;

feedback en (, ) for the attitude error, (, ) for the angular rate;


Making the necessaries modications in the equations and dening the closed-loop
frequency and damping as:

wp = (A6 + K1 k 2wp = K1 kD

The global system can be written:



0 1 p 0
q w 2 2w 2vpw Ixx
q
(1 )p
p p p Iyy
= p 0 0 1


(2.5)
r 2vpwp (1 Iyy )p
Ixx
wp 2 2wp r

This coupling can even destabilise the system. Taking the precedent matrix and using
the stability condition from Routh criteria in the determinant one can see that stability

Enrique Gadea - Robust TVC Control 33


CHAPTER 2. SCIENTIFIC CONTEXT

depends on the chosen feedback. Being v a parameter having 0 as value when using the
rst feedback and 1 when using the second one, from Routh conditions the only one active
is:
Ixx
vp2 (v ) wp2 < 0
Iyy
If v = 0 then stability is always guarantee, but not for v = 1 This study forgot the eect
of the lateral feedback necessary to control the drift. A study done by Roux et Cruciani
[5] shows that when introducing this new feedback both cases become unstable and a
boundary of the roll rate accepted appears for each moment of the y

Figure 2.2: Maximum roll rate allowed

Roux and Cruciani [5] mention the drawbacks of using a SISO approach to study the
coupling. One cannot be sure that the margins found reect reality. Nevertheless, the
system is not a real MIMO neither, it is a SISO sytem with a coupling increasing as roll
rate increase so the SISO approach is not so bad it just needs a renement. is now a
matrix aecting the pitch angle as well as the yaw.
( )
0
=
0
Now, a stability study can be done for dierent roll rates. Because there are only two
parameters to consider, stability can be plotted in plane ( , ) (gure(2.3)).

Linear Parameters Variant System


Control of launch vehicles is not an easy problem. First of all most of the parameters
are not time invariant. Mass like aerodynamic coecients or thrust are a function of
time and in addition there is an uncertainty above them making them time variant and
uncertain at the same time.

Enrique Gadea - Robust TVC Control 34


CHAPTER 2. SCIENTIFIC CONTEXT

Figure 2.3: Low frequency gain margin as a function of the roll rate

A lot of dierent studies were done about time invariant systems, but most of real
systems like the VEGA launcher have time variant parameters. To be able to use the
theorems from the linear control, systems are linearised around some equilibrium points.
The most critical points are usually chosen for the linearisation because if the system is
stable at that point it could be stable all the long the ight domain. The main drawback
of doing this is that it entail to have an important loss in the margins. That is why
the ight domain is linearised in dierent points and at each one a dierent control law
is designed. Problem appears when the system needs to switch from one controller to
the other one. There are two possible strategies to manage this. One option is to switch
directly from one law to the other depending on the ight point or the dierent laws can be
interpolated to have only one non-linear ight law. The interpolation technique is known
as gain scheduling. At the end of the eightys, gain scheduling was a qualied and ecient
technique but with a lack of theoretical justication. This gap was solved by Shamma
in 1988 when he dened the stability conditions for systems using gain scheduling in his
PHD thesis.

Modification of the control needs


Depending on the ight point, control needs can be very dierent. The main objective
is to have a good tracking and to be able to follow a desired trajectory but it can happen
that in some situations the main objective is to reduce the angle of attack (so the load
suer by the launcher is reduced). This is something important because as soon as a wind
prole is applied to the launch vehicle, minimizing the angle of attack and minimizing the
attitude error become antagonist strategies.

Enrique Gadea - Robust TVC Control 35


CHAPTER 2. SCIENTIFIC CONTEXT

2.2 Control laws used in launch vehicles


P D + 3rd feedback

First solution found easily in the literature is a control law using a PD controller
plus a third feedback to control the drift, usually the angle of attack. It is easy
to show that a PD controller can stabilise the system. The proportional term acts
immediately reducing the stationary error and thanks to the predictive phenomena
of the derivative term, the transitory error is also reduced.
With as the input of the system and as the output, the simplied model of a
launcher can be written like:
k1
= G(s) = 2
s a6
After the introduction of the angle of attack or the drift speed as a new state and
introducing the wind as input, it is necessary to control the drift in some way. To
do that is necessary to introduce a new feedback. Dierent options appear and
everything will be studied with more detail further in this document. Choosing the
angle of attack as feedback the control law used is:

= ((Kp + Kd s) + K )

With the new transfer functions one can nd the necessary conditions for the drift
or angle of attack minimization.

Drift minimization
This approach looks for the control law making (z = 0) Using the previous
control law z can be dened as:
zss a0 zss

= ( + w ) (2.6)
U k1 (K + K a6 ) U

With a0 as independent term of the closed loop determinant. If a0 = 0 then


z = 0 for any wind input

Angle of attack minimization


Minimization of the angle of attack is necessary to reduce the load suer by
the launcher, specially at the maximum dynamic pressure moment. While the
launcher cross this zone is more important to guarantee the structural resis-
tance of the launcher than the possibles deviations on tracking. Condition to
minimise the angle of attack is given by : K = 0 This kind of control law is
unstable but can be accepted for small time periods.

Enrique Gadea - Robust TVC Control 36


CHAPTER 2. SCIENTIFIC CONTEXT

PIDF

Use of a PD controller can be upgraded adding an integrator and a low pas lter.
Introducing an integrator the stationary error following a step will be null and the
lter will dim the amplications done in high frequency by the derivative term. The
PIDF is dene like:
( )
KI KD (s) 1
P IDF (s) = Kp + +
I (s) + 1 D s + 1 F (s) + 1

H
The H tries to nd a controller K(s) able to stabilise the system G(s) and to
minimise the innity norm of the closed loop between the inputs and the outputs.

T fyw <

With dened as a scalar Virgilio and Kamimoto [10] dened a way to introduce a
H controller explaining all the steps followed.

1. Creation of a synthesis model


A synthesis model like the one in gure 2.4 has to be built.

Figure 2.4: Synthesis model

2. Creation of the weighting functions


The dierent weights introduced in the outputs will dene the shape and the
performances of the system. It is important to know how the function should

Enrique Gadea - Robust TVC Control 37


CHAPTER 2. SCIENTIFIC CONTEXT

look like and after having an idea of the shape it is necessary to make small
adjustment in a trial and error procedure.
To nd for example the weighting functions necessaries for the sensitivity output
or for the complementary sensitivity one can take the simplied model with a
PD controller to have an idea of the shape. However all the weighting functions
will be explained with more detail in chapter 4.
3. Solve the optimization H problem

4. Modify the weighting functions until nd the desired performances

synthesis

Yasuhiro Morita wrote in 2004 [8] a way to introduce the synthesis in the
launchers world. First of all it is important to remark than rigid body poles of a
launcher are unstable by default. Because of that synthesis results could not be
as good as expected. Morita propose to do a rst stabilisation of the system and to
make use of the synthesis afterwords. Calling H the necessary feedback for the
rst stabilisation and F the controller found with the synthesis technique, the
nal controller will be a combination of both 2.5.

Figure 2.5: Model with a rst stabilisation (H)

Enrique Gadea - Robust TVC Control 38


Chapter 3

Classical controller

3.1 Launch Vehicle Modelling


To create the most basic model of LV one can start taking the equation of the pitch
angle from the EOM developed in section 1.3.2

= a6 k1 sin()
And working with small angles and accepting than = the equation can also be
rewritten as
= a6 k1 () (3.1)
Doing that it is now easy to dene the transfer function between and and so the rst
two states model is dened
k1
= G(s) = 2 (3.2)
s a6

Poles are in a6 and due to the fact that a6 is always bigger than 0, one pole has
a positive real part and the system is then unstable. However, it is known by classical
control experience that a PD controller will stabilize the model. Adding the controller
into the system, the open-loop transfer function is

K(s) = Kp + Kd s
k1 (Kp + Kd s) (3.3)
GK(s) =
s2 a6

3.1.1 Impact of Kp and Kd


Knowing that a PD controller can stabilise the system it is useful to see rst the impact
that Kp and Kd have in it. To do that and to see how the eigenvalues evolves, a rst system
with only a proportional controller rst and with only a derivative one after was created.

39
CHAPTER 3. CLASSICAL CONTROLLER

Kp

1 8

0.8
6
0.6
4
0.4
2
0.2

0 0

0.2
2
0.4
4
0.6
6
0.8

1 8
8 6 4 2 0 2 4 6 8 0.8 0.6 0.4 0.2 0 0.2 0.4 0.6 0.8

(a) roots position Kp>0 (b) roots position Kp<0

Figure 3.1: Roots evolution depending on Kp value

Adding a proportional controller in the loop has a direct impact into the frequency.
It is easy to see that the system is going to have two pure imaginaries poles or two real
ones being then one stable and the other one unstable. In any case damping is not going
to be controlled. Figure 3.1 shows that roots can only be moved all long the axis what
means that damping cannot be controlled. The system cannot be stabilized with only a
proportional controller.
The transfer function of the system in open-loop is
k1 Kp
GK(s) = (3.4)
s2 a6
and in closed-loop
GK k1 Kp
(s) = 2 (3.5)
1 + GK s (a6 + k1 Kp )

Figure 3.2: Model with Kp

The closed-loop poles can be easily found solving the equation


s2 (a6 + k1 Kp ) = 0
(3.6)
s = a6 + k1 Kp

Enrique Gadea - Robust TVC Control 40


CHAPTER 3. CLASSICAL CONTROLLER

As it was said before, roots can only be real or complexes conjugates, depending on if
a6 + k1 Kp > 0 or a6 + k1 Kp < 0

Kd

The introduction of Kd in the system will add a term in s making the damping con-
trollable. The new transfer function will be:
k1 Kd s
GK(s) = 2 (3.7)
s a6
And in close loop
GK k1 Kd s
(s) = 2 (3.8)
1 + GK s k1 Kd s a6

Figure 3.3: Model with Kd

And closed-loop roots are going to evolve like in picture 3.4

1 1

0.8 0.8

0.6 0.6

0.4 0.4

0.2 0.2

0 0

0.2 0.2

0.4 0.4

0.6 0.6

0.8 0.8

1 1
10 0 10 20 30 40 50 60 60 50 40 30 20 10 0 10

(a) roots position Kd>0 (b) roots position Kd<0

Figure 3.4: Roots evolution depending on Kd value

Proceeding in the same way than before it can be inferred than systems roots are
placed in
k1 Kd (k1 Kd )2 + 4a6
s= (3.9)
2

Enrique Gadea - Robust TVC Control 41


CHAPTER 3. CLASSICAL CONTROLLER

The only way to have a stable system is having Kd < 0 and |k1 Kd | > (k1 Kd )2 + 4a6

Kp and Kd

Combining now both controller, either frequency, damping or both of them can be
aected. The system is totally controllable. Thanks to Routh criterion a rst approach
about Kp and Kd values can be done. Routh criterion impose that all the coecients
must have the same sign for having a stable system. So Kd < 0 and Kp < a K1 The new
6

transfer function will be:

k1 (Kd s + Kp )
GK(s) = (3.10)
s2 a6
And in close loop
GK k1 (Kd s + Kp )
(s) = 2 (3.11)
1 + GK s k1 Kd s (a6 + k1 Kp )

Figure 3.5: Model with Kp and Kd

3.1.2 Finding the value of Kp and Kd


Now that the system is totally controllable, the necessary value of Kp and Kd to get
the desired performances can be found from the requirements:

1. 6db gain margin in low frequency (w 0)

2. 30 degrees phase margin at high frequency

From the rst specication

k1 (Kd jw + Kp )
GK(w) =
w2 a6
k1 Kp
GK(0) = = 2 (3.12)
a6
2a6
Kp =
k1

Enrique Gadea - Robust TVC Control 42


CHAPTER 3. CLASSICAL CONTROLLER

and from the second one


k1 (Kd jw + Kp )
GK(w) = = 1|150 = 0.866 j0.5 (3.13)
w2 a6
Equating real parts
k1 Kp = 0.866(w2 + a6 ) (3.14)
Introducing the above relation of Kp

w= 1.3a6 (3.15)

Now, equating imaginary parts

k1 Kd w = 0.5(w2 + a6 ) (3.16)

and replacing the value of w



a6
Kd = (3.17)
k1
The desired open-loop transfer and closed-loop function can now be written :

a6 s + 2a6
GK(s) =
s2 a6
(3.18)
GK a6 s + 2a6
(s) = 2
1 + GK s + a6 s a6

Bode G Step Response

10 2.5

0
Magnitude (dB)

10 2

20

30 1.5
Amplitude

40
0
1
Phase (deg)

45

0.5
90

135 0
1 0 1 2 0 1 2 3 4 5 6 7
10 10 10 10
Frequency (rad/sec) Time (sec)

(a) Bode plot (b) Step Response

GK
Figure 3.6: Bode and Step response for 1+GK

Enrique Gadea - Robust TVC Control 43


CHAPTER 3. CLASSICAL CONTROLLER

nichols plot

40
0 dB
30 0.25 dB
0.5 dB
20 1 dB 1 dB

OpenLoop Gain (dB)


10 3 dB
3 dB
6 dB

0 6 dB

10 12 dB

20 20 dB

30

40 dB
40
360 315 270 225 180 135 90 45 0
OpenLoop Phase (deg)

(a) Nichols plot

GK
Figure 3.7: Black plot for GK(S) Bode and Step response for 1+GK

Time variant parameters


Parameters a6 and k1 are time variant parameters like the inertia or the thrust. Their
evolution is plotted in gure 3.8.

3.5 0.2

3 0.18

0.16
2.5

0.14
2
A6

K1

0.12
1.5
0.1

1
0.08

0.5 0.06

0 0.04
10 20 30 40 50 60 70 80 90 10 20 30 40 50 60 70 80 90
time time

(a) a6 evolution (b) k1 evolution

Figure 3.8: Evolution of k1 and a6 as a function of time

A rst idea to solve the fact that parameter are not constant on time, rest in trying
to dene a controller for one point of the ight time domain (worst case point). Doing
that, the controller will be optimized for only one of all the ight domain points but if the
point has been chosen properly, the system could stay stable(this needs to be checked a
posteriori). Nevertheless, LV performance will change from one point to the other.
The transfer function is:
GK k1 (Kd s + Kp )
(s) = 2 (3.19)
1 + GK s K1 Kd s (a6 + k1 Kp )

Enrique Gadea - Robust TVC Control 44


CHAPTER 3. CLASSICAL CONTROLLER

So, frequency and damping are going to be respectively


k1 Kd
w= a6 k1 Kp = (3.20)
2a6
and are going to be time variant as well.

(a) Frequency evolution (b) Damping evolution

Figure 3.9: Evolution of W and as a function of time

In gure 3.9 the evolution of frequency and damping in time is plotted. Damping
starts in a very low level and starts to increase reaching the nominal and design value of
0.5 at 50s and then it decrease again. With these variations specications where a constant
damping value of 0.5 are not satised.

Evolution of Kp and Kd
In the analysis done before (3.1.2) Kp and Kd were written in function of parameters
a6 and k1 . That means that new values of Kp and Kd can be calculated for each slide of
time. Calculating again their values the performances achieved will not be modied, so
damping and phase margin will stay constant (see gure 3.10).

Damping stays constant but the frequency (being an a6 function) varies with time.
The prole for the W variation is plotted in gure 3.11.

The evolution of Kp and Kd can be deduced from the equations 3.12 and 3.17 and is
plotted in gure 3.12.

To end with, taking a look to the delay margin (gure 3.13) it can be inferred that the
critical point is near to the 50s (maximum dynamic pressure point).

Enrique Gadea - Robust TVC Control 45


CHAPTER 3. CLASSICAL CONTROLLER

2 81.7868

1.5
81.7868

Phase Margin [Degrees]


81.7868
0.5
Imag Part

0 81.7868

0.5
81.7868

81.7868
1.5

2 81.7868
1 0.9 0.8 0.7 0.6 0.5 0.4 0.3 10 20 30 40 50 60 70 80 90
Real Part time [s]

(a) Roots evolution (b) Phase Margin Evolution

Figure 3.10: Evolution of Phase Margin and Roots as a function of time

1.8

1.6
Frequency

1.4

1.2

0.8

10 20 30 40 50 60 70 80 90
time [s]

Figure 3.11: Frequency evolution

3.1.3 System Behaviour


It is possible then to guarantee stability with a xed PD controller but loosing the
desired performances unless a dynamical controller is implemented. However, there are
some drawbacks in this technique. First there are implementation aspects. To be able
to keep the desired goal of the linear designs, the design points must be relatively close
together. This means that a large of linear controllers must be implemented and in addi-
tion a scheme to prevent inactive controllers to drift away (bump-less transfer). Secondly,
the switching surfaces need to be checked for stability in a post analysis. Nevertheless,
main drawback of the interpolation scheme is that stability cannot be guaranteed even in
a neighbourhood of a design point.

Enrique Gadea - Robust TVC Control 46


CHAPTER 3. CLASSICAL CONTROLLER

0.1 0.05

0.2

0.1
0.3

0.4
0.15
0.5
Kp

Kd
0.6
0.2
0.7

0.8
0.25

0.9

1 0.3
10 20 30 40 50 60 70 80 90 10 20 30 40 50 60 70 80 90
time time

(a) Kp evolution (b) Kd evolution

Figure 3.12: Evolution of Kp and Kd as a function of time

1.3

1.2

1.1

1
Delay Margin [s]

0.9

0.8

0.7

0.6

0.5

0.4
10 20 30 40 50 60 70 80 90
time [s]

Figure 3.13: Delay Margin

Looking to gure 3.12 one can notice how Kp and Kd evolve and looking carefully to
the a6 time evolution (gure 3.8) the ight domain can be split in two slides: from 0s to
50s and from 50s to 100s. Maximum value of a6 is placed more or less for t=50s (point of
maximum dynamic pressure).

1. From t=0 to t=50s


In this slide, a6 increase its value and k1 decrease it. Taking back the condition for
stability we need:
a6
k1 Kp a6 > 0 Kp < (3.21)
k1
So it is normal that Kp increase its value in absolute value talking. For Kd we only

Enrique Gadea - Robust TVC Control 47


CHAPTER 3. CLASSICAL CONTROLLER

need to impose a 0.5 damping



1 1 k1 Kd w a6
= = Kd = Kd = (3.22)
2 2 2w K1 K1

2. From t=50s to t=100s


Now both parameters decrease but a6 goes faster than k1 so Kp and Kd also decrease
(in absolute value)

The following table contains all the dierent value of Kp and Kd that will be used in
time simulations for each couple of a6 and k1 value and the time slices done.

a6 k1 Kp Kd time
0.4087 5.9938 0.1364 0.1067 10-15
1.0817 6.1897 0.3495 0.1680 15-25
2.5896 5.4397 0.9501 0.2955 25-35
2.9521 5.9690 0.9892 0.2879 35-45
3.2297 7.0738 0.9132 0.2541 45-55
3.2119 8.4980 0.7559 0.2109 55-65
2.5692 10.4260 0.4928 0.1537 65-75
1.6461 12.2962 0.2677 0.1043 75-85
0.8255 15.0942 0.1094 0.0602 85-95

Enrique Gadea - Robust TVC Control 48


CHAPTER 3. CLASSICAL CONTROLLER

3.2 Complete Rigid Model


A PD controller can guarantee stability and performances in at least a basic two states
SISO model. However, this model was built assuming that there was no drift and no wind
so = but when introducing the drift and the wind = + Vz w where w is the
wind incidence, v is the LV velocity and z is the lateral drift speed.
To create the complete rigid model is then necessary to add at least a third state. One
choice is to add z as a new third state and w as a new input. Nozzle inertia and bending
modes still neglected. Due to this modication the equations of motion are rewritten as

= a6 k1
L T T D
z =
m m m (3.23)
z
= + w
V

The complete procedure to nd these equations is in annex A

Rewriting the EOM in a state space form which is more convenient for controller design
and analysis

0 1 0 0 0 [ ]
= a6 a6 w
0 V + a 6 k 1

z a1 0 a2 z a2 V a3

1 0 0 0 0 [ ]
= 0 1 0 + 0 0 w (3.24)

z 0 0 1 z 0 0
With
D
a1 = L +T
m a2 = L
mv
T L GA
a3 = m a6 = Iyy (3.25)
T CG
L = qSCN k1 = Iyy

For the time being the wind will not be considered. Wind will act like a perturbation in the
system. One of the advantages of robust control is to manage this kind of perturbations
and to keep the system stable. However, even if stability is guarantee some properties
can suer a big degradation like for example the angle of attack or the drift as it will
be shown. For this reason, the wind will be introduced again further in this study, when
making a drift control. The transfer function between ref and IM U can be deduced from
the space state model knowing the kind of feedback used u = (Kp + Kd s)(ref IM U ).
Hence transfer function in open-loop is:

(Kp + Kd s)(a3 av6 + a2 k1 + k1 s)


Hol (s) = (3.26)
s3 + a2 s2 a6 s + a1 av6 a2 a6

Enrique Gadea - Robust TVC Control 49


CHAPTER 3. CLASSICAL CONTROLLER

Figure 3.14: Rigid body model

And in closed-loop

(Kp + Kd s)(a3 av6 + a2 k1 + k1 s)


Hcl (s) =
s3 + B2 s2 + B1 s + B0
B2 = a2 k1 Kd
a6 (3.27)
B1 = k1 Kp a2 k1 Kd a6 a3 Kd
v
a6 a6
B0 = a1 a2 a6 a3 a2 k1 Kp
v v
It is important to know how the system reacts now that it has a new state. It is
also important to emphasize that for this study all the parameters are consider as time
invariant. Numerical values are taken from the maximum dynamic pressure moment.

Parameter Value
a6 3.2297
k1 7.0738
a1 37.87
a2 0.02737
a3 25.54
v 557
Kp -0.9132
Kd -0.2541

System behaviour is now dierent due to the new state introduced. Step performance
decrease and now the drift is also an important parameter. Bode shape is deformed due
to this new state introduction an so is the step response that is degraded but the system
still stable.

Eigenvalues Damping Freq(rad/s)


-8.40e-1+1.54i 4.79e-1 1.75
-8.40e-1-1.54i 4.79e-1 1.75
-1.44e-1 1 1.44e-1

Enrique Gadea - Robust TVC Control 50


CHAPTER 3. CLASSICAL CONTROLLER

Bode G Step Response

10 2.5

0
Magnitude (dB)

10 2

20

30 1.5

Amplitude
40
45
1
0
Phase (deg)

45
0.5

90

135 0
3 2 1 0 1 2 0 5 10 15 20 25 30 35 40
10 10 10 10 10 10
Frequency (rad/sec) Time (sec)

(a) Bode plot (b) Step Response

nichols plot

40
0 dB
30 0.25 dB
0.5 dB
20 1 dB 1 dB
OpenLoop Gain (dB)

10 3 dB
3 dB
6 dB

0 6 dB

10 12 dB

20 20 dB

30

40 dB
40
360 315 270 225 180 135 90 45 0
OpenLoop Phase (deg)

(c) Nichols plot

GK
Figure 3.15: Black plot for GK(S) and Bode and Step response for 1+GK

Number of States Gain Margin Phase Margin Delay Margin


2 6 db 30 0.2523
3 5.3634db 28.3123 0.2405

The overshoot is now more than a 100% of the reference value and the nal asymptotic
value is 0,7 (for a step of 1).

Adding the TVC actuator


Adding the TVC actuator into the model will add some roll-o and will reduce the
bandwidth. It is like a low-pass lter and the two poles introduced by the TVC are nat-
urally stable. Of course margins will decrease a bit due to the introduction of this new
element but it is important to add this term because it will be useful to compare this
results with the ones obtained with the robust control.

The system still stable and the new poles are:

Enrique Gadea - Robust TVC Control 51


CHAPTER 3. CLASSICAL CONTROLLER

Eigenvalues Damping Freq(rad/s)


-7.66e-1+1.65i 4.21e-1 1.82
-7.66e-1-1.65i 4.21e-1 1.82
-1.43e-1 1 1.43e-1
-4.34e+1 1 4.34e+1
-5.76e+1 1 5.76e+1
Because of the introduction of the actuator the system cross twice the line of -180
having two gain margins (one in low frequency and another one in high frequency).

Bode Diagram Step Response

100 2.5

0
Magnitude (dB)

2
100

200
1.5
Amplitude
300
90
1
0
Phase (deg)

90

0.5
180

270

360 0
2 0 2 4 0 10 20 30 40 50 60
10 10 10 10
Frequency (rad/sec) Time (sec)

(a) Bode plot (b) Step Response

Nichols Chart

20

20
OpenLoop Gain (dB)

40

60

80

100

120

140
360 315 270 225 180 135 90
OpenLoop Phase (deg)

(c) Nichols plot

GK
Figure 3.16: Black plot for GK(S) and Bode and Step response for 1+GK

Number of States Gain Margin LF Gain Margin HF Phase Margin Delay Margin
3 5.2641db 33.8503db 23.7623 0.2025

Adding the wind input


The introduction of a new input w will introduce some variations and performances
will decrease again but it is important to quantify the wind impact in each output. The

Enrique Gadea - Robust TVC Control 52


CHAPTER 3. CLASSICAL CONTROLLER

transfer function between this new input and IM U has the same denominator (same poles)
but will present a dierent numerator.

Step Response

0.002

0.004

0.006

0.008
Amplitude

0.01

0.012

0.014

0.016

0.018

0.02
0 20 40 60 80 100 120
Time (sec)

Figure 3.17: Theta response for a Step in w

The transfer function is :


a6 s
Hcl (s) =
s3
+ (B2 )s2 + (B1 )s + B0
B2 = a2 k1 Kd
a6 (3.28)
B1 = k1 Kp a2 k1 Kd a6 a3 Kd
v
a6 a6
B0 = a1 a2 a6 a3 a2 k1 Kp
v v
Because the two inputs w and ref are going to be at the same time is also important
to see what is the eect that the wind by itself and together with ref has in the system
response.

600 0

0.002
500
0.004

0.006
400
0.008

300 0.01

0.012
200
0.014

0.016
100
0.018

0 0.02
0 10 20 30 40 50 0 10 20 30 40 50

(a) IM U (b) z

Figure 3.18: Step response with w = 0.03 and ref = 0 as input

Enrique Gadea - Robust TVC Control 53


CHAPTER 3. CLASSICAL CONTROLLER

0.09 10

0.08 0

0.07 10

0.06 20

0.05 30

0.04 40

0.03 50

0.02 60

0.01 70

0 80
0 10 20 30 40 50 0 10 20 30 40 50

(a) IM U (b) z

Figure 3.19: Step response with w = 0.03 and ref = 0.08 as input

As it has been proven, only with a PD controller the system remains stable even with
the introduction of the drift and the wind input. However, despite tracking in can
also be guarantee and margins are satised there are others requirements that cannot be
controlled only with a PD controller. This control is a requirement in order to reduce the
load suered by the launcher, so having a small angle of attack (less than 3). To satisfy
all the requirements is then necessary to introduce a new feedback, capable to control the
drift or the drift speed. It is true that has an impact on the angle of attack but it can
not be managed only by a feedback. It is not possible to keep a desired value while
trying to put it at the same time near to zero to minimise the angle of attack. That is
why it is necessary to introduce another feedback. There are some dierent options as
new feedback.

1.- feedback 3.- z feedback


2.- z feedback 4.- z + z feedback

However, for a better understanding of the new feedback eect the PD controller will
be the same all the time, i.e it will not be tuned again.

3.2.1 feedback
Adding a proportional term on to the PD controller, the feedback will look like

u = (Kd s + Kp ) (ref IM U ) + K (3.29)


If we break down alpha it is easier to understand the eect that it has in the system. As
it was said before is composed by three terms: , z and w . This feedback will allow to
take into account these three parameters that directly aect the angle of attack so it will
be possible to control the angle of attack and the lateral drift in a such way.It is important
to remark that the angle of attack is not one thing that can be measured directly. It needs
to be built but to do that, one has to estimate the value of the wind incidence or speed
which is quite uncertain. In addition it is important to remark the fact that when tuning
K , is aected also and depending on the K value the system can be destabilized.

Enrique Gadea - Robust TVC Control 54


CHAPTER 3. CLASSICAL CONTROLLER

Because it exists a possibility of making the system unstable, there is a boundary on the
maximum value that K can have.

Root Locus Editor for Open Loop 1 (OL1) Root Locus Editor for Open Loop 1 (OL1)
2

150

1.5

100
1

50
0.5
Imag Axis

Imag Axis
0 0

50 0.5

1
100

1.5
150

300 250 200 150 100 50 0 0.9 0.8 0.7 0.6 0.5 0.4 0.3 0.2 0.1 0 0.1
Real Axis Real Axis

(a) K > 0 (b) K > 0 zoom


Root Locus Editor for Open Loop 1 (OL1)

1.5

0.5
Imag Axis

0.5

1.5
1 0.8 0.6 0.4 0.2 0 0.2 0.4 0.6 0.8 1
Real Axis

(c) K < 0

Figure 3.20: Root locus depending on parameter K

Picture 3.20 shows how, while K varies, the system sends two poles to the right hand
side becoming unstable. The two complex poles that are mainly controlled are those as-
sociated with the rotary motion of the vehicle about its center of gravity.

Enrique Gadea - Robust TVC Control 55


CHAPTER 3. CLASSICAL CONTROLLER

The dierent transfer function of IM U , z and with ref as input are:

IM U (Kp + Kd s)( a3va6 + a2 k1 + k1 s)


=
ref s3 + D2 s2 + D1 s + D0
(Kp + Kd s) ( av3 s2 + k1 s a1vk1 + a2 k1 )
=
ref s3 + D2 s2 + D1 s + D0
z (Kp + Kd s)(a3 s2 + a3 a6 + a1 k1 )
= (3.30)
ref s3 + D2 s2 + D1 s + D0
a3
D2 = a2 k1 Kd + K
V
a3 a6
D1 = (Kp + a2 Kd )k1 a6 Kd + k1 K
V
a1 a6 a3 a6 a1 k1
D0 = a2 a6 Kp a2 k1 Kp + (k1 a2 )K
V v V

1.4 4.5

4
1.2

3.5
1
3

0.8 2.5

0.6 2

1.5
0.4
1

0.2
0.5

0 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) Alpha response with K = 0, 5 (b) Alpha response with K = 0, 3

Figure 3.21: Alpha response for a step with dierent gain feedback

Making K more negative causes an increase in the overshoot in the alpha response
as well as a reduction of the nal value. However, without introducing any wind into the
system, alpha response is very similar to theta so theta will also present an increase in
the overshoot and a reduction of the nal value increasing the tracking error. There is a
compromise between keeping the tracking or reducing alpha nal value. A reduction in
the drift will also appear but the drift cannot be reduced without limits because drift re-
ductions needs reducing K value but getting K to negative values will cause the system
to be unstable. So there is an important limitation for drift reduction.

On the other hand, having a positive value of K produce an increase on the drift be-
cause drift rate pole is getting slower. This feedback acts more in the drift instead of acting
in . It can be interesting if the drift level is not very high and the system can aord an
increase in the drift to get a reduction in the angle of attack and without modifying a lot .

Enrique Gadea - Robust TVC Control 56


CHAPTER 3. CLASSICAL CONTROLLER

4 4
x 10 x 10
0.5 0.5

0 0

0.5
0.5

1
1
1.5
1.5
2

2
2.5

3 2.5

3.5 3
0 10 20 30 40 50 0 10 20 30 40 50

(a) Alpha response with K = 4 (b) Alpha response with K = 12

Figure 3.22: Alpha response for a step with dierent gain feedback

Wind input
Wind will have a direct impact on alpha as it can be checked in its equation. But wind
not only aects alpha, it also aects and z so it is important to quantify the impact that
it can have on the system.

The transfer functions between , , , z and w can be deduced from equations 3.23
and 3.29.
s(s2 + k1 Kd s + k1 Kp
= 3
w s + D2 s2 + D1 s + D0
s(k1 K a6 )
= 3 (3.31)
w s + D2 s2 + D1 s + D0
a3 Kp
z
a3 2
v s + ( a3vKd )(a6 + k1 aa23v )s + ( a2 v
v )(a6 + k1 a3 ) + (a2 a1
v )(k1 K a6 )
=
w s3 + D2 s2 + D1 s + D0
Applying the nal value theorem f () = limx0 f (S) one can see that the function
rejects the eect introduced by the wind in at least and .
To sum up, using realistic inputs in ref and in the wind input (ref = 0.08rad and
wind
U = 0.03) and making a feedback in will lead to maximum drift and angle of attack
reduction of around 14% but will be degraded a 17%.

Time simulations can be found in annex D

3.2.2 z feedback
Making a feedback on z will introduce a new state in the system because it is necessary
to integrate z. The main purpose of this feedback is to control the drift but manoeuvra-
bility is very low. By introducing this new state the system is very close to instability.
Figure 3.23 shows that Kz needs to be positive and less than a very small value.

Enrique Gadea - Robust TVC Control 57


CHAPTER 3. CLASSICAL CONTROLLER

Root Locus Editor for Open Loop 1 (OL1) Root Locus Editor for Open Loop 1 (OL1)

2 4

1.5 3

1
2

0.5
1
Imag Axis

Imag Axis
0
0

0.5

1
1

2
1.5

2 3

2.5 4
5 4 3 2 1 0 1 2 3 4 5 3 2 1 0 1 2 3 4
Real Axis Real Axis

(a) Kz < 0 (b) Kz > 0 zoom

Figure 3.23: Root Locus plot

The transfer functions from ref to each output are:

IM U s(Kp + Kd s)( a3va6 + a2 k1 + k1 s)


=
ref s4 + D3 s3 + D2 s2 + D1 s + D0
s(Kp + Kd s) ( av3 s2 + k1 s a1vk1 + a2 k1 )
=
ref s4 + D3 s3 + D2 s2 + D1 s + D0
z s(Kp + Kd s)(a3 s2 + a3 a6 + a1 k1 )
=
ref s4 + D3 s3 + D2 s2 + D1 s + D0 (3.32)
D3 = a2 k1 Kd
a3 a6
D2 = (Kp + a2 Kd )k1 a6 Kd + a3 Kz
V
a1 a6 a3 a6
D1 = a2 a6 Kp a2 k1 Kp
V v
D0 = (a3 a6 k1 a1 )Kz

Margin is very small and when trying to obtain any improvement before feeling the
eects the system oscillates a lot. This feedback has a direct impact on the drift but
manoeuvrability is very very poor making this feedback not very interesting. Figure 3.24
shows how the system oscillates and how drift is very reduced also. This reduction is very
important but without having a more damped system, a feedback which time necessary
for stabilisation is near the 100 seconds cannot be used for a system where the time live
is about 120 seconds.

In addition zeros of the closed loop are not always stable. Their value depend on Kp ,
Kd , a2 and a6 value and there are some realistic combinations that can make a zero appear
on the right hand side.Due to the unstable zero the system will follow the command by
going into the opposite direction rst.

Enrique Gadea - Robust TVC Control 58


CHAPTER 3. CLASSICAL CONTROLLER

2.5 200

2 0

200
1.5

400
1
600
0.5
800
0
1000

0.5
1200

1 1400

1.5 1600
0 20 40 60 80 100 0 20 40 60 80 100

(a) response (b) drift

Figure 3.24: and drift response for a ref = 0.08

1.5

0.5

0.5

1
0 20 40 60 80 100

Figure 3.25: Theta response for a Step in w

3.2.3 z feedback
Having feedback directly on the drift is not a good option so the derivative is possibly
a better solution. Making a feedback on z will not introduce a new state and will allow us
to avoid the constant oscillatory behaviour of the z feedback. The new feedback will then
be: u = (Kp + Kd ) (ref IM U ) + Kz z

In picture 3.26 we can see how the closed loop poles evolve depending on Kz value The

Enrique Gadea - Robust TVC Control 59


CHAPTER 3. CLASSICAL CONTROLLER

Root Locus Editor for Open Loop 1 (OL1) Root Locus Editor for Open Loop 1 (OL1)

2.5 3

2
1.5

1 1
Imag Axis

Imag Axis
0.5
0
0

0.5 1

1
2

1.5

3
2

6 5 4 3 2 1 0 1 2 3 4 6 4 2 0 2 4 6 8 10 12
Real Axis Real Axis

(a) Kz > 0 (b) Kz < 0

Figure 3.26: Root Locus

transfer functions from ref to the dierent outputs are:

IM U (Kp + Kd s)( a3va6 + a2 k1 + k1 s)


=
ref s3 + D2 s2 + D1 s + D0
(Kp + Kd s) ( av3 s2 + k1 s a1vk1 + a2 k1 )
=
ref s3 + D2 s2 + D1 s + D0
z (Kp + Kd s)(a3 s2 + a3 a6 + a1 k1 )
= (3.33)
ref s3 + D2 s2 + D1 s + D0
D2 = a2 k1 Kd + a3 Kz
a3 a6
D1 = (Kp + a2 Kd )k1 a6 Kd
V
a1 a6 a3 a6
D0 = a2 a6 Kp a2 k1 Kp + (a3 a6 k1 a1 )Kz
V V
Like with alpha feedback having a positive Kz value will only produce and increase
on drift and the system will reach instability very fast. The only option then is having a
negative feedback in Kz . By doing this, drift will be reduced but it exists an upper limit
before the system reach instability.

By adding this feedback, the impact in IM U from ref will be huge and a very im-
portant reduction from the nominal value will appear. Increasing Kz will decrease the
overshoot but also the nal value making the error bigger and will also introduce more
oscillations at the beginning.

This feedback presents the advantage of making and important reduction on the drift

Wind input
In spite of alpha feedback eects, now the wind eect is not completely rejected from
the system and there is an unstable zero from the wind input to the IM U output doing

Enrique Gadea - Robust TVC Control 60


CHAPTER 3. CLASSICAL CONTROLLER

2 2.5

1.5 2

1 1.5

0.5 1

0 0.5

0.5 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) Kz = 0.005 (b) Kz=0.001

Figure 3.27: Theta response for dierent Kz values

that the systems starts going in the opposite direction

0.6

0.4

0.2

0.2

0.4

0.6

0.8
0 10 20 30 40 50

Figure 3.28: Theta response

The transfer functions from the wind input to the dierent outputs are:
Using this feedback having as input a combination of ref and wind makes a reduction
of about 58% in IM U value and 77% in drift.

3.2.4 z + z feedback
This new double feedback is a mix of the last two feedbacks seen. The feedback law
will be:
u = (Kp + Kd s) (ref IM U ) + Kz z + Kz z

Enrique Gadea - Robust TVC Control 61


CHAPTER 3. CLASSICAL CONTROLLER

The z feedback had drift reduction limited and the drift feedback, even having better
results in drift minimization, was not feasible due to the oscillatory behaviour of the
system. However, mixing both feedback it is possible to have a bigger drift reduction than
with the z feedback by itself and without so many oscillations like with the z feedback
The transfer functions between ref and IM U , and z are:

IM U s(Kp + Kd s)( a3va6 + a2 k1 + k1 s)


=
ref s4 + D3 s3 + D2 s2 + D1 s + D0
s(Kp + Kd s) ( av3 s2 + k1 s a1vk1 + a2 k1 )
=
ref s4 + D3 s3 + D2 s2 + D1 s + D0
z s(Kp + Kd s)(a3 s2 + a3 a6 + a1 k1 )
=
ref s4 + D3 s3 + D2 s2 + D1 s + D0 (3.34)
D3 = a2 k1 Kd + a3 Kz
a3 a6
D2 = (Kp + a2 Kd )k1 a6 Kd + a3 Kz
V
a1 a6 a3 a6
D1 = a2 a6 Kp a2 k1 Kp + (a3 a6 k1 a1 )Kz
V v
D0 = (a3 a6 k1 a1 )Kz

This feedback will keep the non unstable zero from the wind to IM U One can see the
eect of adding both feedbacks keeping the numerical value of Kz used in the previous
section and looking to the modications produced by Kz

Using the same case which includes the combinations of ref and the wind input, drift
is reduced by a 99% but error between IM U and ref is about the 71% of the reference
signal.

3.2.5 Summary
After taking a look to the dierent possible feedbacks the two more interesting are the
angle of attack feedback because of the possibility of having some drift reduction without
loosing too much in tracking and Z + Z because of the drift minimization it can oer.
The objective of this point was not to achieve an optimal conguration with the optimized
coecient for the dierent feedbacks. The objective was to show the impact that feedback
has in the system, how drift can be minimized and what can be expected for each dierent
feedback. This will be used further when a drift control will be implemented in the robust
design. Using the results obtained in this preliminary study one can have a rst idea of
how much drift can be reduced and what the consequences are.
As a conclusion the table below contains the numerical values of a time simulation for
each dierent feedback. All the plots are in annex D

Enrique Gadea - Robust TVC Control 62


CHAPTER 3. CLASSICAL CONTROLLER

Feedback
Variable
Nominal Alpha Z Z + Z
K K = 0.3 KZ = 0.005 KZ = 0.005 KZ = 0.00304

0.057 0.047 0.024 0.016


Z -1740 -1500 -397 -17
Z -41 -32 -8.29 -4.64e-5
-0.047 0.039 -0.02 -0.01

3.3 Flexible Launch Vehicle Dynamics


The model of the rigid launcher is typically important for preliminary studies, but for
accurate simulations and controller analysis/design purposes, the exibility of the launch
vehicle must be considered.

The exibility of the LV presents some control problems primarily because the sensing
instrumentation (gyros and accelerometers) pick up not only the rigid body motion but also
the local elastic distortion. Because the vehicle is a continuous body the elastic motion
is described by a system with (theoretically) an innite number of degrees of freedom
(the bending modes).In practice, either a truncation of the innite series or a lumped
mass model is used to yield a system with a nite number of modes. The number of
modes that are signicant in a given situation depends on the bandwidth of the primary
bending modes. The high frequency attenuation properties due to the inherent structural
damping, are sucient to dismiss the higher modes from further consideration. In the
current generation of LV, ve elastic modes are usually sucient to describe the signicant
dynamic properties of the vehicle. Often no more than three modes are needed. This is
the case for our study case.

Equations in a state space form


The state vector including N bending modes is x = [, , z, q1 , q1 , ..., qN , qN ]T , thus
from the 1.15

0 1 0 0 0 0 0
a6 0 a6 k1 [ ]
0 aU6 0 U w
z = a1 0 a2 0 0 z + a2 a
3
qi 0 0 0 0 1 qi 0 0
qi 0 0 0 i 2i i
2
qi 0 T i (C )
(3.35)

1
1 0 1
0 0 0 [ ]
U U w
zimu = 0 GU 1 0
i (imu ) z + 0 0
qi
imu 1 0 0 i (imu ) 0 0 0
qi

Enrique Gadea - Robust TVC Control 63


CHAPTER 3. CLASSICAL CONTROLLER

Dening the bending state xf = [q1 , q1 , ..., qN , qN ]T and the matrices:


( ) ( )
0 1 0
Afi = Bf ri =
i2 2i i T i (C )
( )
0 0 ( )
Cf p i = Cf ci = i (imu ) 0
0 i (imu )
(3.36)
Af1 0 0 Bf r1
.
Af = 0 . . . 0 Bf r = ..
0 0 AfN Bf rN
( ) ( )
Cf p = Cf p1 . . . Cf pN Cf c = Cf c 1 . . . Cf cN

the equation 3.35 can be rewritten in a more compact form:


[ ] ( )[ ] ( ) ( )
xr Ar 0 xr Brw Br
= + w+
xf 0 Af xf 0 Bf r
( ) (3.37)
yp = Crp Cf p x + Drp w
( )
yc = Crc Cf c

In the equations 3.35 the contributions of nozzle inertia are neglected.

3.3.1 Bending modes impact


The appearance of the bending modes could then lead the system to be unstable.
Adding two bending modes to the rigid model dened before makes the system unstable.
Nichols plot of G and GK are plotted in gure 3.30

12
x 10
10

8
0 0.5 1 1.5 2 2.5 3

Figure 3.29: Step Model

To solve this problem it is very usual to dene a notch or a low-pass lter, to lter the
bending modes eect and return the system to a rigid body behaviour. Shapes of typical

Enrique Gadea - Robust TVC Control 64


CHAPTER 3. CLASSICAL CONTROLLER

Nichols Chart Nichols Chart

40 60
0 dB Gtotal
0.25 dB K*Gtotal
0.5 dB 40
20 1 dB 1 dB 0 dB
0.25 dB
3 dB 0.5 dB
6 dB 3 dB
20 1 dB 1 dB
0 6 dB
3 dB
OpenLoop Gain (dB)

OpenLoop Gain (dB)


6 dB 3 dB
12 dB
0 6 dB
20 20 dB 12 dB

20 20 dB

40 40 dB
40 40 dB

60 60 dB
60 60 dB

80 80 dB
80 80 dB

100 dB 100 dB
100 100
180 90 0 90 180 360 270 180 90 0 90 180
OpenLoop Phase (deg) OpenLoop Phase (deg)

(a) Black G(s) (b) Black GK(s)

Figure 3.30: Black plot of G(s) and GK(s)

used lters are plotted in gure 3.31. Knowing the shape it is easy to dene a good lter
based in some background that the designer could have.

Bode Diagram Bode Diagram

0
0

20
10
Magnitude (dB)

Magnitude (dB)

40

60
20
80

100
30
120

140 40
90 0

45
Phase (deg)

Phase (deg)

0 45

45

90 90
2 0 1 2 3 4
10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Notch filter (b) Low pass filter

GK
Figure 3.31: Black plot for GK(S) and Bode and Step response for 1+GK

However this time it is not necessary to design any specic lter. The WT V C actuator,
being a second order with a static gain of one, has the same behaviour than a low-pass
lter and will act as it stabilising the system. So adding the actuator in the loop the
system will be stable again and margins will be:

Gain Margin LF Gain Margin HF Phase Margin Delay Margin


5.1833 db 16.3438 db 23.18 0.2014

The bode plot shows the resonance due to the presence of the bending modes. In a
nal design it is necessary to roll-o this pic making that the rst exible modes have not
a gain over -3db. This constraint is avoided because this is only a preliminary study and
it is going to be used as comparison to the exible modes. But it is important to take it
into account in the nal design.

Enrique Gadea - Robust TVC Control 65


CHAPTER 3. CLASSICAL CONTROLLER

Step Response Bode Diagram

2.5 50

Magnitude (dB)
50
2
100

150
1.5
Amplitude

200

250
90
1
0

Phase (deg)
90

180
0.5
270

360

0 450
0 5 10 15 20 25 30 35 2 0 2 4
10 10 10 10
Time (sec) Frequency (rad/sec)

(a) Step Response having PD controller (b) Step Response having only PD con-
+alpha as feedback troller

Figure 3.32: Step Response and close loop Bode plot

To check the system behaviour a simple Simulink model was created an some time
simulations were done. In this time simulations, input is always a step and parameters are
time invariant, being the numerical values of the maximum dynamic pressure. Further,
when the robust control will be introduced, a non-linear time simulator will be used.
However, because this is just a way to see how the system reacts it is not necessary to use
the non-linear simulator. All the results from the time simulations are in annex D

Enrique Gadea - Robust TVC Control 66


Chapter 4

Robust Control

4.1 Uncertainty Modelling


Launch Vehicles have some time variant parameters that make the controller design
harder. It is necessary to check if the controller can keep stability and performances in all
the time domain and even if stability is possible, performances will suer a big decrease.
One solution, mentioned before, is the gain scheduling technique. Using this technique,
some parameters are constant in some time slides increasing then the model precision.
However, parameters are varying constantly and are not ever well known. As it was
shown in chapter 3 knowing the variation of a6 and k1 it is possible to keep the desired
performances given the fact that values of Kp and Kd are adapted to those variations but
a6 and k1 are not always well known.

Uncertainties or perturbations are going to modify in a random but bounded way the
value of some parameters. Adding some uncertainties in the model will better approximate
the real system behaviour. A block-diagonal containing all the possible perturbations or
uncertainties can be dene as the () block:
( )
a6 0
=
0 k1

4.1.1 Kp and Kd as a function of a6


Taking back the equation 3.18 the closed loop transfer is expressed as a function of
a6 only. That means that the value of the controller can be obtained as an expression of
a6 . Just as complementary information boundaries for Kp and Kd are plotted in gure 4.1.

4.1.2 Using the PD controller defined by slides


Using the PD controller dened in section 3.1.2 it is possible to dene some boundaries
that will indicate the limits of the system performance. This time, damping is not going
to be longer constant but it will vary between the two boundaries found. Figure 4.2 shows

67
CHAPTER 4. ROBUST CONTROL

Kp envelop Kd envelop
0 0
nominal nominal
boundary boundary
0.2 0.05

0.1
0.4

0.15
0.6
0.2
0.8
0.25

1
0.3

1.2 0.35

1.4 0.4
0 10 20 30 40 50 60 70 80 90 0 10 20 30 40 50 60 70 80 90

(a) Kp evolution (b) Kd evolution

Figure 4.1: Evolution and boundaries of Kp and Kd on time

all the dierent boundaries for each parameter.

4 20
nominal nominal
boundary boundary
3.5 18

3 16

2.5 14

2 12

1.5 10

1 8

0.5 6

0 4
0 20 40 60 80 100 0 20 40 60 80 100

(a) A6 evolution (b) K1 evolution

Figure 4.2: Evolution and boundaries of A6 ,W and k1 as a function of time

Looking to the roots position (Real part vs Imaginary part) like in gure 4.3 one can
notice that poles are no longer in the same damping line.

Furthermore margins change a lot depending in the uncertainty. In gure 4.4 three
possible congurations are plotted in a Nyquist plot with their gain and phase margins.

So, PD controller gives good results but without a robust response (The system can-
not aord all the uncertainties dened). All the performances needs to be checked at each
points because there is no guarantee at all. That is why robust control is interesting. The
only design of a robust controller will guarantee stability and will give a reference of how
well all the performances required are satisfy ( value). In addition in a robust design it
is possible to dene the desired shape at some points and the uncertainty level.

Enrique Gadea - Robust TVC Control 68


CHAPTER 4. ROBUST CONTROL

2.5

1.5

0.5

Imag Part
0

0.5

1.5

2.5
1.1 1 0.9 0.8 0.7 0.6 0.5 0.4 0.3 0.2
Real Part

Figure 4.3: Root Locus

Nyquist Diagram

0.6

0.4

0.2
Imaginary Axis

0.2

0.4

0.6

3.5 3 2.5 2 1.5 1 0.5 0 0.5


Real Axis

Figure 4.4: Nyquist

4.2 Building a new synthesis model


With the introduction of robustness a new synthesis model is required. Now it is
important to dene and to make a dierence between the control and the measurement
outputs as well as between the reference and noise inputs. Using the same procedure than
in the previous chapter, a rigid body controller is rst design and after bending modes
and drift minimization is taken into account. The rigid body used keeps the three states
dened but will have some uncertainties. The TVC actuation system will also be included
to increase the realism of the model.
The wind input will not be considered for the design at the beginning but will be taken
into account for the drift control, where wind has a real and more important role.

The new system will look like the one in gure 4.5. The elements of this new system
are:

Enrique Gadea - Robust TVC Control 69


CHAPTER 4. ROBUST CONTROL

Figure 4.5: Root Locus

The plant G modelled with two uncertainties. One in a6 and another one in k1

0 1 0 0 [ ]
= a6 0 a6
+ k1
V
z a1 0 a2 z a3


[ ] 0
= 1 0 0 [ ]
+ 0 (4.1)
1 0 1/v
z z 0

TVC actuation system with an uncertainty in frequency

et1
WT V C = (4.2)
12 wtvcwtvc2
with wtvc having a 15% of uncertainty

Wi Weighting functions
0.15s + 1.5
W1 =
s + 0.01

2 a6 + 100 1s2 + a6 + a6
W2 = 2
a6 a6 s + (2 a6 + 100 a6 )s + 2 a6 + 100
W3 = 0.7 (4.3)
s + 200
Walpha = 3.4
s + 1000
Wext = 0.5
Wnoise = 0.01

4.2.1 Weighting Functions


The weighting functions will allow to introduce the desired behaviour of the system.For
example W1 and W2 will control the shape of the tracking and the closed loop behaviour,

Enrique Gadea - Robust TVC Control 70


CHAPTER 4. ROBUST CONTROL

being the inverse of the sensitivity function S and the complementary sensitivity T. All
this functions reects then how the desired system should be in order to dene a controller
which will satisfy all this requirements.

However, to dene the weighting functions is necessary to know how the system should
be, what kind of shape should it have. Thanks to the analysis done with a classical
controller all this shapes are known.

W1

This function is used to weight the tracking error (ref IM U ). It has to satisfy:

W1 S inf

The nal value theorem impose S(0)=0 to avoid the position error. So S needs a
high reduction of the norm | S(jw) | at low frequencies. Hence W1 , being the inverse
of S, will have high gain at low frequencies having a high-pass lter shape.

W2

A big decrease of the norm | T (jw) | at high frequencies is important to reduce the
impact of the noise in the output and to avoid having big changes in the command.
A high agitation of it can saturate the actuator producing a non-linear behaviour
than can destabilise the loop. Being W2 the inverse of T, a low-pass lter shape is
desired.
In addition in the study done for the classical controller ( chapter 3) the behaviour of
the closed-loop is known and so is the function W2 . One can just invert the transfer
function of 1 + GK adding a high frequency pole and adjusting the gain to have a
realizable function

W3

To avoid having huge command values, a constant boundary was dened. Another
possible options was to dene a high-pass lter in order to have a low-pass lter
response in the command.

Walpha

Same as W2 thanks to the previous studies and looking to the desired behaviour of
alpha a denition of the weighting functions is very easy. The shape will be similar
to the one of W2

Wext

This functions bound an external perturbation coming before the going into the
plant, in this case, into the TVC actuator.

Enrique Gadea - Robust TVC Control 71


CHAPTER 4. ROBUST CONTROL

Wnoise

This function bound the noise added to the measurements done.

Figure 4.6 shows some possible shapes for the dierent weighting functions.

Bode Diagram W2

60 30

20
40
Magnitude (dB)

Magnitude (dB)
10
20
0

0
10

20 20
0 90
Phase (deg)

Phase (deg)
45

45

90 45
4 3 2 1 0 1 2 3 2 1 0 1 2 3 4
10 10 10 10 10 10 10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) W1 (b) W2

W3 Walpha

2 30

2.5
Magnitude (dB)

Magnitude (dB)

35
3

3.5
40

4.5 45
1 0

0.5
Phase (deg)

Phase (deg)

0 30

0.5

1 60
0 1 1 2 3 4 5
10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(c) W3 (d) Walpha

Figure 4.6: W-functions

Parameters are time variant, hence some Wfunctions like W2 must also be time variant.
Because W2 adjust the closed loop behaviour it is important that it adjusts with time.
For that reason its design is based in a function of parameter a6 . In fact W2 reects the
ideal/desired shape of the closed loop. This was dened when the classical controller was
introduced (see section 3.1.2)

Enrique Gadea - Robust TVC Control 72


CHAPTER 4. ROBUST CONTROL

Wext Wnoise

5 39

5.5
39.5
Magnitude (dB)

Magnitude (dB)
6
40
6.5

40.5
7

7.5 41
1 1

0.5 0.5
Phase (deg)

Phase (deg)
0 0

0.5 0.5

1 1
0 1 0 1
10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Wext (b) Wnoise

Figure 4.7: W-functions

4.3 Robustness Analysis


A control system is robust if it is insensitive to dierences between the actual system
and the model of the system which was used to design the controller. These dierences are
referred to some model/plant dierences or simply model uncertainty. The key idea then,
in the robust control paradigm, is to check whether the design specications are satised
even for the worst case uncertainty. The approach is then as follows:
1. Determine the uncertainty set: nd a mathematical representation of the model
uncertainty.

2. Check for RS: determine whether the closed-loop system remains stable for all plants
in the uncertainty set.

3. Check for RP: if RS is satised, determine whether the performance specications


are met for all plants in the uncertainty set.
The mathematical representations of the model including the uncertainties is in gure
4.8 in which the uncertain perturbations are in the block diagonal matrix,

1
..
.
= diag{i } =
i

..
.

where each i represents a specic source of uncertainty.


The P and K transfer function appearing in 4.8 have the following state space descrip-
tion:
A B B1 B2 [ ]
C D D1 D2 A B
P = C1 D1 D11 D12 ,
K= K K
(4.4)
CK DK
C2 D2 D21 D22

Enrique Gadea - Robust TVC Control 73


CHAPTER 4. ROBUST CONTROL

Figure 4.8: LFT Model

If the controller is absorbed into the loop we will end up with the so called N
structure shown in 4.9. The N transfer function appearing in 4.9 has the following state

Figure 4.9: N-structure

space description:
A B B1
N = C D D1 (4.5)
C1 D1 D11

Enrique Gadea - Robust TVC Control 74


CHAPTER 4. ROBUST CONTROL

where now the matrices appearing in 4.5 have the following meaning
( )
A + B2 DK (I D22 DK )1 C2 B2 CK + B2 DK (I D22 DK )1 D22 CK
A=
BK (I D22 DK )1 C2 AK + BK (I D22 DK )1 D22 CK

( )
B + B2 DK (I D22 DK )1 D2
B =
BK (I D22 DK )1 D2

( )
B1 + B2 DK (I D22 DK )1 D21
B1 =
BK (I D22 DK )1 D21

( )
C = C + D2 DK (I D22 DK )1 C2 D2 CK + D2 DK (I D22 DK )1 D22 CK

( )
D = D + D2 DK (I D22 DK )1 D2

( )
D1 = D1 + D2 DK (I D22 DK )1 D21

( )
C1 = C1 + D12 DK (I D22 DK )1 C2 D12 CK + D12 DK (I D22 DK )1 D22 CK

( )
D1 = D1 + D12 DK (I D22 DK )1 D2

( )
D11 = D11 + D12 DK (I D22 DK )1 D21

(4.6)
In order to analyse the robust stability of the whole uncertain model, we only need
to consider the M -structure of 4.10 where M = N11 is the transfer function from the
output to the input of the perturbations. If the nominal ( = 0) feedback system is stable

Figure 4.10: M- structure

then the stability of the system in 4.9 is equivalent to stability of the system in 4.10, where

Enrique Gadea - Robust TVC Control 75


CHAPTER 4. ROBUST CONTROL

= 0 and
M (s) = D + C (sI A )1 B
where A , B , C and D are state space representation matrices of the subsystem N11
mentioned above. We now apply the Nyquist generalized stability condition to the system
in 4.10. We assume that and M are stable; the former implies that the nominal and
the uncertain open-loop transfer function must have the same unstable poles, the latter is
equivalent to assuming nominal stability of the closed-loop system.

4.3.1 Robust Stability And Performance


Theorem 1 Determinant stability condition (real or complex perturbations)
Assume that the nominal system M (s) and the perturbations (s) are stable. Consider
the convex set of perturbations , such that if is an allowed perturbation then so is c
where c is any real scalar such that |c| < 1. Then the M -system in 4.10 is stable for all
allowed perturbations (we have RS) if and only if:

Nyquist plot of det(I M (s)) does not encircle the origin,


det(I M (s)) = 0, , (4.7)
i (M ) = 1, i, ,

The following theorem guarantees robust stability for an unstructured uncertainty,


where (s) is allowed to be any (full) complex transfer function matrix satisfying
1.
Theorem 2 RS for unstructured (full) perturbations.) Assume that the nominal
system M (s) is stable and the perturbations (s) are stable. Then the M -system in 4.10
is stable for all perturbations satisfying 1 (we have RS) if and only if:

(M (j)) < 1 M < 1 (4.8)

A function useful to investigate the robust stability is the structured singular value (de-
noted Mu, mu, SSV or ), which provides a generalization of the singular value .
Let M be a given complex matrix and let = diag{i } denote a set of complex
matrices with () 1 and with a given block-diagonal structure (in which some of the
blocks may be repeated and some may be restricted to be real). The real non-negative
function (M ), called the structured singular value, is dened by
1
(M ) , (4.9)
min{km | det(I km M ) = 0 for structured , () 1}
If no such structured exists then (M ) = 0.The following Theorem provide a necessary
and sucient condition for robust stability with structured uncertainty.
Theorem 3 RS for block-diagonal perturbations (real and complex). Assume
that the nominal system M (s) and the perturbations (s) are stable. Then the M -system
in 4.10 is stable for all allowed perturbations with (), if and only if:

(M (j)) < 1, (4.10)

Enrique Gadea - Robust TVC Control 76


CHAPTER 4. ROBUST CONTROL

In the LFT general control conguration in 4.8 the K block represents the controller,
which is a system itself, so the state vector of the N -system is
[ ]
x
xT = P (4.11)
xK

where xP and xK are state vectors of the systems P and K respectively.

Theorem 4 Robust Performance Rearrange the uncertain system into the N -structure
of 4.9. Assume N S such that N is (internally) stable. Then

RP F = Fu (N, ) < 1, 1 (4.12)



(N (j)) < 1, (4.13)

where is computed w.r.t. the structure


[ ]
= 0

0 p

and p is a full complex perturbation with the same dimensions as F T .

4.3.2 Worst Case Performance and Skew


If we want to keep some of the uncertainty blocks xed we would know how large one
particular source of uncertainty can be before instability. We dene this value as 1/s (M ),
where s is called skewed-. We may view the s (M ) as a generalization of (M ).
For example, let = diag(1 , 2 ) and assume we have xed 1 1 and we want
to nd how large 2 can be before we get instability. The solution is to select
[ ]
I 0
Km =
0 km I

and look at each frequency for the smallest value of km which makes det(I Km M ) = 0,
and we have that skewed- is
s (M ) = 1/km
Assume we have a system for which the peak -value for RP is 1.1. The denition
of tells us that our RP requirements would be satised exactly if we reduced both the
performance requirement and the uncertainty by a factor of 1.1. So does not directly
give us the worst case performance (max (F ())) as one might have expected.
To nd worst case weighted performance for a given uncertainty, one needs to keep the
magnitude of the perturbations xed (() 1); that is, we must compute skewed- of
M . We have, in this case,

max (Fu (N, )(j)) = s (N (j))


()1

Enrique Gadea - Robust TVC Control 77


CHAPTER 4. ROBUST CONTROL

4.4 Rigid Body controller


With the new synthesis model dened and applying the -synthesis algorithm a new
rigid body controller is designed. From the rst one designed until the last version there
is a trial and error processing where the Wfunctions need to be tuned. In fact, even if the
shape is known there still are some small gain adjustments necessaries. The shape of the
controller design by the -synthesis technique is plotted in 4.11

Bode Diagram

40

30
Magnitude (dB)

20

10

10

20
270

225
Phase (deg)

180

135

90
4 2 0 2 4
10 10 10 10 10
Frequency (rad/sec)

Figure 4.11: Rigid body controller

The nominal point of design for the controller is the maximum dynamic pressure. With
only this controller the system stays stable all long the time domain. All the performances
are in the table below.
Time slide PM GM(LF) GM(HF) DM RS(%)
30 38.9701 7.1765 18.4129 0.2 138
40 40.4746 7.2222 17.6195 0.1957 136
50 42.9776 8.1476 16.1515 0.1747 153
60 44.4235 9.8240 14.5609 0.1478 182
70 44.0486 13.1122 12.7698 0.1169 225
80 42.1874 17.2593 11.3299 0.0941 191
90 38.3592 22.4296 9.5355 0.0704 201

Even if the system stays stable and margins are good, it could be interesting to see
what happens if a gain scheduling technique is also applied. With more than one con-
troller the decrease on the phase margin after the 60s can be avoided and all the margins
will follow a more standard variation. A standard variation can be dened as a parabola
were the minimum is next to the maximum dynamic pressure. With only one controller
performances and robustness are subject to the parameters variation from the nominal
design point. That explain the result of a parabola but with a maximum at the maximum
dynamic pressure.

However, despite the results obtained it is possible to keep only one controller as it
was shown and it will guarantee both performances and stability. Thanks to the robust

Enrique Gadea - Robust TVC Control 78


CHAPTER 4. ROBUST CONTROL

approach of the controller it is no longer strictly necessary to use a Gain Schedule tech-
nique since this one gives little improvements in comparison with only one controller.

Dening ten controllers, one each ten seconds of time domain (from ten to ninety
seconds) is a more homogeneous approach. These controllers will look very similar one to
another but with small dierences like in bandwidth or in the static gain for example.

40

30
Magnitude [dB]

20

10

0
100
10 80
4
10
2 60
10
0
10 40
2
10
4 20 time [s]
10
frequency [rad/s]

Figure 4.12: 3D plot of the controllers

The performances achieved now are (in margins talking) very similar but the system
is better prepared to aront the desired robust stability and performances. In general the
% of robust stability supported by the system increase.
The table below sum up the margins achieved with these news controllers
Time slide PM GM(LF) GM(HF) DM RS(%)
30 44.08 7.1765 18.4129 0.1885 162
40 42.26 7.2222 17.6195 0.1797 156
50 42.97 8.1476 16.1515 0.1797 153
60 46.12 9.8240 14.5609 0.1797 161
70 49.29 13.1122 12.7698 0.195 176
80 52.10 17.2593 11.3299 0.2185 218
90 54.25 22.4296 9.5355 0.2582 253
One can nd the complete report of robust stability and performances for each con-
troller in annex E and all the plots of the time simulation in annex D. It is important to
remark that despite in the PD controller and was used here it is not longer necessary to
introduce both feedbacks. However, introducing as new feedback will make the resolu-
tion to nd a controller satisfying all the requirements easier (we are adding a new degree
of freedom) and the robust stability can also be increased. However, the controller will be
more complex. Just to give an example, dening a controller for the time slide t=50s the
performances obtained in stability margins are similar, but the robust stability is around
400%. More than the double obtained by only having as feedback. Nevertheless, during
all this study only a feedback will be considered, knowing that adding a feedback in
could improved the performances.

Enrique Gadea - Robust TVC Control 79


CHAPTER 4. ROBUST CONTROL

S T

From: r To: [+rGrigidn(1)] From: r To: [+Grigidn(1)]


10 100

0
0
Magnitude (dB)

Magnitude (dB)
10
100
20
200
30

300
40

50 400
450 180

360
0
Phase (deg)

Phase (deg)
270

180 180

90
360
0

90 540
4 2 0 2 4 2 0 2 4
10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Sensitivity plot (S) (b) Complementary sensitivity (T)


KS alpha output

From: r To: [+Ksec] From: r To: [+Grigidn(3)]


30
0
20
50
Magnitude (dB)

Magnitude (dB)
10
100
0
150
10
200
20 250

30
540 180

0
Phase (deg)

Phase (deg)

360

180

180
360

0 540
4 2 0 2 4 2 0 2 4
10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(c) KS (d) Alpha

Figure 4.13: S,T,KS,and Alpha Bode plots

4.5 Bending Modes


Bending modes will now include some uncertainty in frequency (20%) and damping
(10%) creating dierent possible behaviours.
The new terms added to the matrix due to the introduction of the bending modes are:


w1 0 0 0 0 0
..
0 . 0 0 0
0

0 0 wi 0 0
0
=
0

(4.14)
0 0 1 0
..
0 0 0 0 . 0
0 0 0 0 0 i
It is important to considered the structure of . As it was already mentioned will
have block diagonal structure in which the generic block can be a scalar real parameter,
a repeated real parameter, a scalar complex perturbation or a full complex m x n block.

Enrique Gadea - Robust TVC Control 80


CHAPTER 4. ROBUST CONTROL

56 20.5

20
54

19.5
52
19

50 18.5

48 18

17.5
46
17

44
16.5

42 16
20 30 40 50 60 70 80 90 20 30 40 50 60 70 80 90

(a) Phase Margin (b) High Frequency Gain Margin

12.5 0.26

12 0.25

11.5 0.24

11 0.23

10.5 0.22

10 0.21

9.5 0.2

9 0.19

8.5 0.18

8 0.17
20 30 40 50 60 70 80 90 20 30 40 50 60 70 80 90

(c) Low Frequency Gain Margin (d) Delay Margin

Figure 4.14: Margins

From a computational time it is important to avoid having large repeated real parameters
blocks.

Hence, instead of having two times the number of bending modes introduced as new
parameters and having an uncertainty in the parameters, a lter (Wf lex ) which magnitude
approximates the maximum gap between the nominal behaviour and the dierent ones
created by the uncertainties is designed.

Sysf lex = Gf lex (1 + Wf lex ) (4.15)


Being Gex the state space model for the bending modes dened in section 3.3 and
the complex uncertainty value ( |1|)

Because nominal value of frequency and other parameters are time variant parameters,Wf lex
must also be time variant. Looking to the dierence between the behaviours and the nom-
inal one, the order of the lter was adjusted. In gure 4.15 one can see the dierent shapes
of the lter for dierent time slides and how it covers the uncertainty introduced.

Enrique Gadea - Robust TVC Control 81


CHAPTER 4. ROBUST CONTROL

Bode Diagram Bode Diagram

40 40

20 20

0 0
Magnitude (dB)

Magnitude (dB)
20 20

40 40

60 60

80 80
2 1 0 1 2 3 4 1 0 1 2 3 4 5
10 10 10 10 10 10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) t=30s (b) t=60s

Bode Diagram

60

40

20
Magnitude (dB)

20

40

60

80
1 0 1 2 3 4 5
10 10 10 10 10 10 10
Frequency (rad/sec)

(c) t=90s

Figure 4.15: Shapes of Wf lex lter

Figure 4.16: Rigid body with bending modes system

As in the classical controller when adding the bending modes to the structure the rigid
body controller cannot guarantee stability and system becomes unstable so a lter is again
necessary. Despite the way it was dene the rst time, now the main purpose is to obtain
a lter given by the system, i.e that can guarantee stability and performances by design.
To nd the rigid body controller a synthesis model was dened applying synthesis

Enrique Gadea - Robust TVC Control 82


CHAPTER 4. ROBUST CONTROL

algorithm, one can get a controller that tries to satisfy the desired performances in the
best way and that guarantee stability also. The principle now is to use the same approach
but adding the bending modes and the rigid controller in the loop.

System behaviour has changed because of the bending mode so the new controller
created by using the synthesis has to guarantee the stability and try to reach the
performances but because all the performances were achieved by the rigid controller for
the rigid body the only thing needed is a lter for the bending modes and that is exactly
what the synthesis algorithm will provide. Despite what happens with the classical
controller this time, the TVC actuator is not enough to stabilise the system because it was
considered for the rigid body controller design. Now the lter is created by the system to
guarantee stability taking into account the dierent uncertainties of the model and given
a robust solution.

Bode Diagram

10

20
Magnitude (dB)

30

40

50

60

70
2 0 2 4 6 8
10 10 10 10 10 10
Frequency (rad/sec)

Figure 4.17: Shape of a lter designed using synthesis

Because this lter was design using some uncertainties on frequency and damping of
the bending modes, it can be used for all the time domain even if the bending modes fre-
quencies change. However, performances decrease because the lter was not only designed
for a nominal bending mode frequency but also for a specic rigid body controller. Hence,
it is good to design as many lters as controllers to maximize performances. Figure 4.18
shows a 3D plot of the dierent lters used and the product of the rigid body controller
and the lter.

The table below sum up the margins for the dierent time slides.

Enrique Gadea - Robust TVC Control 83


CHAPTER 4. ROBUST CONTROL

3D plot Krigid*Notchfilter

40
20
20
0
Magnitude [dB]

Magnitude [dB]
0
20
20
40 90
40 100
80
60 70 80
4 60
10 60 4
60
2 10
10 50 2
0 10
10 10
0 40
2 40 2
10 time [s] 10
4 30 4 20 time [s]
10 10
frequency [rad/s] frequency [rad/s]

(a) 3D Plot of the notch filter (b) 3D plot of Krigid*Wf lex

Figure 4.18: 3D plot of the notch lter and the complete controller

Time slide PM GM(LF) GM(HF) DM RS(%)


30 18.4 2.83 5.88 0.1795 98.5
40 30.4 4.9 10.1 0.2090 98.5
50 22 3.4 7.64 0.1869 89.6
60 32.4 5.16 9.55 0.2041 91.9
70 23.7 3.71 7.57 0.2098 92
80 36.4 6 13.9 0.2837 120
90 34.1 6.17 12.1 0.3485 115

Even if with this congurations 100% of robustness is not achieved it is just a matter
of modifying the weighting functions until the system reach the performances. Robustness
and performances are opposite and it is hard to combine both. If robustness is not satisfy
that means that the performances asked or the uncertainty level introduced is very big
and the system cannot satisfy all the restrictions. However, it is important to remark that
the % of uncertainty tolerated is almost 100% and using only as feedback.

4.6 Drift control


When introducing the wind into the system, the launcher drift and the angle of attack
is increased. It is important to keep both values between the boundaries to guarantee
the tracking and the structural safety. After making a rst simulation to see the values,
one can notice than the drift is not so important (466m. for a maximum allowed value of
1000m) but the angle of attack cross the allowed limits (4.22 for a maximum of 3 al-
lowed).

The main point of this new feedback will be then to reduce the angle of attack, spe-
cially at the maximum dynamic pressure so it seams logical to make a feedback on the
angle of attack instead of the drift and the drift speed. Remembering the study done in
section 3.2.1 a feedback in alpha will reduce the angle of attack and will also introduce a

Enrique Gadea - Robust TVC Control 84


CHAPTER 4. ROBUST CONTROL

Bode Diagram Bode Diagram

From: r To: [+rGrigidn(1)Gflexn] From: r To: [+Grigidn(1)+Gflexn]


10
0
0
Magnitude (dB)

Magnitude (dB)
10 100

20 200

30
300
40
400
540 720

360 360
Phase (deg)

Phase (deg)
180 0

0 360

180 720
4 2 0 2 2 0 2 4
10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Sensitivity plot (S) (b) Complementary sensitivity (T)


Bode Diagram Bode Diagram

From: r To: [+Ksec] From: r To: [+Grigidn(3)]


20
0
0
Magnitude (dB)

Magnitude (dB)
20 100

40
200
60
300
80

100
1080 720

720 360
Phase (deg)

Phase (deg)

360 0

0 360

360 720
2 0 2 4 2 0 2 4
10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(c) KS (d) Alpha

Figure 4.19: S,T,KS,and Alpha Bode plots

little reduction on the drift, but the tracking error will increase. However, even if making
a feedback on the drift and the drift speed the angle of attack can also be decreased,
tracking is very aected and because the drift value still between boundaries, making a
feedback on alpha seams the best option.
The principle used to get the controller is the same that the one used to design the notch
lter for the bending modes. The synthesis model will be very similar, keeping the rigid
controller in the loop, but this time opening the command input will be added to the
output of the rigid controller and the measurement output for the feedback will be the
angle of attack coming for the rigid body plant.

This time is not possible to avoid the wind eect in the synthesis model. Because the
angle of attack (and the drift) are very aected by it, it is important to include it since
the beginning. Without wind, the angle of attack is very small and did not exceed the
maximum value but it does when the wind appears. Avoiding the wind into the synthesis
model will create more than a controller a lter for alpha, in order to lter the feedback.
The system was already satisfying the requirements and adding this feedback will only
makes things worst, so the system creates a lter to avoid its eect. Nevertheless, by

Enrique Gadea - Robust TVC Control 85


CHAPTER 4. ROBUST CONTROL

Figure 4.20: Synthesis Model

introducing the wind the feedback becomes useful and the system can create a controller
to contribute to satisfy all the requirement. This new input will need a weight like all
the others perturbations dened. The weight dened will have the same shape than a
low-pass lter because the main eect of the wind will be at low frequencies 4.21

Bode Diagram

30

20

10

0
Magnitude (dB)

10

20

30

40

50
2 1 0 1 2 3
10 10 10 10 10 10
Frequency (rad/sec)

Figure 4.21: Weighting function for the wind input

For the drift control design is not necessary to include the bending modes in. The
bending modes are not aected by the wind and they aect mainly the pitch angle. It is
true that they are going to have an impact on the angle of attack because the pitch angle
has an impact on it, but to reduce the number of states and the complexity of the synthesis
model, it is better to avoid include them. Once the drift control is done, it is important to

Enrique Gadea - Robust TVC Control 86


CHAPTER 4. ROBUST CONTROL

verify that even including the bending modes all the requirements are satisfy. If there is
any problem in the angle of attack for example, it suce to modify the weighting functions
to make it more constraint and increase the reduction in the rigid body to compensate the
possible variation introduced by the exible modes. Of course, with powerful computers
it is possible to make the drift control including the bending modes.

The rigid body controller was designed again but this time, including the wind as an
input just to compare with the other controller. Looking to gure 4.22 one realises that
both controllers are very similar, and even in their performances (time simulation and
margins). For this reason it is justied to keep the same controller dened in section 4.4

Bode Diagram

50
Krigiddrift
Krigid

40

30
Magnitude (dB)

20

10

10
4 2 0 2 4
10 10 10 10 10
Frequency (rad/sec)

Figure 4.22: Comparison between both rigid body controllers

3D plot Kdrift
Bode Diagram

140
150
120

100
Magnitude [dB]

100

50
80
Magnitude (dB)

0
60

50
40
100

20 80

60
0
4
40 2 10
0 10
20 2 10
4 2 0 2 4 time [s] 20 4 10
10 10 10 10 10
10 frequency [rad/s]
Frequency (rad/sec)

(a) Bode plot for a Kdrift controller (b) 3D plot of the Kdrift controller

Figure 4.23: Shape of the Kdrift controller

Enrique Gadea - Robust TVC Control 87


CHAPTER 4. ROBUST CONTROL

Adding this controller into the system the angle of attack get reduced in a 30% and
tracking is even improved. However, there is a small increase in the drift but the nal
value achieved stays under the boundary. The table below sum up the results achieved:

alpha Drift Max error Max (degrees)


Nominal 4.22 446 1.34
Alpha Feedback 2.94 407.6 0.8

Now the bending modes are introduced together with the notch lter designed in 4.5.
As it was expected, the system still stable and the angle of attack still under 3.

alpha Drift Max error Max (degrees)


Nominal 5.22 636 3
Alpha Feedback 2.69 474 3

4.7 One controller for all the Pay Loads


All the data where obtained for a Pay Load of 1200kg. One could think that for each
Pay Load is necessary to do again all this study even if a lot of things can be used to
reduce the amount of work. It is true that with the Pay Load, data changes and of course
values of the EOM are not going to be the same, but because of the robust approach
it is possible that the system (more technically talking the controller) could manage the
dierence.
Comparing the numerical values of the most important parameters from the rigid body
(a6 and k1 ) together with the frequency of the bending modes one can see that even for
300kg or 2200kg, values are included in the interval dened by the 20% of uncertainty of
the design point.

Pay Load a6 k1 w1 w2 w3
300kg 3.21 6.74 27.08 60.06 82.14
1200kg 3.23 7.07 24.66 53.93 74.15
2200kg 3.26 7.42 22.85 50.43 70.06

So it seams possible to use the same controller for all the dierent Pay Loads. However,
there is an important dierent between the rigid body behaviour and the introduction of
the bending modes. When looking to parameters a6 and k1 one can see that the dierence
at each Pay Load is not very important, so it seams obvious that the rigid body controller
having a robust stability value bigger than a hundred percent will be able to manage it.
However, for the bending modes is not so easy. Dierence in frequency between 300kg
and 1200kg are almost the double than the ones between 1200kg and 2200kg. Adding the
fact that the robust stability when adding the bending modes decrease in an import way
perhaps the system will be able to stabilise the system for all the Pay Loads, but margins
at low Pay Loads will be very poor. For that reason, it can be interesting to dene two
kinds of notch lter for the bending modes. One for lows Pay Loads and the other one
for the bigger ones. Of course the rigid body controller used will be the same, reducing
considerably the amount of work.

Enrique Gadea - Robust TVC Control 88


CHAPTER 4. ROBUST CONTROL

4.8 Time simulation


All the controllers presented where tested in a non-linear simulator. This simulator
has two main inputs: the desired pitch angle and a wind prole C.2. Outputs are the
achieved pitch angle, the angle of attack, the error and the load (Q ).
All the plots for each controller are in D.

Enrique Gadea - Robust TVC Control 89


Chapter 5

Multi-axis controller

Now that the robust control in one axis is done, it is interesting to study what happens
when introducing the others axis. In fact everything is coupled in a LV when the roll rate
appears, and there are also some control problems due to the presence of the roll and the
pitch and yaw axis alternation. Making a multi-axis control is similar to duplicating the
work done for one axis. The total number of states considered will be six instead of three
and two control inputs will be considered instead of one. A new wind prole could be
design for the yaw, but from now on the wind is not going to be considered.

5.1 Problems due to the coupling


As it was introduced before, there is a coupling between pitch and yaw due to the roll
rate. This coupling is more and more important when the roll rate also increases. For
small levels of roll rate coupling, the system is still stable using the rigid body controller
dened in section 4.2 but some bumps and oscillations appear. If the roll rate is progres-
sively increased, the number of bumps in the pitch and in the yaw angles will increase
until instability is reached. Figures 5.1 and 5.2 show the pitch and yaw response using
the rigid body controller from the fty seconds time slide. One can notice the number of
oscillations that appears in both axes.

Due to this coupling, and to the possibility to reach instability it is interesting to design
a new rigid body controller taking the coupling into account. This new controller must
manage the control of the rigid body (of each axis) and the coupling. So in fact, there is
going to be two controllers for each axis, making a total of four. The controller will have
two inputs (pitch error and yaw error) and two outputs (p and y ) and can be expressed
like [ ]
K11 K12
(5.1)
K21 K22
Where K11 and K22 will manage the rigid body behaviour and K12 together with K21
will manage the coupling. Hence K11 and K22 will have a very similar shape to Krigid and
K12 together with K21 will lter the roll rate frequency to avoid the coupling. It is similar
to the exible modes case but for the roll rate.

91
CHAPTER 5. MULTI-AXIS CONTROLLER

1.8 1.8

1.6 1.6

1.4 1.4

1.2 1.2

1 1

0.8 0.8

0.6 0.6

0.4 0.4

0.2 0.2

0 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) p = 0/sec (b) p = 2/sec

Figure 5.1: Pitch response for dierent roll rates (p)

1 0.4

0.8
0.3
0.6
0.2
0.4
0.1
0.2

0 0

0.2
0.1
0.4
0.2
0.6
0.3
0.8

1 0.4
0 10 20 30 40 50 0 10 20 30 40 50

(a) p = 0/sec (b) p = 2/sec

Figure 5.2: Yaw response for dierent roll rates (p)

5.2 Building the system model


The system dened in section 4.2 is no longer valid since the coupling between axes
is considered. The considered model take the roll as an input, dened by the user. Roll
and roll rate are known and their evolution is xed by the user, not by the system. The
model will have then ve degrees of freedom. The purpose of this section is to study
the system stability and behaviour when introducing a coupling between two axis. The
evolution of this coupling is not interesting by the moment so keeping the roll as an input
is justied. In addition for a stability study, the roll rate is the key parameter. The roll
is more necessary when studying the trajectory because pitch and yaw will be switching
from attitude to lateral drift according to the roll angle but for stability purpose it can be
xed to zero.

The complete equations for this new system are:

Enrique Gadea - Robust TVC Control 92


CHAPTER 5. MULTI-AXIS CONTROLLER

= p + q
= p + r
Izz Ixx
q = k1 p + a6 + pr
Iyy
Ixx Iyy
r = k1 y + a6 + pq
Izz
( ) ( ) (5.2)
T D T yb + L b T pb L b
x = +
m m m
( )
T D L T y
y = + + pz
m m
( )
T D L T p
z = + py
m m
Rewriting these equations in a state space form:

0 1 p 0 0 0
q a 0 p In a6 0 0
6 0 0 q
v
k1 0 [ ]
p

p 0 0 1 0 0
= a7 r + 0 k1
r 0 p In a7 0 0 v a3
0 y
Z a1 0 0 0 a2 p Z
0 a3
Y 0 0 a4 0 p a5 Y


q
[ ] [ ] [ ][ ]
1 0 0 0 0 0
0 0 p
= + 0 0 y (5.3)
0 0 1 0 0 0
r
Z
Y
With:
D
a1 = L +T
m a2 = L
mv
T L GA
a3 = m a6 = Iyy
T CG
L = qSCN k1 = Iyy
L +T D
L (5.4)
a4 = m a5 = mv
L GA
a7 = Iyy L = qSCN
In = 1 IIxx
yy

In gure 5.2 only the system was drawn. To avoid overbook the gure, the weighting
functions were not included, but they still be included in the design.

5.3 Designing a new controller


Similar to the one axis controller, it is necessary to dene the weighting functions
to design a robust controller. However, due to the launchers axis symmetry, the same

Enrique Gadea - Robust TVC Control 93


CHAPTER 5. MULTI-AXIS CONTROLLER

Figure 5.3: Multi-axes rigid body model

weighting functions can be used in both axis. In fact, the weighting functions dened in
section 4.2 were thought in a way such as to have a desired launcher behaviour satisfying
the requirements. Nothing has changed from this point, i.e the launcher has to satisfy the
desired requirement independently of the number of axes considered. That is why it is
possible to reutilise the weighting functions without introducing, a priori, any modication.

Bode Diagram

From: In(1) From: In(2)


40

30

20
To: Out(1)

10

0
Magnitude (dB)

10

20
40

30

20
To: Out(2)

10

10

20
0 0
10 10
Frequency (rad/sec)

Figure 5.4: Multi-axis rigid body model

After following the same procedure than for the rigid controller, the controller designed
looks like the one plotted in gure 5.3. One can notice that there is an important peak at
the same frequency of the roll rate. This peak appears due to the roll rate coupling and
increases its value according to the roll rate value. 5.5.

The old rigid body controller was very focused on only one axis and cannot guarantee

Enrique Gadea - Robust TVC Control 94


CHAPTER 5. MULTI-AXIS CONTROLLER

Bode Diagram Bode Diagram

From: In(1) From: In(2) From: In(1) From: In(2)


40 40

20 30

20
To: Out(1)

To: Out(1)
0
10
20
0
Magnitude (dB)

Magnitude (dB)
40 10

60 20
80 40

60 30
40
20
To: Out(2)

To: Out(2)
20
10
0
0
20

40 10

60 20
5 0 5 0 0 0
10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) p=0 (b) p=45

Figure 5.5: Controller shape for dierent roll rates


Roll rate profile
40

35
Time p (/s)
30 30 10
40 10
roll rate

25

50 27
20
60 27
15
70 27
10
30 40 50 60 70 80 90
80 38
Time
90 38

Figure 5.6: Roll rate prole

any stability when introducing some coupling. This controller however, can manage this
coupling and it tolerates a variation in the roll rate. Nevertheless, as in the one axis case, it
is more interesting to dene more than only one controller because this time the coupling
will vary if the roll rate evolves.
The shape of this new controller is shown in gure 5.7. One can notice that as pre-
dicted at the beginning of this chapter, the shape of the controller between error and p
and between error and y looks like the rst robust rigid body controller and the crossed
terms, are a lter acting in the roll rate frequency.

The table below sums up the robust stability (so the level of uncertainty allowed before
reaching instability) together with the roll rate(p).

Time p (/s) RS(%) RP(%)


30 10 166 0.4738
40 10 169 0.4752
50 27 129 0.3986
60 27 163 0.3453
70 27 135 0.3742
80 38 114 0.2861
90 38 209 0.4186

Enrique Gadea - Robust TVC Control 95


CHAPTER 5. MULTI-AXIS CONTROLLER

3D Krigid(1,1) 3D Krigid(1,2)

40 40

20 20
Magnitude [dB]

Magnitude [dB]
0 0

20 20

40 40
100 100
80 5 80 5
10 10
60 60
0 0
40 10 40 10

time [s] 20 10
5
time [s] 20 10
5
frequency [rad/s] frequency [rad/s]

(a) From error to p (b) From error to p


3D Krigid(2,1) 3D Krigid(2,2)

40
40
Magnitude [dB]

20
20
Magnitude [dB]

0
0

20 20
100 10
5

80 100
40
4
60 0 80
10 2 10
10 60
0 40
10 40
2
10 4 20 time [s] 5
10 20 time [s]
10 frequency [rad/s]
frequency [rad/s]

(c) From error to y (d) From error to y

Figure 5.7: S,T,KS,and Alpha Bode plots

S T

From: r From: r
10 100

0 0
To: [+rGrigidn(1)]

To: [+Grigidn(1)]

10
100
20
200
30
Magnitude (dB)

Magnitude (dB)

40 300

50 400
0 0
To: [+tGrigidn(2)]

100 100
To: [+Grigidn(2)]

200 200

300 300

400 400
4 2 0 2 4 4 2 0 2 4
10 10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Sensitivity plot (S) (b) Complementary sensitivity (T)

Figure 5.8: S and T Bode plot from ref

Enrique Gadea - Robust TVC Control 96


CHAPTER 5. MULTI-AXIS CONTROLLER

KS alpha output

From: r From: r To: [+Grigidn(5)]


40 50

20
To: [+Ksec(1)]

0
0

20 50
Magnitude (dB)

40

Magnitude (dB)
100
60
20
150

0
To: [+Ksec(2)]

200
20

250
40

60 300
4 2 0 2 4 4 2 0 2 4
10 10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) KS (b) Alpha


beta output

From: r To: [+Grigidn(6)]


50

50
Magnitude (dB)

100

150

200

250

300
4 2 0 2 4
10 10 10 10 10
Frequency (rad/sec)

(c) Beta

Figure 5.9: KS, Alpha and Beta bode plot from ref

S T

From: t From: t
0 0
To: [+rGrigidn(1)]

100 100
To: [+Grigidn(1)]

200 200

300 300
Magnitude (dB)

Magnitude (dB)

400 400
20 100

0
To: [+tGrigidn(2)]

0
To: [+Grigidn(2)]

100
20
200

40
300

60 400
5 0 5 5 0 5
10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Sensitivity plot (S) (b) Complementary sensitivity (T)

Figure 5.10: S and T Bode plot from ref

Enrique Gadea - Robust TVC Control 97


CHAPTER 5. MULTI-AXIS CONTROLLER

KS alpha output

From: t From: t To: [+Grigidn(5)]


40 50

20
To: [+Ksec(1)]

0
0

20 50
Magnitude (dB)

40

Magnitude (dB)
100
60
40
150
20
To: [+Ksec(2)]

0 200

20
250
40

60 300
4 2 0 2 4 4 2 0 2 4
10 10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) KS (b) Alpha


beta output

From: r To: [+Grigidn(6)]


50

50
Magnitude (dB)

100

150

200

250

300
4 2 0 2 4
10 10 10 10 10
Frequency (rad/sec)

(c) Beta

Figure 5.11: S,T,KS,and Alpha bode from ref

5.4 Bending modes and drift control


5.4.1 Bending modes
With the bending modes in the system, as in the one axis case, the system becomes
unstable. It is necessary to introduce the bending modes lter. One of the hypothesis
tested says that there is no roll coupling in the bending modes and they are independent
for each axis, so it is possible to use the lter designed in section 4.5.

When introducing them, as it was expected, system becomes stable again. In fact the
lter is introduced twice, one for each axis. Figure 5.4.1 reects the new scheme of the
model with all its elements without the weighting functions.

Enrique Gadea - Robust TVC Control 98


CHAPTER 5. MULTI-AXIS CONTROLLER

Step Response Step Response


13
x 10 From: r From: t From: r From: t
1 3
To: [+Grigidn(1)+Gflexn1]

To: [+Grigidn(1)+Gflexn1]
2.5
0.5
2

1.5
0
1

0.5
0.5
0
Amplitude

Amplitude
1 11 0.5
x 10
10 3
To: [+Grigidn(2)+Gflexn2]

To: [+Grigidn(2)+Gflexn2]
2.5

2
5
1.5
1
0 0.5

5 0.5
0 10 20 30 40 0 10 20 30 40 0 20 40 60 80 100 0 20 40 60 80 100
Time (sec) Time (sec)

(a) Without any filter (b) Using the bending modes filter

Figure 5.12: Step response with and without lter

Figure 5.13: Multi-axis model

Time p /s RS(%) RP(%)


30 10 30 0.1098
40 10 59 0.2469
50 27 59 0.1449
60 27 66 0.1971
70 27 35 0.1064
80 38 36 0.0583
90 38 77 0.1102

Enrique Gadea - Robust TVC Control 99


CHAPTER 5. MULTI-AXIS CONTROLLER

S T

From: r From: r
20
50

To: [+Grigidn(1)+Gflexn1]
0
To: [+rGrigidn(1)]

0
50

20 100

150
40
Magnitude (dB)

Magnitude (dB)
200

250
60
0 200

To: [+Grigidn(2)+Gflexn2]
To: [+tGrigidn(2)]

100 0

200 200

300 400

400 600
5 0 5 4 2 0 2 4 6
10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Sensitivity plot (S) (b) Complementary sensitivity (T)


KS

From: r
40

20
To: [+Ksec(1)]

20
Magnitude (dB)

40

60
40

20
To: [+Ksec(2)]

20

40

60
4 2 0 2 4
10 10 10 10 10
Frequency (rad/sec)

(c) KS

Figure 5.14: S,T and KS from ref

S T

From: t From: t
0 200
To: [+Grigidn(1)+Gflexn1]

0
To: [+rGrigidn(1)]

100

200
200
400

300
Magnitude (dB)

Magnitude (dB)

600

400 800
50 200
To: [+Grigidn(2)+Gflexn2]

0
To: [+tGrigidn(2)]

200
50
400

100
600

150 800
6 4 2 0 2 4 4 2 0 2 4 6 8
10 10 10 10 10 10 10 10 10 10 10 10 10
Frequency (rad/sec) Frequency (rad/sec)

(a) Sensitivity plot (S) (b) Complementary sensitivity (T)

Figure 5.15: S and T bode plot from ref

Enrique Gadea - Robust TVC Control 100


CHAPTER 5. MULTI-AXIS CONTROLLER

KS

From: t
40

20

To: [+Ksec(1)]
0

20

Magnitude (dB)
40

60
40

20

To: [+Ksec(2)]
0

20

40

60
4 2 0 2 4
10 10 10 10 10
Frequency (rad/sec)

(a) KS

Figure 5.16: KS bode plot from ref

5.5 Limitations of this approach


This approach is interesting to study and to see what is the eect of the roll rate in the
system and how a controller can be designed to solve the coupling. However, it is necessary
to know the roll rate , what is always not always known in principle, and the controllers
are optimized for one roll rate only. It could be interesting to design the controller in a
such way that the roll rate was an input so it can adapt itself to dierent roll rates or
possible variations in a more accurate way instead of just playing with the robustness of
the controller.

Enrique Gadea - Robust TVC Control 101


Conclusions

The main conclusion of this study is that it is possible to design a complete controller
(rigid body controller, bending modes lter and drift controller) using a robust technique
and taking the desired requirements into account since the beginning. The time simula-
tions conrmed that the system was stable for all the situations and that the structural
requirements (drift and angle of attack) were satised. However other conclusions can be
extracted.

A classical controller (such a PD controller) will guarantee stability at least while the
synthesis model stays very simple (two or three states at maximum). When having a simple
model, the PD controller can assume the role of stabiliser and performances guarantor but
with its own limitations (design point, low uncertainty level...). Between these limitations
there is the need of using a lter for the bending modes and something to reduce the drift
or the angle of attack. In addition to adapt the controller to the time variant parameters,
it was necessary to introduce the gain scheduling technique, dening several controllers for
dierent points. This technique had as drawback some implementation problems in time
simulations like bumps appearance in the switching process or even instability in a worst
case.

The classical controller was designed using the desired closed loop performances of the
system and considering that parameters are time invariant and well known. The role of
the robust controller is to design a controller taking into account the desired performances
but also introducing some perturbations or uncertainties in the parameters. Using the
synthesis technique a robust controller was successfully designed for the rigid body.
This controller presented similar performances in gain and phase margin in front of the
classical controller and had bigger robustness.

Another important dierence lies in the design method. Taking the bending modes as
example, the lter is designed by knowing the shape it should have without considering
the requirements of the system, so the lter obtained can stabilise the system but will not
consider to minimize the error, to have a good close-loop behaviour or any of the desired
requirements. However, when the lter is designed using the synthesis technique, the
lter is fruit of the system together with the requirements. It keeps the desired shape
but ltering the necessary frequencies and because it was designed by a robust technique,
stability is guarantee in advance and there is an indicator of how well the desired perfor-
mances are satised. Results shown that it was possible to dene a lter and to keep a

103
CHAPTER 5. MULTI-AXIS CONTROLLER

robust system, while it was almost impossible by doing it manually or using the desired
shape.

The advantages of using a robust technique can be extrapolated to any situation where
a new controller or an improvement of an old one could be necessary. For example, to
minimize the angle of attack it was necessary to add a new feedback and to introduce a
controller. The introduction of the controller reduced the angle of attack from 5.2to 2.8.
As for the bending modes, instead of using a classical gain (that could have worked) a
robust controller was used. Acting in the same way that in the other cases and dening
the desired behaviour of the system, the synthesis technique brings a controller sat-
isfying in the best possible way all the desired behaviour and guaranteeing stability. This
technique can be used for complex situations like multi-axis problem. A controller taking
the coupling between the dierent axes into account was successfully designed, showing
that the robust control is a good choice for high complexity problems

Keeping in mind that the robust controller was successfully designed next steps would
be to achieve similar results for the multi-axis scenario. The rigid body controller was
already dened and it was shown that it was not necessary to introduce any new lter but
it is still necessary to realise a complete time simulation in a non-linear simulator. After
that it could be interesting to dene the roll rate and the roll as states, to synthesise a
new controller and to implement it in a 6-DOF time simulation.

It is also important to remark the diculties found during the designing process. The
main drawback was the non-convexity of the algorithm. That means there is no way to
guarantee an optimal result. The second problem was the denition of the weighting func-
tions, used for the synthesis model of the robust controller. There was also an important
computational constraint and some implementations problems. As it is explained in annex
D when using a gain scheduling techniques the controllers used need to be similar and have
not to present important peak dierences.
This study may be a good basis and a reference for a further study using LPV tech-
niques. The robust controller can be designed using LPV techniques where controllers can
be designed in one shot over the entire envelope. The rate for the multi axis system can
become an LPV parameter that can be scheduled making a controller for pitch, yaw and
roll possible.

Enrique Gadea - Robust TVC Control 104


References

[1] Arthur L. Greensite. Control Theory Volume II : Analysis and Design of Space Vehicle
Flight Control Systems. Spartan Books, 1971

[2] Ph. Saunois. Comparative Analysis of Architectures for the Control Loop of Launch
Vehicles during Atmospheric Flight. EADS Space Transportation, France

[3] LT. Andrew Allen Martin. Model Predictive Control for Ascent Load Management of
a Reusable Launch Vehicle. Massachusetts Institute of Technology, June 2002.

[4] James A. Frosch, Donald P. Vallely. Saturn AS-501/S-IC Flight Control System De-
sign. J.Spacecraft Vol 4 NA 8, August 1967

[5] Cristophe R. Roux, Irene Cruciani. Roll Coupling Eects on the Stability Margins for
Vega Launcher. Guidance, Navigation and Control Conference and Exhibit, August
2007. AIAA 2007-6630

[6] Bong Wie, Wei Du, Mark Whorton. Analysis and Design of Launch Vehicle Flight
Control Systems. Guidance, Navigation and Control Conference and Exhibit, August
2008. AIAA 2008-6291

[7] Wei Du, Bong Wie. Ascent Flight Control of Ares-I Creq Launch Vehicle in the Event
of Uncontrolled Roll Drift. Guidance, Navigation and Control Conference and Exhibit,
August 2009. AIAA 2009-5957

[8] Yasuhiro Morita. An Idea of Applying -Synthesis to Launcher Attitude and Vibration
Control Design. Journal of Vibration and Control, 2004, Vol. 10, Nr. 9, p.1243-1254

[9] Dale F. Enns. Rocket Stabilization as a Structured Singluar Value Synthesis Design
Example, June 1991.

[10] Miguel A. de Virgilio, Darren K. Kamimoto. Practical Applications of Modern Con-


trols for Booster Autopilot Design. The Aerospace Corporation, 1993.

[11] Choong-Seok Oh, Hyochoong Bang, Chang-Su Park. Attitude control of a fexible
launch vehicle using an adaptative notch lter: Ground experiment. Control Engi-
neerign PRactice, 2008, Vol. 16 Nr. 1, p 30-42

[12] Lazzenec,H., Pilotage des Missiles et des Vehicules Spatiaux, Dunod, Paris, 1966.

105
REFERENCES

[13] Michael A. Creagh,Rick Lind, H-innity Control for Attitude Manoeuvres of a Spin-
ning Asymmetric Vehicle.Guidance, Navigation, and Control Conference, August
2009. AIAA 2009-5641

[14] Renato Lafranconi, Miguel Lopez, The Small Launcher for Europe

[15] M.Gauvrit, P.Apkarian, Commande robuste des systemes lineaires, SUPAERO (1994)

Enrique Gadea - Robust TVC Control 106


Annex A

Complete rigid body dynamic

A.1 Rigid body dynamic


The equations of motion are most readily derived relative to an inertial frame. Con-
sidering a generic mass particle, mi the total moment about the origin of the body frame
is
d
Mo = i (mi Ri ) (A.1)
dt
the time rate of change of the momentum, m R is given by
i i

d
(mi R i ) = mi Ri mi ci (A.2)
dt
where the eect of variation in mass is accounted for. Noting

R i = R o + i

and taking the derivative respect to time

R i = R o + + w

A further dierentiation yields

Ri = Ro + w i + w (w i ) + i + 2w i (A.3)

So equation A.2 can be rewritten


d
Mo = mc Ro + (Iw)i mi (wi )mi ci +w(i mi i )+i mi i (A.4)
dt
The equation for the linear acceleration follows directly from Newtons law
[ ]
F = m Ro + w (w c ) + w c + 2w c + c mi ci (A.5)
where

107
ANNEX A. COMPLETE RIGID BODY DYNAMIC

F applied force
mRo dAlembert force
2m(w c ) Coriolis force
m(w c ) Euler force
mw (w c ) centrifugal force
mi ci thrust due to variation in mass FT

For purpose of writing the trajectory equations, the terms in equations A.1 and A.2
that are due to bending,sloshing and jet damping are negligibly small and will be neglected.
In addition, for most large booster vehicles, the motion of the mass center relative to a
xed point on the body is small, and so is the rotation vector w. Consequently terms
involving products of w, and will be dropped.
Applying all this simplications, equations A.1 and A.2 are reduce to

F + FT = mRo + mw c
d (A.6)
Mo + MT = (I w) + mc (Ro + c )
dt
F External forces
FT Thrust term mi ci
Mo External moments
MT r Thrust deection i mi ci

Now, replacing Ro by its expression and in expanded form, equation A.6 may be written
as
[ ]
FA + Fg + FT = m U + w U + w c
[ ] (A.7)
MA + Mg + MT = I w + I w + w (I w) + mc U + w U + c

Reducing the equations of motion to scalar form:



u + qw rv + zcg q ycg r
m v + ru pw + xcg r zcg p = FA + Fg + FT (A.8)
w + pv qu + ycg p xcg q

p + (Izz Iyy )qr + mycg (w + pv qu + zcg ) mzcg (v + ru pw + ycg )


Ixx p + Ixx
Iyy q + Iyy
q + (Ixx Izz )pr + mzcg (u + qw rv + xcg ) mxcg (w + pv qu + zcg ) (A.9)
r + (Ixx Iyy )pq + mxcg (v + ru pw + ycg ) mycg (u + qw rv + xcg
Izz r + Izz
= MA + Mg + MT

During this study two main hypothesis have been used:

1. The mass center coincides with the origin of the reference system

Enrique Gadea - Robust TVC Control 108


ANNEX A. COMPLETE RIGID BODY DYNAMIC

2. Ix x = Iy y = Izz
=0

Introducing these simplications the system is reduced to



u + qw rv
m v + ru pw = FA + Fg + FT (A.10)
w + pv qu

Ixx p + (Izz Iyy )qr
Iyy q + (Ixx Izz )pr (A.11)
Izz r + (Ixx Iyy )pq
= MA + Mg + MT

A.2 External Forces and Moments


The external forces and moments in the above equations are due to gravity, thrust,
aerodynamics, propellant sloshing and engine inertia.

Fx = Fxg + FxT + Fx + Fx + FxE


Fy = Fyg + FyT + Fy + Fy + FyE
Fz = Fzg + FzT + Fz + Fz + FzE
(A.12)
Mx = Mxg + MxT + Mx + Mx + MxE
My = Myg + MyT + My + My + MyE
Mz = Mzg + MzT + Mz + Mz + MzE
However the contribution done by the propellant sloshing together with the nozzle
inertia will not be considered in front of the others parameters.

A.2.1 Gravity
Gravity is an external force that need to be transform to the body axis reference. Using
as external reference a xed Earth reference gravity can be expressed like:

xE 0
yE = 0 (A.13)
zE g
To express the gravity in the body axis reference, it is necessary to use the transformation
matrix [T ]bT . This matrix will be presented further in the section A.3.

xb 0
yb = [T ]bT 0
zb g
(A.14)
xb sin g
yb = sin cos g
zb cos cos g
And the force suered will be equal to the mass multiplied by the gravity.

Enrique Gadea - Robust TVC Control 109


ANNEX A. COMPLETE RIGID BODY DYNAMIC

A.2.2 Thrust

(a) Pitch plane (b) Yaw plane

Figure A.1: Thrust Conguration

The thrust due to the rocket engines is one of the major forces acting on the LV during
its ight. Swivelling of the thrust vector is also the primary means by which the LV
attitude is controlled.
The forces and torque generated are given by:

FT x = T (t) cos(p )
FT y = T (t) sin(y )
FT z = T (t) sin(p ) (A.15)
MT y = T (t)CG sin(p )
MT z = T (t)CG sin(y )

where CG is the distance between the nozzle swivel point C and the center of gravity G.
Equation A.15 emphasize that the thrust is a function of time.

Aerodynamic Forces and Torques The interaction between the LV and the atmo-
sphere in which it ies generates aerodynamic forces and torques. This interaction is only
signicant during the early stages of ight and typically has a destabilizing eect on the
LV dynamics.
The forces and torques due to aerodynamic loads will be derived using quasi-steady-

Enrique Gadea - Robust TVC Control 110


ANNEX A. COMPLETE RIGID BODY DYNAMIC

state aerodynamic theory. The aerodynamic components of interest are given by:

FAx = q(t)SCA
FAy = q(t)SCY
FAz = q(t)SCN (A.16)
MAy = q(t)SCN GA (t)
MAz = q(t)SCY GA (t)

where it was assumed that FAx and FAz act in the negative xb and zb directions respectively
as shown in gure 1.4. It is important to emphasize that the dynamic pressure q and the
distance GA between the aerodynamic center and the COG both depend strongly on time

(a) Pitch plane (b) Yaw plane

Figure A.2: Aerodynamic Conguration

S reference surface
CA coecient of x-aerodynamic force
CN coecient of z-aerodynamic force

Since the LV is not a lifting body there are no intrinsic aerodynamic torques, so that
the expression of the aerodynamic torques in equation A.16 has the very simple expression
of a force times a length. Furthermore, FAx is simply the aerodynamic drag which is essen-
tially independent from perturbations. Instead, the CN coecient appearing in equation
A.16 is typically a function of the angle of attack , its rate and the pitch rate . A
linear dependence of CN with respect to some steady state values of the aforementioned
variables, can be obtained by classical Taylor series, where the coecients of the series
are the classical stability derivatives. For LV having little or no lifting surfaces the only

Enrique Gadea - Robust TVC Control 111


ANNEX A. COMPLETE RIGID BODY DYNAMIC

stability derivative of real importance is typically the one associated with , which we
denote with CN = CN /. This stability derivative is, however, a function of Mach for
transonic and supersonic speeds. Furthermore, in the case of long slender LV, CN is a
function of position along the vehicle, CN (x) is therefore written that way to emphasize
this fact.

In order to completely dene FAz one can start by introducing the local angle of attack
for the rigid/exible LV,

(OG x) t)
(x, t) (x,
loc (x) = + (A.17)
U x U
where = arctan((zb W )xb ), OG is the distance between the origin and the center of
gravity of the LV and (x, t) is the displacement due to the bending modes.

Since both CN (x) and loc (x) depend on x the hole expression must be integrate on
the whole length L of the LV in order to obtain the desired expression of the aerodynamic
force. This gives:
L
1 2
FAz = U S CN (x)loc (x) dx
2 0
( L
1 2 1 L
= U S CN (x) dx + CN (x)(OG x) dx (A.18)
2 0 U 0
)
L 1 L
+ CN i (x) dx qi (t) CN i (x) dx qi (t)
0 U 0
i i

The last two terms in equation A.18 represent the aeroelastic terms. Everything done for
FAz , and My is equivalent for FAy , and Mz due to the axis-symmetry of the launcher.

A.3 Building the synthesis model


Combining the last two sections the complete rigid body dynamic is dened:

T CG L GA Ixx Izz
q = sin p + pr
Iyy Iyy Iyy
T CG L GA Iyy Ixx
r = sin y + pq
Izz Izz Izz
Gu + T D (A.19)
u = + rv qw
m
Gv T sin y + L
v = + pw ru
m
Gw T sin p L
w = + qu pv
m
One may note that all the equations presented before were obtained using the vehicle
body axes. However, for control synthesis design is better to obtain the motions about

Enrique Gadea - Robust TVC Control 112


ANNEX A. COMPLETE RIGID BODY DYNAMIC

the reference trajectory. Denoting Sb as the vehicle body axes and ST as the trajectory
axes, the relation between them can be expressed by the three Euler angles (, and )
as follows:
Rotate Sb about the Zb axis by an angle psi in the positive direction
Then rotate about the YP axis by an angle in the positive direction
Finally, rotate about the XP axis by an angle in the positive direction
This brings Sb into ST . Dening [T ]bT as the transformation matrix

1 0 0 c 0 s c s 0
[T ]bT = 0 c s 0 1 0 s c 0 (A.20)
0 s c s 0 c 0 0 1
Note that inverse of the matrix [T ]bT is equal to its transverse. Assuming small angles
(cos 1 ; sin ) for and , [T ]T b may be expressed like

1
[T ]T b = cos sin (A.21)
sin cos
So using the matrix [T ]T b it is easy to nd the relation between the body angular rates
and the trajectory ones
wYT = p + q cos r sin
(A.22)
wZT = p + r cos + q sin
For control synthesis purposes it is necessary to linearise the rigid body motion of the
LV about a trajectory xed reference frame and to obtain a perturbed motion about the
reference trajectory, given by a time scheduled look-up table.
The perturbed equation of motion in body axes can be obtained as:

x xb xT
= [T ]LO yb yT
y (A.23)

z zb zT
And writing the body states in term of reference variables as
qo = qL + q
qo = q
ro = rL + r
ro = r
zo = zL + z
(A.24)
yo = yL + y
o = L +
o = L +
pb = pL +
yb = yL +

Enrique Gadea - Robust TVC Control 113


ANNEX A. COMPLETE RIGID BODY DYNAMIC

Then playing with the equations the result for little deviation from the reference be-
come:

= p + q cos r sin
= p + q sin + r cos
Izz Ixx
q = k1 p + a6 + pr
Iyy
Ixx Iyy
r = k1 y + a6 + pq
Izz
( ) ( ) (A.25)
T D T yb + L b T pb L b
x = +
m m m
( ) ( )
T D L T y L T p
y = + cos sin + pz
m m m
( ) ( )
T D L T p L T y
z = + cos sin py
m m m

With this it is very easy now to build a state space model. Choosing the desired level
of states dierent models can be dened. For example, the system built in 3.2 can be
easily obtained from this equations imposing = = p = 0.

Enrique Gadea - Robust TVC Control 114


Annex B

Tuning a controller

Until now the dierent values of Kp and Kd were found just comparing the denominator
of the transfer function to the denominator of a second order system (s2 + 2w + w2 ).
Comparing both expression one can x the desired damping and frequency. However,
normally systems are not as easy as a second order or as easily identiable as these one.
For that reason it is necessary to nd other methods to nd out the values of the controller.
The engineering software MATLAB oer a tool that allow to calculate an optimal value
for the controller satisfying some constraint in time or frequency domain.

B.1 Introducing time domain constraint


Some times it is interesting to having a time response of some kind. More than going
on into the theoretical expressions to nd out what the controller values are, it can be
interesting to impose some boundaries or some restrictions in the system time response.
This is a good solution an a very easy one to set up some parameters for models with
time invariant parameters. It is also very useful to get some fast results and check some
aspects of the plant like for example how it would act in front of a perturbation one time
it is stable. It is important to check the system frequency response after making this kind
of set up. When aronting a time variant parameters two dierent approaches exist:

1. One can only impose one time restriction to be satised by the system even if pa-
rameters change with time. That means that even if parameters change the time
performance to reach is always the same and the controller is going to vary to reach
this performance.

2. Dierent time restrictions are dened because the system is going to be dierent at
each time slide and time requirement are also going to be dierent. The controller
will be adapted at each slide of time for the specics time requirement so we are
optimizing all the time domain.

Even if the second approach could look more ecient that the rst one, we can get
some good results with the rst approach because the nal time response of the system
is going to be satisfactory (boundaries and constraint are going to be satised) however,

115
ANNEX B. TUNING A CONTROLLER

values of the controller parameters could be higher or more restrictive in some time slides
that needed.
Margins need to be checked a posteriori because this tool only provides values that
satisfy (if possible) the constraint presented in the time response. There is no guarantee
even of stability. For example taking back the three states LV model presented in 3

(Kp + Kd s)(a3 av6 + a2 k1 + k1 s)


Hcl (s) =
s3 + B2 s2 + B1 s + B0
B2 = a2 k1 Kd
a6 (B.1)
B1 = k1 Kp a2 k1 Kd a6 a3 Kd
v
a6 a6
B0 = a1 a2 a6 a3 a2 k1 Kp
v v
and making one new tuning of Kp and Kd the time response seams to be improved.
This new tuning produces three real poles so there is no more overshoot in a step response.

Step Response Step Response

2.5 1.4

1.2
2

1.5
Amplitude

Amplitude

0.8

0.6
1

0.4

0.5
0.2

0 0
0 5 10 15 20 25 30 35 40 0 0.5 1 1.5
Time (sec) Time (sec)

(a) Old PD controller (b) New PD controller

Figure B.1: Comparison of the step response before and after using the PD optimization
tool

Then, margins need to be checked:


Number of States Gain Margin Phase Margin Delay Margin
Old 5.3634db 28.3123 0.2405
New 33.6db 87.2 0.0264
Thanks to this new controller Phase and Gain margin increase but Delay margin
decrease. One needs to check what is important for the system and if the new response is
acceptable or not.

B.2 Introducing frequency domain constraint


Another way to proceed is dening boundaries and constraint on the frequency plane
directly. We can directly impose a minimum damping or frequency value. It is another

Enrique Gadea - Robust TVC Control 116


ANNEX B. TUNING A CONTROLLER

way to control overshoots, time response and pole position with the advantage that one
can guarantee stability at least for the nominal case but the drawback that time response
is not so intuitive like in the previous case. Imposing some temporary boundaries will
produce a controller that satises these boundaries but only for the time simulation. The
system could have one unstable root (very slow) and be unstable for higher time values.
Working directly with the systems roots avoid this problem and control time response.
Nevertheless as it was said before, the problem of time variant parameters force to nd
dierent restrictions for each time slide.
Perhaps one important dierence rest in the fact that time domain optimisation is
easier to implement in a loop due to the fact that can be dened by a command while the
frequency optimisation needs to be done with the GUI.

Enrique Gadea - Robust TVC Control 117


Annex C

Getting the controller in one step

Another option to manage the problem of a controller design when a lot of parameters
appears is trying to get the controller in one step. For example, instead of designing a rigid
body controller and after that a notch lter, why not design it in one step?. Theoretically
the algorithm will calculate the controller necessary to satisfy the requirements so pre-
senting the complete synthesis model, i.e rigid body system, bending modes and weighting
functions, a very similar solution should be given. The problem lies in the non-convexity
of the problem. When a solution is found there is no guarantee of optimal solution. In-
stead of having a big and complex system and trying to nd a solution directly, making a
two steps approach a rst problem easier is solved and then even if the performances are
degraded and system becomes unstable adding the exible modes, the starting point for
this situation is very dierent from the other one when systems starts from zero. In this
section a one step controller for the rigid body and the bending modes is designed for each
time slides in order to compare the results achieved.
3D plot for the one step controller

40

20
Magnitude [dB]

20

40 80
5
10
60
0
10 40

10
5 20 time [s]
frequency [rad/s]

Figure C.1: Rigid body and bending modes lter

119
ANNEX C. GETTING THE CONTROLLER IN ONE STEP

Time slide PM GM(LF) GM(HF) DM RS(%)


30 19.73 3.217 6.627 0.1856 58.7
40 23.77 4.143 8.123 0.1853 89.4
50 19.59 3.402 6.843 0.1661 62.3
60 21.92 3.881 7.673 0.1710 70.2
70 22.92 4.025 7.211 0.1887 72.2
80 30.42 6.496 8.422 0.2128 120
90 39.75 9.897 12.09 0.2690 79.8

The results obtained are poor that the ones obtained with the two step controller
especially for the robust stability where the % of uncertainty tolerated is fewer. So, it
seams that making the two steps approach, the algorithm can nd a better solution than
making only one step. The same can be done for the drift control. Instead of keeping the
rigid body controller it is possible to try to solve the problem in one step. However, even
if the algorithm can nd a solution and the closed loop is stable, when making the time
simulation results and introducing the real wind prole, the system oscillates a lot, being
near to instability.

70

65

60

55

50

45

40

35

30

25

20
20 30 40 50 60 70 80 90 100

Figure C.2: Time simulation with drift control

Perhaps the complexity of nding a solution when trying to solve the problem in shot,
makes necessary to reduce the time slides and to introduce more controllers. However,
because that is a comparison between both controllers, when using the same number and
in the same situation, the two step controllers give not only better results, but also less
computer time consumption (solution is founded faster).ss

Enrique Gadea - Robust TVC Control 120


Annex D

Time Simulation

D.1 Interpolation of Controllers


When using a Gain Scheduling technique, controllers are going to be interpolated
between them to cover the complete time domain. The result is a linear controller useful
for the complete ight. However, the interpolation process is an important point. When
implementing a Gain Schedule technique two factors become crucial for the successful
implementation. One factor is the duration of the transition between controllers and the
other is the shape of the controller itself.

70

65

60

55

50

45

40

35

30

25

20
20 30 40 50 60 70 80 90 100

Figure D.1: Theta response with 5s of transition duration and 0.1s

When interpolating two controllers a transition duration is dened to switch from one
to the other. Between this time controllers are interpolated. When time is over, one of
the designed controllers is used until the next transition point appears. If the duration is
very small and the dierence between controllers is important then the system will bump
when switching from one controller to the other. In gure D.1 one can see the dierence
between using o.1s or 5s as duration for the transition period. When using 5s bumps are
smaller than with 0.1s. However, time can not be put as big as the time interval between
two designed points. Making a very big duration will make the system switch a lot of time

121
ANNEX D. TIME SIMULATION

between dierent controllers, and this can produce important oscillations in very small
time periods which can produce instability in some cases.
In the other hand, if the time evolution of the controllers is very rough that means
that the dierence to cover in the interpolation is bigger, and when switching from one
controller to the other bumps can appear again.

40
30

20 30
10

0 20
Magnitude [dB]

Magnitude [dB]
10
10
20

30 0
40

50 10

60
5
10 20
5
10
0 10
0
10
5
60 70 80 90 10
5
10 30 40 50 60 70 80 90
30 40 50
frequency [rad/s] time [s] frequency [rad/s] time [s]

(a) Controller 1 (b) Controller 2

Figure D.2: 3D shape of two dierent controllers

Figure D.2 shows a controller where which has a max dierence between two design
points of 30dB and a second one with less than 20dB of dierence. When making a time
simulation with the same transition duration one can see how bumps appear in the simu-
lation of the rst controller (gure D.3.

70 70

65 65

60 60

55 55

50 50

45 45

40 40

35 35

30 30

25 25

20 20
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(a) Time simulation for the first controller (b) Time simulation for the second controller

Figure D.3: Time simulation for the dierent controllers

As it was shown, when doing a time simulation it is important to check either the
shape and the transition duration. If the shape is very rough perhaps a high transition
duration is necessary.

Enrique Gadea - Robust TVC Control 122


ANNEX D. TIME SIMULATION

D.2 Time Simulation for the classical controller


All the time simulation have been done with for a Pay Load of 1200kg.

D.2.1 Time simulation with as feedback


Time simulation having alpha as feedback and with K = 0.5
4
x 10
1.4 0.5

1.2 0

0.5
1

1
0.8
1.5
0.6
2

0.4
2.5

0.2 3

0 3.5
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


200 1.2

1
0
0.8

0.6
200
0.4

400 0.2

0
600
0.2

0.4
800
0.6

1000 0.8
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.4: Time simulation for ref = 1 and w = 0

Enrique Gadea - Robust TVC Control 123


ANNEX D. TIME SIMULATION

0.06 18000

16000
0.05
14000

0.04 12000

10000
0.03
8000

0.02 6000

4000
0.01
2000

0 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


500 0.1

450 0.2

400
0.3
350
0.4
300
0.5
250
0.6
200
0.7
150

0.8
100

50 0.9

0 1
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.5: Time simulation for ref = 0 and w = 1

0.1 500

0.09
0
0.08

0.07
500
0.06

0.05 1000

0.04
1500
0.03

0.02
2000
0.01

0 2500
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


10 0.08

0 0.06

10
0.04

20
0.02
30
0
40

0.02
50

60 0.04

70 0.06
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.6: Time simulation for ref = 0.08 and w = 0.03

Time simulation having alpha as feedback and with K = 0.3

Enrique Gadea - Robust TVC Control 124


ANNEX D. TIME SIMULATION

4
x 10
4.5 0.5

4
0

3.5
0.5
3

2.5 1

2 1.5

1.5
2
1

2.5
0.5

0 3
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


100 4

0
3

100

2
200

300 1

400
0

500

1
600

700 2
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.7: Time simulation for ref = 1 and w = 0


4
x 10
0.5 3

0
2.5

0.5

2
1

1.5 1.5

2
1

2.5

0.5
3

3.5 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


700 0.5

0
600

0.5
500
1

400 1.5

300 2

2.5
200
3

100
3.5

0 4
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.8: Time simulation for ref = 0 and w = 1

Enrique Gadea - Robust TVC Control 125


ANNEX D. TIME SIMULATION

0.25 200

0.2
200

400
0.15
600

800
0.1
1000

1200
0.05

1400

0 1600
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


5 0.25

0
0.2

5
0.15
10

15 0.1

20 0.05

25
0
30

0.05
35

40 0.1
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.9: Time simulation for ref = 0.08 and w = 0.03

D.2.2 Time simulation with z as feedback


Time simulation having Z as feedback and with Kz = 0.005

2 1000

1.5
1000

2000
1
3000

4000
0.5
5000

6000
0

7000

0.5 8000
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response

Figure D.10: Time simulation for ref = 1 and w = 0

Enrique Gadea - Robust TVC Control 126


ANNEX D. TIME SIMULATION

20 2

1.5
20

40
1
60

80
0.5
100

120
0

140

160 0.5
0 10 20 30 40 50 0 10 20 30 40 50

(a) z response (b) response

Figure D.11: Time simulation for ref = 1 and w = 0

0.6 6000

0.4
5000

0.2
4000

0
3000
0.2

2000
0.4

1000
0.6

0.8 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


120 0.2

0.4
100

0.6

80
0.8

60 1

1.2
40

1.4

20
1.6

0 1.8
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.12: Time simulation for ref = 0 and w = 1

Enrique Gadea - Robust TVC Control 127


ANNEX D. TIME SIMULATION

0.14 50

0
0.12
50

0.1 100

150
0.08
200
0.06
250

0.04 300

350
0.02
400

0 450
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


1 0.1

0
0.08
1

2 0.06

3
0.04
4
0.02
5

6 0

7
0.02
8

9 0.04
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.13: Time simulation for ref = 0.08 and w = 0.03

D.2.3 Time simulation with z as feedback


Time simulation having Z as feedback and with Kz = 0.00138

2.5 200

2 0

200
1.5

400
1
600
0.5
800
0
1000

0.5
1200

1 1400

1.5 1600
0 20 40 60 80 100 0 20 40 60 80 100

(a) response (b) z response

Figure D.14: Time simulation for ref = 1 and w = 0

Enrique Gadea - Robust TVC Control 128


ANNEX D. TIME SIMULATION

200 2

150
1.5
100
1
50
0.5
0

50 0

100
0.5
150
1
200
1.5
250

300 2
0 20 40 60 80 100 0 20 40 60 80 100

(a) z response (b) response

Figure D.15: Time simulation for ref = 1 and w = 0

2 1200

1.5 1000

1 800

0.5 600

0 400

0.5 200

1 0
0 20 40 60 80 100 0 20 40 60 80 100

(a) response (b) z response


250 1

200
0.5

150

0
100

50 0.5

0
1

50

1.5
100

150 2
0 20 40 60 80 100 0 20 40 60 80 100

(c) z response (d) response

Figure D.16: Time simulation for ref = 0 and w = 1

Enrique Gadea - Robust TVC Control 129


ANNEX D. TIME SIMULATION

0.15 10

0.1 10

20

0.05 30

40

0 50

60

0.05 70

80

0.1 90
0 20 40 60 80 100 0 20 40 60 80 100

(a) response (b) z response


15 0.15

10 0.1

5 0.05

0 0

5 0.05

10 0.1

15 0.15

20 0.2
0 20 40 60 80 100 0 20 40 60 80 100

(c) z response (d) response

Figure D.17: Time simulation for ref = 0 and w = 1

D.2.4 Time simulation with z + z as feedback


Time simulation having Z and Z as feedback and with KZ = 0.00304 and Kz = 0.005

0.06 0.5

0.05 0

0.5
0.04

1
0.03
1.5
0.02
2
0.01
2.5

0
3

0.01 3.5

0.02 4
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response

Figure D.18: Time simulation for ref = 0.08 and w = 0

Enrique Gadea - Robust TVC Control 130


ANNEX D. TIME SIMULATION

1.5 0.06

1 0.05

0.04
0.5

0.03
0
0.02
0.5
0.01

1
0

1.5 0.01

2 0.02
0 10 20 30 40 50 0 10 20 30 40 50

(a) z response (b) response

Figure D.19: Time simulation for ref = 0.08 and w = 0

3
x 10
20 0.8

0.7
15
0.6

0.5
10

0.4

5
0.3

0.2
0
0.1

5 0
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


0.45 0.005

0.4

0.35 0.01

0.3

0.25 0.015

0.2

0.15 0.02

0.1

0.05 0.025

0.05 0.03
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.20: Time simulation for ref = 0 and w = 0.03

Enrique Gadea - Robust TVC Control 131


ANNEX D. TIME SIMULATION

0.07 0.5

0.06 0

0.05 0.5

0.04 1

0.03 1.5

0.02 2

0.01 2.5

0 3
0 10 20 30 40 50 0 10 20 30 40 50

(a) response (b) z response


1.5 0.04

1 0.03

0.02
0.5

0.01
0
0
0.5
0.01

1
0.02

1.5 0.03

2 0.04
0 10 20 30 40 50 0 10 20 30 40 50

(c) z response (d) response

Figure D.21: Time simulation for ref = 0.08 and w = 0.03

D.3 Time Simulation for the robust controller


D.3.1 Time simulation for the rigid body controller

70 1.4

65 1.2

60 1

55 0.8

50 0.6

45 0.4

40 0.2

35 0

30 0.2

25 0.4

20 0.6
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(a) IM U (b) ref -IM U

Enrique Gadea - Robust TVC Control 132


ANNEX D. TIME SIMULATION

5
x 10
2 2.5

2
1
1.5

0 1

0.5
1
0
2
0.5

3 1

1.5
4
2

5 2.5
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(c) (d) Q
500

400

300

200

100

100

200
20 30 40 50 60 70 80 90 100

(e) Drift

Figure D.22: Time simulation for the rigid body

D.3.2 Time simulation including the bending modes

70 4

65
3
60

55
2
50

45 1

40
0
35

30
1
25

20 2
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(a) IM U (b) ref -IM U


5
x 10
2 3

1 2

0
1

1
0
2
1
3

2
4

5 3

6 4
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(c) (d) Q

Enrique Gadea - Robust TVC Control 133


ANNEX D. TIME SIMULATION

700

600

500

400

300

200

100

100

200
20 30 40 50 60 70 80 90 100

(e) Drift

Figure D.23: Time simulation for the bending modes

D.3.3 Time simulation for the drift control

70 0.6

65
0.4
60

55 0.2

50
0
45
0.2
40

35 0.4

30
0.6
25

20 0.8
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(a) IM U (b) ref -IM U


5
x 10
1.5 2.5

1 2

1.5
0.5
1
0
0.5
0.5
0
1
0.5
1.5
1

2
1.5

2.5 2

3 2.5
20 30 40 50 60 70 80 90 100 20 30 40 50 60 70 80 90 100

(c) (d) Q
500

400

300

200

100

100
20 30 40 50 60 70 80 90 100

(e) Drift

Figure D.24: Time simulation for the drift control

Enrique Gadea - Robust TVC Control 134


Annex E

Robustness

This annex compile all the robust stability and performances details for each controller
used and for each slide of time.

E.1 Robustness of the classical controller


Here are the robust stability and performances reports for the rigid and exible body
using a PD controller. Each PD controller is optimized for the correspondent time slide

Rigid body
Robust Stability
Instability Sensitivity
Design Point (%) Tolerate
Uncert Freq a6 (%) k1 (%) Wtvc (%)
30 91.3 23 39 42
40 92 19 39 42
50 96.6 667 0.0238 28 39 42
60 95.4 20 39 261
70 106 667 0.0206 67 90 103
80 99.5 667 0.0060 43 40 43
90 137 667 0.0114 25 40 38

Robust Performances
Sensitivity
Design Point RP
a6 (%) k1 (%) Wtvc (%)
30 0.2636 6 11 16
40 0.2705 6 10 15
50 0.2736 6 10 15
60 0.2783 6 10 15
70 0.2864 6 10 22
80 0.2943 6 10 14
90 0.2980 6 10 14

135
ANNEX E. ROBUSTNESS

Flexible body
Robust Stability

Instability Sensitivity
Design Point (%) Tolerate
Uncert Freq Bend. Modes a6 (%) k1 (%) Wtvc (%)
30 24 24.1 53.2 99 0 0 5
40 25 25.1 53.2 99 0 0 5
50 26.7 26.7 53.3 99 0 0 5
60 43.7 43.9 22.1 91 0 1 9
70 41.1 41.3 32.4 91 0 0 12
80 12.9 12.9 27.6 98 0 0 3
90 54.1 54.4 31.2 92 0 1 12

Robust performances
Sensitivity
Design Point RP
Bend. Modes a6 (%) k1 (%) Wtvc (%)
30 0.1804 78 0 1 3
40 0.1871 77 0 0 3
50 0.1984 75 0 0 9
60 0.2723 48 6 10 14
70 0.2824 68 6 10 18
80 0.1130 93 0 0 3
90 0.2967 52 6 10 14

E.2 Robustness of the synthesis controller


Rigid body
Robust Stability
Instability Sensitivity
Design Point (%) Tolerate
Uncert Freq a6 (%) k1 (%) Wtvc (%)
30 162 442 1.57 49 47 38
40 156 449 1.64 15 47 40
50 153 442 1.52 15 48 39
60 161 15 48 38
70 176 17 87 38
80 218 667 0.0118 17 59 27
90 253 14 92 36

Enrique Gadea - Robust TVC Control 136


ANNEX E. ROBUSTNESS

Robust Performances
Sensitivity
Design Point RP
a6 (%) k1 (%) Wtvc (%)
30 0.4606 4 9 11
40 0.4449 4 9 11
50 0.4445 4 9 12
60 0.4650 4 9 11
70 0.4946 4 9 10
80 0.5624 3 8 9
90 0.6012 3 8 9

Flexible Body
Robust Stability

Instability Sensitivity
Design Point (%) Tolerate
Uncert Freq Bend. Modes a6 (%) k1 (%) Wtvc (%)
30 98.5 113 3.59 24 28 49 59
40 98.5 115 24.7 70 10 33 29
50 89.6 122 5.15 14 60 66 22
60 91.9 113 0.60 1 19 39 41
70 66.8 73.1 0.51 1 20 37 43
80 120 120 27 76 21 36 27
90 115 219 5.13 1 28 56 41

Robust Performances
Sensitivity
Design Point RP
Bend. Modes a6 (%) k1 (%) Wtvc (%)
30 0.1824 1 7 11 15
40 0.3004 1 6 10 14
50 0.2142 2 7 11 15
60 0.3137 1 6 10 14
70 0.2328 1 7 11 15
80 0.3571 1 6 10 13
90 0.3610 0 5 10 13

Enrique Gadea - Robust TVC Control 137

You might also like