ECOLE
DOFFICIERS DE LARMEE
DEPARTEMENT
DES VEHICULES
AEROSPATIAUX
RECUEIL DEXERCICES
DAUTOMATIQUE
Monsieur BATEMAN
Commandant HEIM
Introduction
EXERCICES DAPPLICATION
3 Marges de stabilit
e
4 Pr
ecision
11
5 Pr
ecision Vs. Stabilit
e
13
6 Lieu dEvans
17
7 Correction proportionnelle
19
8 Correction proportionnelle d
eriv
ee
21
23
10 Repr
esentation d
etat dun syst`
eme
25
11 Commandabilit
e et Observabilit
e dun syst`
eme
27
12 Commande modale
29
13 Observateurs d
eterministes
31
i
II
BUREAUX DETUDES
35
1 Mod
elisation dune cuve
37
Etude
dun quadrirotor
41
3 R
egulateur de distance dune voiture
47
4 Etude
dune automanette
51
III
ASSISTES
PAR ORDINATEUR
TRAVAUX DIRIGES
55
1 Initiation `
a MATLAB
57
2 Syst`
emes dordre un et deux
65
69
4 Dynamique lat
erale dun Boeing 747
75
5 Etude
dune automanette
81
85
89
8 Etude
dun moteur brushless
95
101
105
11 Observateur d
eterministe : application `
a lestimation de cap
111
117
IV
123
ARCHIVES
125
2 Contr
ole de la trajectoire dun avion
131
135
ii
Introduction
Ce recueil dexercices dautomatique illustrent les cours de methodes frequentielles.Il est
articule en quatre parties qui comportent :
Une serie de petits exercices reprenant chacune des notions abordee en cours.
Des bureaux detudes qui traitent de probl`emes dautomatique appliques `a des syst`emes
aeronautiques et spatiaux et qui seront abordes lors des seances de travaux diriges.
Les sujets des bureaux detudes qui traitent de syst`eme aeronautique et spatiaux et qui
seront simules avec le logiciel MATLAB lors des seances de travaux diriges assistes par
ordinateur.
Premi`
ere partie
EXERCICES DAPPLICATION
EXERCICE
On etudie le comportement dune voiture roulant sur le plat en ligne droite. On commande
cette voiture par le pourcentage denfoncement de la pedale daccelerateur et on observe sa
vitesse.
Initialement, la pedale est enfoncee de 40% et on roule `a 100km/h.
A un instant que lon prendra comme origine des temps, on appuie sur la pedale de 15%.
Levolution de la vitesse est representee par la figure 1.1
Step Response
130
120
Amplitude
110
100
90
80
70
5
10
15
20
25
Time (sec)
Question 2 :
Question 3 :
EXERCICE
Step Response
2.5
Amplitude
1.5
0.5
0
0
10
12
Time (sec)
Question 3 :
Calculer les p
oles du syst`eme et les placer dans le plan complexe.
Question 4 :
Question 5 :
resonance)
EXERCICE
Marges de stabilite
Nichols Chart
10
0
5
10
15
20
25
30
40
50
180
165
150
135
90
45
La figure 3.1 est le lieu de Black du syst`eme de fonction de transfert H(p) en boucle ouverte.
On ins`ere H(p) dans une boucle de regulation `a retour unitaire. Le correcteur est de type
proportionnel C(p) = K
9
H(p)
S(p)
Question 1 :
Question 3 :
10
EXERCICE
Precision
Le but de cet exercice est de pratiquer le calcul des erreurs en regime permanent.
On ne considerera que des entrees (consignes E ou perturbation B) en echelon damplitude
respectivement e0 et b0 .
Dans tout lexercice on notera E lerreur de suivi de la consigne `a perturbation nulle et B
lerreur de regulation en presence de perturbation.
1
Question 1 : Calculer E et B pour C(p) = K et H(p) = 2
p +p+4
Question 2 :
Question 3 :
Question 4 :
1
p(1 + 3p)
K
1
et H(p) =
p
1 + 3p
B(p)
E(p)
(p)
C(p)
11
S(p)
H(p)
Exercice 4. Pr
ecision
12
EXERCICE
E(p) +
2p2
1
dans une boucle dasser+ 3p + 1
H(p)
S(p)
Exercice 5. Pr
ecision Vs. Stabilit
e
Nichols Chart
10
20
30
40
50
60
70
180
135
90
45
Calculez cette erreur pour K = 1 et relevez graphiquement les marges de stabilite dans ce
cas.
Question 2 :
Retrouvez ce resultat sur les abaques de Nichols et determinez si le syst`eme en boucle fermee
est resonant. Que peut-on alors dire du facteur damortissement reduit ? En deduire lallure de
la reponse `
a un echelon unitaire.
La figure 5.3 redonne le lieu de la boucle ouverte non corrigee (K = 1) ainsi que celui de
la boucle ouverte corrigee avec le gain determine `a la question 2. On a aussi fait apparatre les
abaques de Nichols.
14
Nichols Chart
40
0 dB
0.25 dB
0.5 dB
1 dB
20
1 dB
3 dB
6 dB
3 dB
6 dB
12 dB
20 dB
20
40 dB
40
K=1
K = 19
60
60 dB
80
180
80 dB
0
135
90
45
15
Exercice 5. Pr
ecision Vs. Stabilit
e
16
EXERCICE
Lieu dEvans
E(p) +
H(p)
S(p)
Question 1 :
p+3
pour K > 0
p3 + 7p2 + 12p + 10
Question 2 :
Question 3 :
p3
6p2
1
et K > 0
+ 13p + 20
17
18
EXERCICE
Correction proportionnelle
On cherche `
a commander par un correcteur `a simple gain C un syst`eme dont la fonction de
transfert en boucle ouverte est donnee sur le diagramme de Black (Figure 7.1). Le syst`eme est
`a retour unitaire.
Nichols Chart
20
0
20
40
60
80
100
120
140
160
270
225
180
135
90
45
Question 1 :
Question 2 :
Question 3 :
Question 4 :
Calculez le gain K2 quil faut choisir pour assurer une marge de phase de 45 .
Tracez sur la meme figure lallure des reponses indicielles unitaires en boucle fermee
pour les deux gains K1 et K2 .
Question 5 :
Quelle est la precision maximale que peut atteindre ce syst`eme avec un correcteur
proportionnel ?
Question 6 :
20
EXERCICE
On cherche `
a commander un syst`eme dont la fonction de transfert est donnee sur le lieu de
Black (Figure 8.1). Ce syst`eme est insere dans une boucle dasservissement avec retour unitaire
et munie d un correcteur. Le correcteur sera note C(p).
Nichols Chart
40
0 dB
0.25 dB
0.5 dB
1 dB
3 dB
6 dB
20
1 dB
3 dB
6 dB
12 dB
20
20 dB
40
40 dB
60
60 dB
80
80 dB
100
100 dB
120
360
315
270
225
180
135
90
45
120 dB
0
Question 1 :
21
22
EXERCICE
On cherche `
a commander un syst`eme dont la fonction de transfert en boucle ouverte est
donnee sur le diagramme de Black (Figure 9.1) en linserant dans une boucle de regulation
avec un correcteur C(p). La commande reellement appliquee au syst`eme est celle donnee par le
correcteur `
a laquelle sajoute une perturbation B(p).
Nichols Chart
40
20
System: bo
Gain (dB): 0.699
20
Phase (deg): 180
Frequency (rad/sec): 36.2
40
60
80
100
120
140
160
270
225
180
135
90
45
Question 1 :
Question 2 :
Question 4 :
Question 5 :
pente unite.
En conservant le param`
e`
a la question 3, calculez le gain K tel que le syst`eme
i donn
etre T
1
corrige par C (p) = K 1 +
ait une erreur de tranage de 14 pour une entree en rampe
Ti p
de pente unite.
Quelle performance a-t-on degradee en ameliorant ainsi la precision ?
Tracez sur une meme figure lentree en rampe ainsi que les reponses du syst`eme
corrige par C(p) et C (p)
La consigne donnee en entree du syst`eme asservi est en forme de dents de scie de periode
400 s.
Deduire qualitativement de votre figure precedente lallure de la sortie pour le syst`eme corrige
par les deux correcteurs.
Question 6 :
24
EXERCICE
10
dy
= x2 et on adopte comme vecteur detat :
dt
X = [x1 , x2 ]T
u est la commande et U designe le vecteur de commande. Dautre part, seul letat x1 est
mesure et on appelle Y le vecteur de mesure.
Donnez une representation detat compl`ete du syst`eme , i.e. une equation detat
et une equation dobservation.
Question 1 :
Question 2 :
Calculer le polyn
ome caracteristique de la matrice detat, en deduire les p
oles du
syst`eme .
Question 3 :
ce syst`eme.
Question 4 :
Y (p)
du syst`eme .
U (p)
Changement de base
Question 5 :
25
Int
egration de l
equation d
etat
T
A linstant initial t = 0, letat X(0) = 0 1 , la commande u(t) est nulle pour
tout t, autrement dit, le syst`eme fonctionne en regime libre. En utilisant la representation detat
sous forme diagonale, integrez lequation detat et montrez que le regime libre sexprime comme
une combinaison lineaire des modes.
Question 7 :
26
EXERCICE
11
Consid
erations sur l
equation d
etat
On cherche `
a exploiter la structure des matrices de commande B du mod`ele lateral dun
avion en vue devaluer les effets des commandes sur les etats. Soit lequation detat de lavion :
A Ar Ap A
Bl Bn
!
r A
0
r Brl Brn l
r Arr Arp
+
=
p Ap Apr App
0 p Bpl Bpn n
0
0
1
0
0
0
Question 2 :
Commandabilit
e
Soit lequation detat du syst`eme du second ordre :
!
!
!
x1
0 2
x 1
+
=
x2
1 3
x 2
!
1
u
1
On se propose dans un premier temps detablir si ce syst`eme est commandable ou non de deux
mani`eres differentes.
On admet (vous pourrez le verifier pour vous exercer) que le syst`eme admet dans la base
diagonale lequation detat suivante :
!
!
!
!
0
1 0
z1
z1
+ u
=
z2
0 2
z2
2
27
!
1.265 1
0.6325 1
Question 3 :
Question 4 :
Observabilit
e
La sortie mesuree a pour expression y = x1 + x2
Question 5 :
Question 6 :
de letat z2 .
Ce syst`eme non-commandable et non-observable presente-t-il pour autant des
risques lors de son utilisation ?
Question 7 :
28
EXERCICE
12
Commande modale
Soit le syst`eme precedemment etudie dans lexercice consacre `a la mise sous forme de
representation detat dun syst`eme et pour lequel on adopte comme vecteur detat X = [x1 , x2 ]T ,
u est la commande et U le vecteur de commande. Par ailleurs, tout letat est mesure et Y est le
vecteur de mesure.
Lequation detat :
!
!
!
!
0
x1
0 1
x 1
u
+
=
1
x2
1 0
x 2
Lequation dobservation :
y1
y2
!
!
1 0
x1
+
x2
0 1
!
0
u
0
On a vu que ce syst`eme avait un comportement astable i.e. pulsation propre non amortie n =
1rad/s et = 0. On desire donc apr`es correction par retour detat lui conferer le comportement
suivant :
facteur damortissement = 0.5,
pulsation propre non-amortie n = 2rad/s,
gain statique unitaire.
En prealable `
a la mise en uvre dune loi de commande, quelle propriete du syst`eme
doit etre imperativement etablie ?
Question 1 :
Commande modale
Representer le schema du syst`eme muni de sa commande par retour detat et du
gain de precompensation. Quelle sont les dimensions des matrices de contre-reaction K et de
precompensation H. Precisez la structure de ces deux matrices.
Question 3 :
29
30
EXERCICE
13
Observateurs deterministes
Th
eorie des observateurs
La connaissance quon a du syst`eme etudie lest au moyen de la representation detat suivante :
X = AX + BU
Y
(13.1)
= CX
o`
u le vecteur detat du syst`eme X Rn , la commande U Rm et la mesure Y Rs , ici on
suppose quil y a moins de grandeurs mesurees que de variables detat et n > s.
Il faut bien avoir `
a lesprit que ces equations representent seulement un mod`ele du syst`eme
qui rend compte de mani`ere imparfaite dune realite souvent plus complexe.
Par ailleurs, certains etats sont inaccessibles `a la mesure, par consequent il nest pas possible
de disposer dinformations `
a leur sujet. Neanmoins, leur connaissance nen nest pas moins utile.
Cest linteret dun observateur, sous reserve que le syst`eme soit observable, de permettre de
generer une estimation de ces etats.
Lobservateur, `
a linstar du syst`eme (13.1) est un syst`eme dynamique qui, dune mani`ere
generale est decrit par les equations suivantes :
= F X
+ GU + LY
X
(13.2)
= X X
Rn et Rn est appelee lerreur.
o`
u le vecteur detat de lobservateur est X
31
lon a de letat initial est donnee par X(0) qui diff`ere de letat initial reel inconnu X(0).
Question 4 :
Quelles conditions doivent remplir les valeurs propres de la matrice detat pour que lerreur
converge vers 0 ?
Lerreur est-elle une grandeur physiquement accessible ?
En prealable `
a la mise en uvre dun observateur, quelle propriete du syst`eme doit
etre imperativement etablie ?
Question 5 :
pcom , pcom = {1 + i 3, 1 i 3}
Question 7 :
Un observateur est en fait un filtre lineaire qui peut etre caracterise par sa matrice de
fonctions de transfert. On se propose detablir cette matrice.
En reprenant les resultats etablis `
a la question 3, calculez les transformees de
Laplace des equations du syst`eme et de lobservateur. En deduire une expression qui lie X(p)
a
`
U (p) et Y (p).
Question 9 :
32
Question 10 :
33
34
Deuxi`
eme partie
BUREAUX DETUDES
35
BE
1.1
Etude
dune cuve
On se propose dans cet exercice detablir le mod`ele dune cuve representee sur la figure 1.1.
Une electrovanne permet de controler de debit Qe `a lentree, Qs designe le debit en sortie. La
surface de la cuve est notee S et H designe le niveau de liquide quon souhaite controler.
Qe
Qs
Figure 1.1 La cuve etudiee
Question 1 :
1.2
Etude en r
egime statique
H
Qs =
R
o`
u R designe la resistance hydraulique.
37
(1.1)
BE 1. Mod
elisation dune cuve
Question 2 :
dequilibre ?
La cuve est initialement vide et on r`egle Qe de sorte que Qe > Qs , lorsque le niveau H a
atteint la hauteur desiree, on r`egle Qe pour maintenir H constant.
Question 3 :
Exprimez H en fonction de Qe .
Question 4 :
{Qe0 , H0 }.
Question 5 :
1.3
Etude dynamique
Question 8 :
h(0 )
Question 9 :
de h(t).
Calculez h(t) la hauteur de liquide dans la cuve en regime permanent, comparez
cette hauteur `
a sa veritable valeur (censee etre donnee par (1.1). Expliquez la difference.
Question 10 :
1.4
La figure 1.2 montre les resultats des essais dune servocommande soumise `a un signal sinusodal de pulsation et damplitude unitaire, le signal de commande est represente par un trait
continu. Lanalyse de la reponse, trait discontinu, doit permettre detablir un mod`ele simple de
ce syst`eme.
Question 1 :
Relever les pulsations des signaux auxquelles cette servocommande a ete soumise.
Question 2 :
38
Ebauchez
lallure de la reponse `
a un echelon unitaire de cette servocommande.
39
BE 1. Mod
elisation dune cuve
Amplitude
System: sys
Time (sec): 78.5
Amplitude: 4
System: sys
Time (sec): 141
Amplitude: 4
5
0
Amplitude
20
40
60 sys 80
System:
Time (sec): 16
Amplitude: 4.01
100
(sec)
160
180
200
5
0
5
10
15
System: sys
Time (sec): 2.18
Amplitude: 4.61
Amplitude
20
25
System:
sys 30
Time (sec): 3.75
(sec)
Amplitude: 4.61
Input: In(1)
Time (sec): 3.06
Amplitude: 0.309
35
40
0
5
0.5
1.5
2.5
X: 1.483
(sec)
Y: 0.3893
1.1
1.2
1.3
System: sys
Time (sec): 3.36
3.5
4
4.5
Amplitude: 0.0166
X: 1.8
Y: 0.3686
0
1
0.9
1
1.4
1.5
1.6
1.7
1.8
1.9
X: 2.157
Y: 0.08989
0
X: 2.314
Y: 0.09061
1
1.8
1.9
2.1
2.2
40
2.3
2.4
2.5
BE
Etude
dun quadrirotor
2.1
Description du syst`
eme
Le but de ce TD est de degager des hypoth`eses visant `a simplifier letude dun syst`eme
complexe, de le modeliser pour ensuite le commander. Le syst`eme etudie est un aeronef `a voilure
tournante appele quadrirotor et represente sur la figure 2.1. La structure de ce quadrirotor est
motor 1 + propeller 1
1
motor 2+propeller 2
~xb
~yb
3
motor 3+ propeller 3
Figure 2.1 Vue de dessus du quadrirotor
supposee rigide, de masse m constante et le centre de gravite est fixe. Soit RE = (O,
x
E , yE , zE ),
la terre. Le vecteur
= (x, y, z)T rep`ere la position du centre de gravite du drone dans RE .
BE 2.
Etude
dun quadrirotor
2.2
Hypoth`
eses de travail
Continuit
e, Invariance
Le mod`ele du quadrirotor est obtenu en ecrivant la relation fondamentale de la dynamique, le
theor`eme du moment cinetique et les relations cinematiques. Seules les equations utiles `a letude
de ce syst`eme seront detaillees.
Question 2 :
Lin
earisation du mod`
ele
Lequation qui suit proc`ede de la relation fondamentale de la dynamique, g designe lacceleration de pesanteur :
w = pv + qu + gcoscos
k1 (21 + 22 + 23 + 24 )
m
A levidence, cette seule equation montre que le quadrirotor nest pas un syst`eme lineaire.
42
Question 3 :
Lin
earisation
o`
u IT est le moment dinertie autour de laxe de tangage.
Pour le point dequilibre defini precedemment, linearisez les equations des derivees
temporelles du tangage et de lassiette. On note e , qe , e les valeurs a
` lequilibre de , q, et
= e +
, q, les variations de ces variables autour de lequilibre de sorte que : = e + ,
and q = qe + q
Question 4 :
2.3
1
3 e la transformee de Laplace de la commande du moment
(s) = 2k2
On pose M
de tangage, linearisee et obtenue pour de petites variations de la vitesse des helices autour de
leur valeur dequilibre.
(s). Vous
Ecrivez lexpression Laplacienne liant la fonction de transfert (s)
a
`M
prendrez soin dexprimer les conditions initiales que vous distinguerez des conditions dequilibre.
Question 5 :
(s)
la fonction de transfert du quadrirotor pour laxe de
(s)
M
tangage et proposez un schema fonctionnel.
Question 6 :
Question 7 :
Etablissez H(s) =
Question 9 :
43
BE 2.
2.4
Etude
dun quadrirotor
Intoduction `
a la commande
En mecanique generale, et pour des syst`emes en rotation, il est dusage de decrire un moment
de rappel par le produit dun coefficient de raideur par un angle. De meme, un moment de
frottements visqueux est decrit par le produit dun coefficient de frottement par une vitesse
angulaire. Or, lassiette et le tangage q sont mesures ; si lon exploite ces mesures pour generer
la loi de commande, il sera possible dintroduire des moments de rappel et de frottement visqueux
qui permettront de stabiliser le quadrirotor. Le schema fonctionnel du quadrirotor muni dune
telle loi de commande est represente sur la figure 2.2, m correspond `a la commande en tangage
appliquee par le pilote. Sur ce meme schema, Kq et K sont des gains reglables.
m
-+ M
1
IT
1
s
1
s
Kq
K
Figure 2.2 Le schema fonctionnel du drone muni dune commande en tangage
= f (,
M
a m (s).
`
Question 10 :
Question 12 :
Sur quel gain et comment agir sur ce gain pour conferer au quadrirotor une plus grande
precision ( ici laptitude du quadrirotor `
a rester le plus proche de sa position dequilibre
en presence de perturbations). Quelle performance serait en contrepartie degradee ?
Proposez une valeur du facteur damortissement reduit et le reglage des gains afferents
(en fait, une relation entre Kq et K ) pour que le quadrirotor, ecarte de sa position
dequilibre, y revienne le plus rapidement possible.
On donne IT = 7.5.103 kg.m2 et on augmente les gains K et Kq tout en
realisant sur ces gains la contrainte
etablie `
a la question precedente i.e. maintenir un facteur
2
. Rappelez lexpression de la pulsation propre non-amortie n et
damortissement reduit =
2
representez dans le plan complexe le lieu des p
oles parametre en K .
Question 13 :
44
2.4. Intoduction `
a la commande
Un sous-syst`eme groupe propulsif compose de lensemble {moteur, reducteur,helice} peut
etre decrit par un syst`eme du premier ordre de fonction de transfert :
i (s)
40
=
Ui (s)
0.01s + 1
O`
u i est la vitesse de rotation du moteur i et ui (t) est la tension de commande de ce moteur.
Le quadrirotor est correctement commande si le groupe propulsif reagit plus rapidement aux
variations de la tension de commande que langle de tangage aux variations de la commande en
tangage.
Sur la carte des p
oles tracee `
a la question precedente, portez le p
ole du soussyst`eme et indiquez les regions du plan complexe correspondant `
a des reglages admissibles/inadmissibles pour K .
Question 14 :
45
BE 2.
46
Etude
dun quadrirotor
BE
On suppose disposer `
a bord dune voiture dun dispositif permettant de mesurer la distance
qui la separe de la voiture qui la prec`ede. On se propose detudier la regulation de cette distance.
3.1
Mod
elisation
Mod
elisation de la voiture
Une voiture roule en ligne droite, sur le plat `a Veq = 130 km/h pour une commande des
gaz egale `
a la demi-ouverture de ladmission en carburant. On note cette commande des gaz `
a
lequilibre Xeq = 50.
On notera v et x les ecarts aux valeurs `a lequilibre.
La figure 3.1 represente laccroissement de vitesse (en km/h) v consecutive `a un accroissement
de commande x = 1.
47
BE 3. R
egulateur de distance dune voiture
131.2
131
Vitesse (km/h)
130.8
130.6
130.4
130.2
130
10
20
30
Temps (s)
40
50
60
Mod
elisation des deux voitures
On poursuit un vehicule qui se trouve initialement `a la distance d0 . On appellera cible le
vehicule poursuivi.
On note vc une variation de la vitesse de la cible.
Completer le schema de la figure 3.2 (on rappelle que les vitesses sont exprimees
en km/h). Preciser la nature des deux entrees.
Question 2 :
V c ib le
x
d (m )
V o itu re " c h a s s e u r"
48
3.2. Commande
Question 3 :
d(p)
d(p)
et G(p) =
.
x(p)
vc (p)
3.2
Commande
Question 5 :
Commande proportionnelle
On commence par envisager une commande proportionnelle : C(p) = K
Question 6 : Par un simple raisonnement qualitatif, quel doit
etre le signe de K pour que le
syst`eme soit stable ? Esquisser lallure du lieu de Black de KF (p) lorsque K = 1.
Question 7 :
d(p)
en fonction de K.
dc (p)
Pour cette question, la cible roule `
a la vitesse dequilibre, autrement dit vcible = 0.
Question 8 :
Question 9 :
Decrire lallure de la reponse indicielle en boucle fermee pour des valeurs croissantes de |K| pour le signe de K assurant la stabilite.
Question 10 :
Question 11 :
Question 12 :
Attention `
a lapplication des formules du cours, elles ne sappliquent qu`a lun des deux cas...
Dans le doute il est conseille de calculer directement les erreurs.
49
BE 3. R
egulateur de distance dune voiture
Application numerique : on chercher `
a asservir la distance a
` 50m, le vehicule
poursuivi accel`ere de 5 km/h, calculer pour quels gains K la precision est superieure a
` 10 %
Question 13 :
50
BE
Etude
dune automanette
Pr
esentation
Lautomanette est une commande automatique de la chane des gaz dun avion. Son but
est dajuster la commande des gaz donnee au moteur afin de maintenir constante la vitesse
longitudinale par rapport `
a lair de lappareil. Elle necessite une centrale anemometrique pour
la mesure de la vitesse relative Va .
Le diagramme fonctionnel de lautomanette que lon a simplifie en negligeant la tranee est
donne ci-dessous :
(p)
mg
Uc (p) +
Ua (p)
600
1 + 2p
F +
Vw (p)
Vs
1
mp
+
Va (p)
Notations
Uc
Ua
Va
Vs
Vw
m
g
Variation pente
Vitesse vent/sol
Masse de lavion (8160 kg)
Pesanteur (10 m/s2 )
BE 4. Etude
dune automanette
4.1
Correction proportionnelle
R
eponse `
a une consigne
Question 1 :
Ua (p)
en absence de perturbations,
(p)
cest-`
a-dire lorsque = Vw = 0.
Question 2 :
Va (p)
, les perturbations etant toutes nulles.
Uc (p)
R
eponse aux perturbations
Va (p)
representant la reponse en vitesse a
`
(p)
une variation de pente. Deduisez-en lim Va (t) lorsque est un echelon damplitude 0 =
Question 7 :
Va (p)
representant la reponse de lavion a
` une
Vw (p)
4.2
Correction proportionnelle-int
egrale
On envisage maintenant un
correcteur
proportionnel-integral. On remplace donc K par un
1
bloc de fonction de transfert K 1 +
.
Ti p
52
4.3. Correction `
a avance de phase
Justifiez sans calcul pourquoi ce type de correcteur permet dannuler les erreurs
statiques dues aux perturbations.
Question 9 :
Question 10 :
On choisit le param`etre Ti =
10
(avec n la pulsation propre non amortie du
n
40
0 dB
0.25 dB
0.5 dB
1 dB
20
1 dB
3 dB
6 dB
3 dB
6 dB
12 dB
20 dB
20
40
System: BO
Gain (dB): 20
Phase (deg): 155
Frequency (rad/sec): 1.08
40 dB
60 dB
60
80
180
135
90
45
80 dB
0
4.3
Correction `
a avance de phase
Une alternative au correcteur proportionnel-integral qui annule les erreurs est daugmenter
le gain K pour les ramener `
a des valeurs acceptables.
En reconsiderant `
a nouveau un correcteur purement proportionnel, quel gain
faudrait-il choisir pour diminuer toutes les erreurs statiques dun facteur 10 ? Determinez
graphiquement les nouvelles marges de stabilite en boucle fermee.
Question 11 :
Question 12 :
53
BE 4. Etude
dune automanette
Qua-t-on cherche `
a faire avec ce reglage sortant la F T BO du contour a
` 0 dB en
boucle fermee ?
Question 13 :
54
Troisi`
eme partie
ASSISTES
TRAVAUX DIRIGES
PAR ORDINATEUR
55
TDAO
Initiation `a MATLAB
Cette seance `
a pour but de vous familiariser `a lutilisation du logiciel de calcul MATLAB,
et plus particuli`erement `
a lutilisation de ses fonctions dediees `a lautomatique.
On demarre MATLAB en double cliquant sur licone MATLAB presente sur le bureau de
Windows
Les commandes qui vont etre utilisees peuvent etre saisies `a partir de la fenetre Command
Window de MATLAB ou mieux, dans un fichier cree dans lediteur de texte accessible depuis
File New Script.
57
TDAO 1. Initiation `
a MATLAB
1.1
Travaux
el
ementaires sur les matrices
Tous les objets manipules par MATLAB peuvent etre consideres comme des matrices. La
matrice :
!
valeur1 valeur2 valeur3
A=
valeur4 valeur5 valeur6
est definie sous MATLAB comme suit : A= [ valeur1 valeur 2 valeur3 ; valeur4 valeur5 valeur6 ]
Un espace ou une virgule separe deux elements dune meme ligne et le point virgule indique la
separation de ligne.
2 3 1
1. B = A + A
2. C = A2 ainsi que D = A. A puis comparer le resultat de C `a celui de D
3. inverse dune matrice : inv(A)
4. transposee de la matrice A : A
5. calculer le determinant de A : det(A)
6. determiner les valeurs propres et les vecteurs propres de A (consultez laide en ligne de
la fonction eig en ecrivant help nom de la fonction, ici help eig
7. trouver le rang de la matrice A, fonction rank,
8. saisir la matrice I3 , fonction eye
9. concatenation horizontale de A et B soit : [A, B]
10. concatenation verticale de A et B soit [A; B]
11. extraction du terme de la premi`ere ligne, troisi`eme colonne de A : A(1, 3)
12. extraction de la troisi`eme ligne de A : A(3, :)
13. extraire la deuxi`eme colonne de A
1.2
Les polyn
omes
58
1.3
La fonction de transfert qui caracterise un syst`eme est un objet defini de la facon suivante :
system=tf(num,den) o`
u num et den sont les polyn
omes apparaissant au numerateur et au denominateur.
Lanalyse dun syst`eme decrit par une fonction de transfert est menee au moyen de la fonction
ltiview.
8
1. saisissez la fonction de transfert suivante : H(p) = 2
p + 4p + 4
2. depuis le Command Window ou depuis votre script, executez ltiview, une fenetre souvre,
3. cliquez sur file import, une fenetre souvre, selectionnez lobjet system puis validez en
cliquant sur le bouton OK,
4. la reponse indicielle appararat,
clic droit plot types, vous pouvez afficher les reponses indicielles, impulsionnelles,
a des conditions initiales, le diagramme de Bode, le lieu de Black-Nichols, la carte des
`
poles et des zeros, etc.
apr`es avoir choisi une representation, clic droit characteristics, permet dafficher les
caracteristiques de la reponse choisie : temps de reponse (settling time 2 ), depassement
(peak response), permanent (steady state), etc. pour une reponse indicielle.
5. visualisez la reponse indicielle et le diagramme de Bode du syst`eme decrit par H(p),
relevez sur chacune de ces representations les caracteristiques et comparez-les `a celles
attendues en utilisant les abaques du cours sur les syst`emes dordre deux,
6. visualisez la carte des poles et des zeros, cliquez droit et activez loption grid, lire les
valeurs du facteur damortissement reduit et de la pulsation propre non amortie de H(p).
1.4
Synth`
ese de lois de commande pour les syst`
emes monovariable
A linstar de ltiview qui permet danalyser les performances dun syst`eme au travers de
letude des caracteristiques de sa reponse, sisotool est un programme qui facilite la synth`ese
de lois de commande et levaluation des performances des syst`emes asservis munis de ces lois
de commande. On souhaite mettre en uvre une correction proportionnelle pour le syst`eme
represente sur la figure 1.2. La fonction de transfert H(p) etudiee est celle qui a ete definie dans
la partie precedente.
2. Par defaut, sur MATLAB, le temps de reponse est defini `
a 2%, il convient de modifier cette valeur en faisant
clic droit properties options
59
TDAO 1. Initiation `
a MATLAB
E(p) +
H(p)
S(p)
1. depuis le Command Window, tapez et executez sisotool, une fenetre souvre. La conception de la loi de commande et levaluation des performances du syst`eme ainsi corrige
sop`erent en ouvrant successivement les onglets de la gauche vers la droite.
2. Longlet Architecture permet de definir la structure de la boucle `a controler et les valeurs
des differentes fonctions de transfert.
bouton Control Architecture : verifiez que la structure selectionnee est celle desiree,
relevez sur le schema le nom des variables utilisees pour definir les fonctions de transfert et les signaux.
bouton System Data : allouez les fonctions de transfert dans les champs prevus `a cet
effet de sorte que la structure de la boucle proposee par sisotool soit coherente avec
celle representee sur la figure 1.2. A ce stade le correcteur C = 1. Le bouton Browse
permet dimporter dans sisotool les fonctions de transfert declarees dans MATLAB.
3. Longlet Compensator Editor : C represente le gain statique du correcteur, soit K pour
le syst`eme etudie. A ce stade, laissez C = 1.
Notez quil est possible de synthetiser des correcteurs plus sophistiques en ajoutant des
poles et des zeros.
4. onglet Graphical Tuning : dans ce menu, vous choisissez le type de graphique utilise pour
la synth`ese du correcteur, la plupart du temps nous utiliserons le lieu des racines et le
lieu de Black-Nichols.
plot1 : choisissez root locus
plot2 : choisissez nichols
Cliquez ensuite sur le bouton Show design plot. Pour les differents graphiques, cliquez
droit grid.
5. onglet Analysis Plot : pour afficher une reponse indicielle correspondant au reglage effectue :
selectionnez Plot type : step
cochez closed loop r to y
bouton Analysis plot
Pour le reglage du correcteur, sous longlet Graphical tuning, deplacez avec la souris les
poles sur le lieu des racines pour leur donner la configuration souhaitee ou translater le lieu de
60
1.5. Simulink
Black-Nichols jusqu`a par exemple atteindre la marge de phase desiree. Il faut ensuite lire dans
longlet Compensator editor la valeur de C ayant permis ce reglage.
Synthetisez un correcteur proportionnel qui conf`ere `a la boucle dasservissement un gain `
a
la resonance en boucle fermee de 0dB, et observez les caracteristiques de la reponse indicielle du
syst`eme ainsi controle.
1.5
Simulink
Pratiquement, le mod`ele de synth`ese represente par une fonction de transfert permet lanalyse
et le dimensionement dune loi de commande. Ces etudes ont ete menees dans les sections
precedentes au moyen de ltiview et sisotool.
Il convient ensuite de valider les resultats obtenus au travers de simulations sur un mod`ele plus representatif de la realite. SIMULINK est un utilitaire de MATLAB qui permet la
simulation temporelle des syst`emes dynamiques. Le mod`ele du syst`eme etudie est represente
graphiquement en interconnectant des fonctions contenues dans des biblioth`eques.
On souhaite simuler le syst`eme controle par la loi de commande etablie `a la section precedente
et represente sur la figure 1.4.
61
TDAO 1. Initiation `
a MATLAB
SIMULINK est execute `
a partir du Command Window de MATLAB en cliquant sur le
bouton
Une fenetre intitulee Simulink Library Browser souvre, elle est composee dune distribution
de biblioth`eques sous forme dic
ones.
Il faut ensuite ouvrir une fenetre dans laquelle vous construirez votre mod`ele : File New
Model. Vous trouverez les fonctions utiles `
a la realisation de ce schema dans les biblioth`eques
suivantes :
fonction
transfer function, integrator
Sommateur, Product, Gain, (.2 )
Step
Scope
Mux
rate limiter
Biblioth`eques
Continuous
Math Operations
Sources
Sinks
Signal Routing
Discontinuities
Il faut ensuite double-cliquer sur chaque bloc pour le parametrer, `a linstar des echelons de
consigne :
Step Time
Initial Value
Final Value
Sample Time
0
0
0.1, 0.35, 1
0
ou du rate limiter qui permet dintroduire une non linearite dans le mod`ele de simulation :
Rising slew rate
Falling slew rate
2
-2
1.5. Simulink
La commande plot(out( :,1),out( :,2)) permet dafficher le premier signal.
63
TDAO 1. Initiation `
a MATLAB
64
TDAO
Le but de ce TDAO est la familiarisation avec le logiciel Matlab, en particulier les commandes
utiles en Automatique ainsi que lapprofondissement des connaissances vues en cours et lors des
exercices sur papier.
2.1
Question 1 :
2 (p)
2
= 2
Tc (p)
p + 0, 04p + 1
Question 2 :
TDAO 2. Syst`
emes dordre un et deux
Question 3 :
Pour cela, executez ltiview dans la fenetre de commande ou le programme en .m. Importez
le syst`eme (File Import)
2.2
On note langle entre laxe dun satellite et la droite reliant le centre de gravite du satellite
au centre de la Terre.
Le satellite est commande par une roue a` reaction qui lui transmet un couple de commande
Cm .
Le gradient de gravite exerce sur le satellite un couple de rappel elastique k et la pression
(2.1)
Donnees numeriques :
Ipf
= 0, 5 kg.m2
k = 20 N.m
f
= 1, 25 N.m.s
Mod
elisation
Completez le schema de la figure 2.1 pour quil modelise le syst`eme decrit.
Ouvrez une page Simulink, construisez et simulez le schema. On mettra une entree Cm en
echelon et on visualisera la sortie .
Question 1 :
2.3. Identification
Cm
+ I
pf
2.3
Identification
Lobjet de cet exercice est de retrouver la fonction de transfert des syst`emes inconnus contenus dans le fichier identification.mdl `a partir dessais bien choisis.
Syst`
emes simples
Copiez le syst`eme inconnu 1 dans une nouvelle page, visualisez la reponse indicielle,
relevez ses caracteristiques et deduisez-en les coefficients de la fonction de transfert.
Validez vos resultats en visualisant sur un meme Scope la sortir du syst`eme inconnu et celle
de votre solution.
Question 1 :
TDAO 2. Syst`
emes dordre un et deux
routing.
Question 2 :
Syst`
eme plus complexe
Realisez un essai indiciel sur le syst`eme inconnu 3 et relevez le gain statique.
Que peut-on dire de lordre du syst`eme ? ( i.e. du degre du denominateur de la fonction de
transfert )
Kn2
Peut-on modeliser ce syst`eme une fonction de transfert du type 2
? Pourquoi ?
p + 2n p + n2
Question 3 :
1
< n
Kn2 (1 + p)
avec
p2 + 2n p + n2
Question 5 :
Question 6 :
(rad/s)
En deduire les valeurs de et n
Question 7 :
68
TDAO
motor 1 + propeller 1
1
motor 2+propeller 2
~xb
~yb
motor 3+ propeller 3
Figure 3.1 A gauche, vue shematique dun quadrirotor. A droite, le U130 de Novadem
3.1
Mod`
ele de simulation du quadrirotor
Dans cette premi`ere partie, vous allez representer sous la forme dun schema fonctionnel les
equations des forces et des moments produits par les helices du quadrirotor ; puis vous implementerez ce schema sous SIMULINK au moyen des composants fournis dans les biblioth`eques de
ce logiciel.
Sur papier, donnez un shema fonctionnel des equations de la poussee, des moments
de roulis, de tangage et de lacet produits par les vitesses de rotation des helices.
Question 1 :
Question 2 :
3.2. Mod`
ele de synth`
ese
Blocs utiles
Sommateur, Product, Gain,
Input
Output
Biblioth`eques
Math Operations
Sources
Sinks
Ouvrez le fichier Model quadrotor.mdl et completez-le avec le sous-syst`eme generant la force de poussee et les moments produits par les helices. Il peut
etre n
ecessaire de
recompiler lun des fichiers constitutifs de ce sch
ema, pour cela suivez la proc
edure
indiqu
ee dans le fichier LisezMoi.txt archiv
e dans le dossier Fichiers Matlab/TDAO3. Ce mod`ele est un mod`ele de simulation du quadrirotor. Appliquez aux entrees de ce
sous-syst`eme des echelons (bloc Step dans Sources) qui simulent les vitesses de rotation. Calculez |e | la valeur absolue de la vitesse de rotation des helices `
a lequilibre puis param`etrez le bloc
Step en le double-cliquant :
Question 3 :
Step Time
Initial Value
Final Value
Sample Time
0
0
e
0
Lancez la simulation sur un horizon de 10s, constatez que vous avez bien atteint un equilibre
en observant les angles dattitude et laltitude du quadrirotor.
3.2
Mod`
ele de synth`
ese
Vous
allez, dapr`
es une simulation, identifiez un mod`ele de synth`ese du quadrirotor. On pose
1
3 e le moment de tangage linearise et obtenu pour de petites variations de
= 2bl
M
autour de e , cf. TD1). Vous allez identifier la fonction de transfert qui
la vitesse des helices
lie M(s) `
a (s),
de petites variations de lassiette autour de lassiette dequilibre.
71
(s)
puis
.
(s)
M
Comparez la fonction de transfert ainsi identifiee `
a celle trouvee lors du TD.
Question 4 :
MATLAB dispose doutils pour letude des performances et le trace des reponses temporelles,
diagrammes et lieux frequentiels des syst`emes lineaires invariants continus.
Depuis la fenetre de commande Windows ou `
a la suite du progamme .m, saisissez
la fonction de transfert identifiee infra.
Question 5 :
(s)
Pole/Zero, pour le trace des p
oles () et des zeros () de
.
(s)
M
3.3
Introduction `
a la commande
Autour de laxe de tangage, le quadrirotor nest pas stable. Soumis `a une entree de commande
dont lamplitude et la duree sont bornees, la reponse ne revient pas `a lequilibre. On se propose
detudier une loi de commande qui permette de stabiliser le quadrirotor tout en controlant le
temps de reponse et lamortissement. Cette commande est etudiee avec le mod`ele de synth`ese
puis implementee sur le mod`ele de simulation. On ne sinteressera dans la suite quau controle
de lattitude du quadrirotor, les effets des forces dues `a laction de pesanteur et aux helices ne
sont pas pris en compte. Reprenez les resultats etablis `a la question 10 du TD et en particulier
la fonction de transfert du quadrirotor corrige.
72
3.3. Introduction `
a la commande
Ouvrez une nouvelle feuille de travail sous SIMULINK puis, au moyen de deux
integrateurs et dun gain, representez le mod`ele de synth`ese du quadrirotor. Prevoyez une entree
de commande m (le moment de tangage) et deux sorties pour visualiser et q. Encapsulez ce
schema dans un Subsystem et pensez `
a le sauvegarder.
Question 6 :
Blocs utiles
Sommateur, Gain,
Integrator
Input
Output
Question 7 :
Biblioth`eques
Math Operations
Continuous
Sources
Sinks
m qui represente la commande de laxe de tangage realisee par exemple au moyen dune radiocommande sera modelise par un echelon unitaire. Vous param`etrerez les gains K et Kq de sorte
quautour de laxe de tangage, le quadrirotor se comporte
comme un syst`eme du second ordre
2
dont le facteur damortissement reduit est egal `
a
et le temps de reponse inferieur a
` 0, 5s.
2
q et M .
Inserez trois oscilloscopes pour mesurer ,
Blocs utiles
Sommateur, Gain,
Step
Scope
Biblioth`eques
Math Operations
Sources
Sinks
Question 8 :
Question 9 :
74
TDAO
4.1
Amortisseur de lacet
d l < 0
p > 0
r> 0
d n < 0
x a
b > 0
f > 0
y
z h
Figure 4.1 Angles et vitesses de la dynamique laterale : Gte et roulis p - Derapage et lacet r
Question 3 : Comment justifiez-vous le fait que la fonction de transfert saisie soit du quatri`
eme
ordre alors que la simulation montre quun troisi`eme ordre suffit `
a caracteriser la dynamique
laterale de lavion ?
En vous aidant de Q
la carte des p
oles et des zeros, mettez la fonction de transfert
(p zi )
.
sous la forme p
oles-zeros i.e. K Q
(p pj )
Question 4 :
R
egulation du lacet
Les essais precedents montrent qu`
a levidence lavion nest pas suffisamment amorti.
Une solution `a cette situation pourrait consister `a modifier la geometrie de lavion pour
le rendre moins oscillant. Ce reglage nest pas realisable en pratique. On montre en effet en
mecanique du vol que le facteur damortissement reduit est proportionnel `a la racine carre de
la surface de la derive ainsi qu`
a la distance entre le centre de gravite et la derive. Le facteur
damortissement etant naturellement tr`es faible, le diminuer convenablement par la geometrie
de lavion conduirait `
a en augmenter.
On pref`ere introduire une loi de commande de la gouverne de direction n qui contre le
mouvement de lacet. Ce dispositif constitue un amortisseur de lacet.
On suppose pour les questions qui suivent que le capteur (gyrom`etre) restitue une mesure
76
Question 5 :
Les r`egles de construction vues en cours sont insuffisantes pour tracer compl`etement les lieux
dEvans `a la main (il faudrait notamment les angles de depart et darrivee).
Affichez avec sisotool le lieu dEvans pour C > 0 puis pour C < 0. Que peut-on
dire de la stabilite dans chaque cas ?
Question 6 :
77
Dans lespace de votre promotion sur le site EEE, copiez le repertoire Fichiers Matlab, decompressezle dans le repertoire D : \mon nom. Positionnez le chemin de Matlab sous le repertoire tdao4
puis ouvrez et executez le fichier Boeing747lacet.m qui initialise les donnees du mod`ele et ouvre
la fenetre SIMULINK.
Remarque : Pour mettre en evidence linteret de lamortisseur de lacet, `a linstant initial,
langle de derapage est different de zero. Cette valeur du derapage est dej`
a programmee.
Completez le schema pour inserer le mod`ele de lavion dans une boucle de regulation
avec le correcteur synthetise precedemment.
Quelle valeur doit-on donner `
a la consigne de lacet ?
Question 9 :
4.2
78
(p)
.
l (p)
Question 12 :
Question 13 : Testez ce r
eglage sans lamortisseur de lacet. Pour ce faire, double-cliquez a
`
nouveau sur le bloc modelisant lavion et portez `
a 0 la valeur du gain de lamortisseur de lacet
puis relancez la simulation.
79
80
TDAO
Etude
dune automanette
Pr
esentation
Ce TDAO a pour objet letude dune automanette. Lautomanette etant un mode du pilote
automatique qui permet lacquisition et la tenue dune vitesse indiquee. Le schema fonctionnel
de lautomanette est represente sur la figure 5.1 :
Les notations utilisees :
Uc
Ua
Va
Vs
Vw
m
g
Variation pente
Vitesse vent/sol
Masse de lavion (8160 kg)
Pesanteur (10 m/s2 )
(p)
mg
Uc (p) +
Ua (p)
C(p)
600
1 + 2p
F +
Vw (p)
Vs
1
mp
+
1
Figure 5.1 Le schema fonctionnel de lautomanette
81
Va (p)
TDAO 5. Etude
dune automanette
5.1
R
eponse `
a une consigne
Question 1 :
boucle fermee et verifiez que sa valeur est coherente avec celle trouvee `
a la question precedente.
Visualisez egalement lerreur permanent lim (t). Sans faire de calcul, ce resultat etait-il previt
sible ?
R
eponse aux perturbations
Question 5 : Lorsque est un
echelon damplitude 0 = 0, 017rad, les autres entrees etant
nulles, visualisez lim (t) et lim Va (t). Ce resultat etait-il previsible ?
t
5.2
Correction proportionnelle-int
egrale
On envisage maintenant un
correcteur
proportionnel-integral. On remplace donc K par un
1
bloc de fonction de transfert K 1 +
.
Ti p
On rappelle les resultats du TD : K = 3, 47 et Ti = 28.5
Tracez le diagramme de Black de la FTBO corrigee. Mettez en evidence linfluence
du correcteur sur le diagramme de Black
Question 6 :
Question 7 :
Question 8 :
5.3. Correction `
a avance de phase
quon ait (`
a tort) choisi le param`etre Ti =
1
tel que i = 100dB , on aurait Ti = 0, 22s avec
i
5.3
Correction `
a avance de phase
Une alternative au correcteur proportionnel-integral qui annule les erreurs est daugmenter
le gain K pour les ramener `
a des valeurs acceptables. On ins`ere ensuite un correcteur `a avance
de phase pour restaurer la stabilite degradee par lajout de gain. Le correcteur utilise est donc
finalement
CaP h (p) = K
1 + p
1 + p
avec > 1
On rappelle quon avait determine K = 34, 7 pour limiter les erreurs `a des valeurs acceptables
et quun dimensionnement grossier avait conduit `a = 8, 4 et = 0, 34
Construisez dans votre schema Simulink le correcteur `
a avance de phase et testez-le
pour une entree en consigne et des entrees en perturbations.
Question 9 :
Affichez sur la meme figure les diagrammes de Black de la FTBO non corrigee,
corrigee avec un simple gain K et corrigee avec le correcteur `
a avance de phase. Visualisez
leffet de ce dernier.
Question 10 :
83
TDAO 5. Etude
dune automanette
84
TDAO
But de ce TD/TDAO :
Sur papier : vous faire ecrire la formulation dun filtre de Kalman dans le cas un cas
simple. En formulation continue, on se limite le plus souvent `a la solution stationnaire
(A savoir faire seul...). Le syst`eme etudie est ici dordre 1, ce qui permet facilement
Expos
e du probl`
eme
Mod
elisation des d
efauts
La
La
6.1
Formulation du filtre
Quels sont les etat, entree et sortie du syst`eme ? Ecrire son mod`ele sous forme de
representation detat en faisant bien apparatre les vecteurs contenant des elements dincertitude.
Identifier les matrices traditionnellement appelees A, B, C, D, Q, R
Question 1 :
Question 2 :
Question 3 :
6.2
Simulation
Copier dans un repertoire local le repertoire fdK dans votre espace promotion. Executer le
programme initDonnees.m qui definit les variables utiles et ouvre le schema Simulink contenant
le mod`ele du satellite. Les defauts des capteurs sont caracterises par les variables definies. Dans
la pratique, on nest pas cense les connatre et il faut tout dabord essayer de quantifier ces
defauts.
Caract
erisation des capteurs au sol
On suppose disposer dinstallation dessais etalonnees avant le lancement du satellite. On
peut ainsi connatre les valeurs reelles de la vitesse et de la position ainsi que les celles delivrees
par les capteurs.
Enregistrer les erreurs de mesures de vitesse et de position sur un temps assez long
(de quelques milliers de secondes). En appliquant la definition de la covariance des bruits detat
et de mesure, retrouver les param`etres et qui permettront de regler le filtre de Kalman.
Question 4 :
86
6.2. Simulation
Trucs & Astuces Matlab
On rappelle que lon peut exporter les donnees dun objet Scope en cochant la case Save data
to Workspace dans longlet Data history de la fenetre de param`etres du Scope. On acc`ede `
a la
matrice des donnees en faisant nomVariable.signals.value
Trucs & Astuces Matlab
Utiliser la commande .* pour multiplier deux matrices de meme dimension terme `a terme
Trucs & Astuces Matlab
Utiliser la commande mean pour calculer la moyenne des termes dune matrice (consulter
laide)
Trucs & Astuces Matlab
On sera frequemment amene `
a calculer la covariance dun signal contenu dans un vecteur.
Cest loccasion decrire une fonction Matlab. Dans une page vierge de lediteur, la premi`ere
ligne active doit etre function Resultat = NomFonction(param`etres)
Attention, les variables ne sont a priori pas globales : dans une fonction on ne connait que
les variables passees en param`etre
Estimation de la position
On sait donc caracteriser les bruits des capteurs de notre satellite. On a d
u retrouver les
variances de bruits qui ont servi `
a construire les signaux et definis dans initDonnees.m
On suppose desormais le satellite dans lespace et on ne dispose plus des grandeurs reelles
de la vitesse et de la position pour estimer la position. Ces sorties ne nous serviront plus que de
reference pour evaluer les performances de nos estimateurs.
Integrer directement la vitesse de rotation. Comparer la position ainsi estimee et la
position reelle. Visualiser la difference, calculer la moyenne du carre des erreurs destimation (
ie la covariance derreur destimation statistique) et conclure sur la qualite de cette estimation.
Question 5 :
Vous trouverez dans le fichier gainFdK.mdl un bloc Simulink dans lequel le calcul du gain du
filtre est dej`
a construit. Les trois derni`eres entrees sont les param`etres de reglage (utiliser des
constantes).
Pour lintegrateur du filtre, on prendra une valeur initiale externe.
Influence de la fiabilit
e de l
etat initial
Question 7 :
consequence.
Faute de connaissance sur la position, on initialise arbitrairement la position initiale a
` 0 = 0.
On sait cependant que le satellite peut avoir une position initiale de lordre de 15 . Proposer un
87
Question 8 :
Question 10 :
La variance du bruit sur la vitesse est calculee dans InitDonnees.m `a partir de lerreur maximale (Definition `a 3). Cest cette valeur quil convient de modifier. Il ny a pas dautres modifications `a faire si les reglages du filtre sont specifies en utilisant les variables du probl`eme
(varWSat et varTSat).
Degrader dans la meme proportion la qualite de linformation de position. Adapter
le reglage du filtre et refaire une simulation dans ces conditions. Relever et exploiter les memes
donnees que precedemment.
Question 11 :
88
TDAO
Pendant cette seance de TD assiste par ordinateur, on vous propose de dimensionner une
loi de commande pour laxe de tangage du quadrirotor etudie lors des seances de TD1 et de
TDAO1. A cette occasion, on a etabli lexpression de la fonction de transfert qui lie (s),
les
1
+
3
e
2k2
I T s2
(s)
(s)
variations de lassiette autour de sa position dequilibre (ici zero), au moment de tangage M
resultant du differentiel de vitesse de rotation des helices 1 et 3. Soit :
(s)
1
=
IT s2
M (s)
avec
1
3 e
(s) = 2k2
M
q(s) = s(s)
1 et
3 sont les commandes du
Ainsi, dans letat, et comme cela est illustre sur la figure,
(s)
quadrirotor. Comme on vient de le rappeler, ces derni`eres produisent le moment de tangage M
mais aussi les variations de poussee T. Cependant, si lon dispose dune radiocommande (RC),
il est plus judicieux dassocier une voie `a la commande des gaz T et une voie `a la commande
89
1
3
m =
1 +
3
T =
1 et
3 proc`edent de la rotation de moteurs `a courants continus asservis en
Pratiquement,
vitesse. Ces asservissements ont les caracteristiques suivantes :
La boucle dasservissement en vitesse est beaucoup plus rapide que les autres soussyst`emes constitutifs du quadrirotor.
Le gain statique de cet boucle dasservissement est unitaire.
Sur le shema fonctionnel, indiquez o`
u figurent les sous-syst`emes moteurs asservis
en vitesse et definissez leur fonction de transfert.
Question 2 :
Dans la question qui suit, vous allez utiliser la fonction sisotool dediee, dans le cas de syst`emes asservis mono-entree, mono-sortie, `
a la synth`ese de correcteurs dans le domaine frequentiel
(Bode, Black-Nichols) ou `
a laide du lieu dEvans (root locus). Cette fonction autorise egalement
levaluation des performances des lois de commande synthetisees dans le domaine temporel.
Question 3 :
(s)
.
m (s) T =0
Le quadrirotor vole en stationnaire, comment interpretez-vous physiquement T = 0 ?
On donne IT = 6e3 kg.m2 , e = 225rad.s1 , k2 = 6.573e6. Saisissez cette fonction de
transfert sous MATLAB.
Calculez la fonction de transfert en boucle ouverte
depuis la fenetre de sisotool, cliquez sur longlet graphical tuning et dans les menus deroulants, selectionnez les types de representation avec lesquels vous souhaitez synthetiser la
loi de commande. Par exemple nichols pour le trace du lieu de Black de la boucle ouverte,
puis cliquez sur le bouton show design plot.
depuis la fenetre de sisotool, cliquez sur longlet compensator editor o`
u vous pourrez modifier les param`etres du correcteur.
enfin, en retournant sur la fenetre de sisotool, cliquez sur longlet analysis plot pour le
trace de la reponse aux signaux types. Il est possible de tracer les reponses aux differentes
entrees : consigne, perturbation, bruit de mesure. Dans le cas present, on se contentera
dune reponse indicielle `
a la consigne (closed loop r to y). Cliquez sur le bouton show
analysis plot pour visuliser les resultats.
Avec sisotool, visualisez le lieu de Black-Nichols de la fonction de transfert non
corrigee puis, pour chacune des strategies de commande suivantes ebauchez le lieu de BlackNichols de la fonction de transfert corrigee et dites si le correcteur etudie permettrait de contr
oler
le quadrirotor.
proportionnel
proportionnel integral
proportionnel derive
`
a avance de phase
Question 4 :
On desire conferer `
a ce quadrirotor, pour la commande de laxe de tangage en boucle fermee,
un comportement du type de celui dun syst`eme du second ordre dominant avec un facteur
damortissement egal `
a 0, 707. Pour ce faire, le lieu de Black de la boucle ouverte corrigee doit
tangenter lisogain 0dB (ce qui traduit le fait que le facteur de surtension en boucle fermee est
nul, ce qui revient `
a dire que le facteur damortissement vaut 0, 707). A priori, le correcteur le
mieux adapte serait le correcteur `
a avance de phase dont on rappelle que la fonction de transfert
a pour expression :
s + 1
CAP (s) = k
s + 1
et dont le diagramme de Bode est represente sur la figure
91
Question 6 :
Sous SIMULINK, ouvrez le fichier Model quadrotor1.mdl. Ouvrez le fichier Model quadrotor.mdl et completez-le avec le sous-syst`eme generant la force de poussee et les moments
produits par les helices. Il peut
etre n
ecessaire de recompiler lun des fichiers constitutifs de ce sch
ema, pour cela suivez la proc
edure indiqu
ee dans le fichier LisezMoi.txt
archiv
e dans le dossier Fichiers Matlab/TDAO6. Ce mod`ele, dit de simulation, se veut
realiste, il tient notamment compte des effets nonlineaires dus aux helices. Implementez sur ce
mod`ele la commande de laxe de tangage obtenue avec le mod`ele lineaire et testez-la.
Question 7 :
qc (s)
C +
-
0.493 q(s)
s
1
s
(s)
Figure 7.3 Schema fonctionnel de la commande de laxe de tangage avec retour tachymetrique
Question 8 :
Calculez
q(s)
et mettez cette fonction de transfert sous la forme
qc (s)
G
q(s)
=
qc (s)
Ts + 1
(s)
et montrez quun correcteur proportionnel de gain C permet de
c (s)
conferer au quadrirotor un comportement du type de celui dun second ordre dont le reglage de
la pulsation propre est defini pr C et celui du facteur damortissement reduit est defini par a.
Question 9 :
Calculez
92
Utilisez sisotool pour mettre en evidence les effets de ces reglages sur la FTBO
corrigee, le lieu des p
oles et la reponse indicielle.
Question 10 :
93
94
TDAO
Etude
dun moteur brushless
Lors de cette seance de TP, vous allez successivement etudier les caracteristiques statiques
et dynamiques dun moteur brushless puis mettrez en uvre une loi de commande visant `
a
accotre ses performances. Le moteur etudie entraine les helices de lhexacopter (aeronef `a voilure
tournante equipe de six rotors) represente sur la figure 8.1.
8.1
Relev
e de la caract
eristique statique
Sous EEEet depuis le dossier Automatique localise dans votre espace de promotion,
copiez sous D : \mon nom le fichier brushless.mdl. Ce mod`ele du moteur est un mod`ele de
simulation.
Appliquez `
a lentree de commande N un signal constant dont vous ferez varier successivement
la valeur entre 0 et 250 par pas de 25. Comme on sinteresse au regime statique, vous rel`everez
la valeur de la vitesse en regime permanent.
Question 1 :
95
TDAO 8. Etude
dun moteur brushless
Relever les valeurs de N et de dans un tableau et visualiser la caracteristique statique
Trucs & Astuces Matlab
On peut afficher la valeur numerique dun signal en utilisant le bloc display dans la biblioth`eque Sinks de SIMULINK.
Trucs & Astuces Matlab
Un tableau est en fait une matrice. Si lon nomme M cette matrice, on acc`ede `a sa premi`ere
colonne en tapant et executant M( :,1), `
a la deuxi`eme en tapant et executant M( :,2), `a la
premi`ere ligne en tapant et executant M(1, :), etc. La fonction plot(M( :,1),M( :,2)) affiche en
coordonnees cartesiennes sur laxe des abcisses les points de la premi`ere colonne de M, sur laxe
des ordonees les points de la deuxi`eme colonne de M.
La poussee produite par une helice est liee `a la vitesse de rotation dune helice par la relation :
T = b 2 . Pour lhelice etudiee, b = 1.416 105 N s2 , par ailleurs, la masse m de lhexacopt`ere
est egale `a 1.5kg.
Le vol stationnaire correspond `
a une situation dequilibre. Calculez la vitesse dequilibre dun moteur et porter sur la caracteristique statique le point dequilibre {Ne , e }.
Question 2 :
8.2
Caract
eristique dynamique
Appliquer `
a lentree du moteur brushless une commande N = Ne , ajouter a
` ce
1
signal un echelon damplitue egale `
a environ 10% de Ne et relever la reponse indicielle .
Question 4 :
1. Il nest pas possible de faire le releve des coordonnees dun point sur le Scope. On peut toutefois imprimer
ces courbes sur une figure en suivant cette procedure :
1. double-cliquez sur le scope qui affiche le signal que vous voulez traiter,
2. cliquez sur lic
one Parameters onglet History
3. decochez la case Limit data point to last
4. cochez la case Save data to workspace
5. donnez un nom explicite `
a la variable, par exemple out et choisissez le format Array, validez
6. relancez la simulation
7. out est un tableau accessible depuis le Command Window dont la premi`ere colonne est le temps,
96
8.3. Correction
Identifier cette reponse en utilisant la methode de Broida decrite dans la derni`ere
partie du sujet. Attention `
a ce que le Step Time de lechelon soit regle a
` zero.
Question 5 :
La reponse indicielle met en evidence la presence dun retard. La fonction de transfert dun
retard est ecrite au moyen de lapproximation de Pade (cf. Annexe C.2 du livre de cours), on
montre que
1 R2 p
eRp
R
1+ p
2
.
Reecrire lexpression de la fonction de transfert du moteur en utilisant lapproximation de Pade. Cette fonction de transfert est le mod`ele de synth`ese du moteur.
Calculer les p
oles et les zeros de cette fonction de transfert.
Quelle est la classe du moteur ?
Question 6 :
8.3
Correction
les colonnes suivantes sont les valeurs prises par les signaux appliques au Scope. La commande
plot(out( :,1),out( :,2)) permet dafficher le premier signal.
97
TDAO 8. Etude
dun moteur brushless
Pourquoi le lieu de Black de la boucle ouverte du syst`eme ainsi corrige doit-il tangenter
lisogain 0dB ?
Implementer la commande synthetisee sous sisotool sur le mod`ele de simulation.
Appliquer un echelon de consigne ayant pour valeur initiale la vitesse dequilibre e et
pour valeur finale un increment egal a
` 10% de cette valeur.
Relever les signaux suivants : erreur, commande, vitesse.
Commenter les resultats obtenus.
Question 9 :
8.4
M
ethode de Broda
Le mod`ele propose par Broda pour la reponse `a un echelon damplitude e0 dun syst`eme de
la forme de celle presentee sur la figure 8.2 secrit :
S(p)
KeRp
=
U (p)
p + 1
0.6
0.5
s()
Amplitude
0.4
0.3
s(t2)=40% de s()
0.2
0.1
0.1
Temps6(sec)
10
98
12
8.4. M
ethode de Broda
o`
u
s()
,
e0
la constante de temps = 5.5(t2 t1 ),
le retard R = 2.8t1 1.8t2 .
le gain statique K =
99
TDAO 8. Etude
dun moteur brushless
100
TDAO
Au cours de cette seance de TDAO, vous mettrez en uvre une strategie de commande visant
`a controler laltitude du quadrirotor represente sur la figure 9.1.
motor 1 + propeller 1
1
motor 2+propeller 2
~xb
~yb
motor 3+ propeller 3
Figure 9.1 A gauche, vue shematique dun quadrirotor. A droite, le U130 de Novadem
point de decollage, o`
u xE pointe vers le nord, yE vers lest et
z
E pointe en direction de la terre.
RE
T
Le vecteur
= (x, y, z) rep`ere la position du centre de gravite du drone dans RE . Soit
Rb = (c.g.,
xb ,
yb ,
zb ) un rep`ere orthonorme direct lie au vehicule et partiellement represente sur
la figure 9.1. Les angles de gte , dassiette et le cap decrivent lorientation de Rb /Re .
Ce quadrirotor poss`ede :
une entree de commande pour le controle de la poussee T . Celle-ci est obtenue en commandant simultanement les vitesses de rotation i des helices avec i {1..4}
T = k1 (21 + 22 + 23 + 24 )
o`
u k1 designe le coefficient de poussee des helices.
101
9.1
Inversion dynamique
La methode dinversion dynamique consiste `a appliquer au syst`eme une commande qui linearise le syst`eme en lui conferant la fonction de transfert dun integrateur pur. Soit le syst`eme
decrit par :
x = f (x) + g(x)u
(9.1)
(9.2)
et quon impose `a x dans u de suivre un profil desire x des , alors en remplacant (9.2) dans (9.1),
il vient :
x = x des
(9.3)
21
22
Question 2 :
Etablissez dans ces conditions la fonction de transfert qui lie la nouvelle entree v zdes
` z. Ce syst`eme est-il stable ?
a
Question 3 :
Dans lespace de votre promotion sur le site EEE, copiez le repertoire Fichiers Matlab, decompressezle dans le repertoire D : \mon nom. Positionnez le chemin de Matlab sous le repertoire tdao9
puis ouvrez et executez le fichier quadri.mdl qui ouvre la fenetre SIMULINK contenant le schema
du syst`eme.
Sur le schema SIMULINK, implementez la loi de commande non lineaire trouvee a
`
la question 1. Vous trouverez toutes les fonctions utiles dans les biblioth`eque Math Operations
et Sources. La masse m = 1.5kg et le coefficient de poussee dune helice k1 = 1, 416.105 .
Question 4 :
1. Cette methode suppose le mod`ele du syst`eme parfaitement identifie, elle est donc peu robuste du fait des
incertitudes pouvant affecter les param`etres du mod`ele.
102
zc (p) +
C(p)
9.2
Question 5 :
F T BF (p) =
1
z(p)
= 2
zc (p)
p + 2p + 1
.
Ce correcteur netant pas realisable (le degre du numerateur est superieur a
` celui
K(T p + 1)
du denominateur), vous en implementerez une version modifiee. Soit C(p) =
(ce
0.05T p + 1
qui revient `
a implementer un correcteur `
a avance de phase). Implementez ce correcteur sur le
schema SIMULINK prealablement muni de sa commande nonlineaire. Simulez-le en reponse au
un signal defini par :
zc (t) = 0.5tU (t) pour t < 5s,
zc (t) = 2.5U (t) pour t 5s
Les erreurs de trainage et de position observees sont-elles conformes a
` la theorie ?
Question 6 :
Synth`
ese dune commande dans le domaine fr
equentiel
Le correcteur est cette fois synthetise dans le domaine frequentiel en exploitant le lieu de
Black-Nichols de la FTBO. Il sagit de determiner un correcteur qui conf`ere `a ce lieu le profil
desire.
103
Question 8 : Impl
ementez ce correcteur proportionnel-derive sur le schema SIMULINK prealablement muni de sa commande nonlineaire et simulez-le. Vous le soumettrez aux memes signaux
de consigne que ceux de la question 6.
104
TDAO
10
Dans ce bureau detudes, on cherche `a controler un airliner autour de ses axes de roulis et de
lacet. Le mod`ele de lappareil est celui etudie au chapitre 5 du cours. Dans une premi`ere partie,
vous mettrez en evidence les modes propres de laeronef et les effets de chacune des commandes
sur ces modes. Dans un second temps, vous dimensionnerez une commande par retour detat avec
strategie de placement de poles et de vecteurs propres. Cette loi de commande sera dimensionnee
en vue de decoupler les axes de roulis et de lacet par le controle de la gouverne de direction et
les ailerons. Enfin, dans le cas o`
u, seule une partie du vecteur detat est mesuree, vous mettrez
en uvre une commande par retour de sortie dont vous evaluerez les limites.
Sous MATLAB, vous ecrirez un script pour chacune des parties. En aucun cas vous ne devez
coder dans la fenetre dedition des commandes.
10.1
Mod
elisation et Lin
earisation
Les equations laterales de la mecanique du vol dun avion evoluant `a vitesse et altitude
constantes, `
a pente nulle et `
a tr`es faible incidence e sont donnees dans (10.1). Les vecteurs
T
u est langle de derapage, p la
et de commande U = n o`
detat X = r p
vitesse de roulis, r la vitesse de lacet, langle de gte, n langle de braquage de la gouverne de
direction et langle de braquage des ailerons.
= 11 + 12 r + 13 p + 14 sin + 15 n + 16
(10.1)
r = 21 + 22 r + 23 p + 24 sin + 25 n + 26
p = 31 + 32 r + 33 p + 34 sin + 35 n + 36
= p + tan e (r cos + qe sin )
Dans le cas o`
u lon suppose de petites variations x,u, de ces variables autour
de lequilibre defini par Xe = 0 et Ue = 0, linearisez les equations (10.1) et etablissez les
Question 1 :
105
10.2
Analyse Modale
Les resultats mis en evidence dans cette partie sont ceux qui ont ete entrevus aux chapitre
5 du cours. Le syst`eme est decrit par lequation detat (10.2) :
x = Ax + Bu
(10.2)
avec, dans le cas dun Boeing 747 evoluant `a Mach 0.8 et 40000 pieds :
A=
B
=
3.05
0.153
.388
.4650
0
0.143
0
0.0805
1
0
0
0
(10.3)
T
Tout le vecteur detat est mesure y = m rm pm m . Ces mesures sont parfaites, ce
qui signifie que la mesure est `
a tout instant egale `a la grandeur physique afferente. Pratiquement
ces mesures sont obtenues au moyen dune sonde de derapage, de gyrom`etres et dun gyroscope
de verticale.
Question 2 :
Calculer les valeurs propres et la matrice des vecteurs propres de la matrice detat
fonction eig.
Question 3 :
Identifier les modes et caracterisez-les. Soit par leur constante de temps, soit
par leur pulsation propre non amortie et leur facteur damortissement reduit. Quelle critique
porteriez-vous sur le comportement de cet avion ?
Question 4 :
Les coefficients de la matrice des vecteurs propres prennent leurs valeurs dans C.
Calculer le module de ces coefficients avec la fonction abs et justifier le fait que les axes de
roulis et de lacet sont couples.
Question 5 :
Question 7 :
106
Question 8 :
10.3
Lappareil etudie presente une dynamique du second ordre mal amortie et lune de ses dynamiques du premier ordre est trop lente. Pour controler ces dynamiques, on met en uvre une
commande par retour detat de la forme :
u = He Kx
(10.4)
Dans cette partie, on envisage une commande par placement de poles et de vecteurs propres.
Linteret de cette approche reside dans la possibilite de decoupler les dynamiques des axes
de roulis de celles de lacet. Reportez-vous au 3.3.3 du chapitre 6 du livre de cours pour les
developpements theoriques.
Les modes desires pour lavion corrige :
On souhaite que le mode dordre deux soit plus rapide et mieux amorti.
le pole du mode dordre un le plus lent reste inchange,
le pole du mode dordre un le plus rapide doit etre `a lorigine dun regime transitoire
inferieur ou egal `
a une trois secondes.
le mode dordre deux doit etre decouple du roulis p,
le mode dordre un le plus rapide doit etre decouple du derapage
le mode dordre un le plus lent doit etre decouple du lacet r
Question 9 : Au moyen des
equations (10.2) et (10.4), etablissez lexpression litterale de la
representation detat du syst`eme corrige.
Saisissez-les p
oles de lavion corrige sous MATLAB dans un vecteur appele poles.
Question 11 :
Question 12 :
Pour chaque p
oles (valeur propre i ), calculez le noyau de lapplication lineaire
107
(10.5)
Vous stockerez le resultat de ce calcul dans un vecteur vwi et vous verifierez que ce vecteur
a la structure desiree.
`
Trucs & Astuces Matlab
La matrice identite fonction
eye
!
A11 A12
secrit sous MATLAB [A11 ,A12 ;A2 ]
La matrice
A2
Pour acceder au n premi`eres composantes du vecteur vwi vi = vwi (1 : n)
Pour acceder au m derni`eres composantes du vecteur vwi wi = vwi (n + 1 : n + m)
Vous construirez les matrices de passage P et de sensibilite des commandes aux
modes W en concatenant les vecteurs vi et les vecteurs wi avec i [1..4].
Question 13 :
Calculez la matrice de contre-reaction K et verifier que lensemble des valeurs propres spe(A
BK) est celui attendu.
Calcul de la matrice H
Comme on dispose de deux commandes, on peut controler deux variables. Soit T =
le vecteur des variables controlees.
Question 14 :
Ecrire
lequation des variables contr
olees sous la forme = Mx.
Quelle doit etre la dimension de la matrice de pre-gain H ? Calculer numeriquement le(les) coefficient(s) de cette matrice, de sorte quen regime permanent les sorties contr
olees
soient egales aux consignes e.
Question 15 :
Simulation
Ouvrez et executez le fichier ModelBoeing747.m. Lancez la simulation pour verifier son bon
fonctionnement.
Sur ce mod`ele, implementez et testez la commande par retour detat (10.4) avec
les valeurs de K et H calculees precedemment. Observez toutes les sorties et verifiez que les
decouplages sont effectifs. Vous trouverez les blocs utiles dans les biblioth`eques suivantes :
gain (Parametrez les matrices avec loption Multiplication Matrix(K*u)), add Maths
mux Signal Routing
step Sources
scope Scope
Question 16 :
108
10.4
Dans cette derni`ere partie, on suppose que le derapage nest pas mesure. On cherche cependant `
a mettre en uvre une loi de commande dite par retour de sortie. Cependant, comme
trois variables detat sont mesurees, on ne pourra contr
oler que trois des quatre poles caracteristiques de la dynamique laterale. Il est conseille de sappuyer sur le cours pour synthetiser cette
commande.
Dans le cas o`
u seules les variables detat r, p et sont mesurees, donnez lexpression numerique de la matrice de sortie X telle que :
Question 17 :
y = Cx
(10.6)
u = He Ky
(10.7)
Les objectifs de la commande restent les memes que ceux definis dans la section precedente.
Toutefois, comme on ne dispose que de trois mesures, on ne peut placer que trois poles.
Les poles desires pour lavion corrige 1 :
On souhaite que les poles complexes conjugues valent 1 i,
le pole du mode dordre un le plus lent reste inchange,
on ne place pas le pole dordre un le plus rapide.
le mode dordre deux doit etre decouple de la commande des ailerons ,
le mode dordre un le plus lent doit etre decouple de la commande des ailerons n
Pour chaque p
oles (valeur propre i avec i [1..3]),
Calculez le noyau de lapplication lineaire :
!
A i In B
ci
Question 19 :
(10.8)
Ces simulations montrent quun retour de sortie est possible `a la seule condition de degrader
les dynamiques, ici le temps de reponse du mode dordre deux. Dans les cours qui suivent, nous
1. Ces reglages diff`erent des precedents, il na en effet pas ete possible de trouver un reglage du syst`eme stable
par retour de sortie avec le cahier des charges propose `
a la section precedente
109
110
TDAO
11
xb
yb
o
z=zb
z=yb
Figure 11.1 Les rep`eres et la centrale MTI de XSENS
111
11.1
`
MODELES
L
equation d
etat
La cinematique de rotation est decrite par :
= r
(11.1)
(11.2)
Ecrivez
les lequation detat de b et de . Vous ferez explicitement apparatre les
matrices detat A et de commande B.
Question 1 :
Question 2 :
Question 3 :
L
equation dobservation
Etablissez
les equations qui permettent dobtenir une mesure m du cap a
` partir
des mesures magx et magy delivrees par les magnetom`etres. Le champ magnetique terrestre est
dirige selon x et a une intensite de B0 = 47T .
Question 4 :
Question 5 :
Question 6 :
11.2. OBSERVATEUR
11.2
OBSERVATEUR
Etablissez
lobservabilite du syst`eme decrit par les equations detat et dobservation
etablies dans la section precedente.
Question 7 :
T
Etablissez
lequation detat des erreurs destimation, soit = b . Il est
conseille de traiter dans un premier temps cette question dans le cas general avec les matrices
F, G et L puis de substituer `
a ces matrices leurs valeurs particuli`eres.
Question 9 :
Question 10 :
` partir des p
A
oles, calculer le polyn
ome caracteristique de la matrice F LC
et lidentifier `
a |I (F LC)| o`
u |A| designe le determinant de la matrice A. En deduire la
matrice des gains L de lobservateur. Verifiez votre calcul avec la fonction place. Attention a
`
la syntaxe.
Question 11 :
Question 12 :
11.3
Dans le cas o`
u la mesure est entachee dune erreur systematique d constante de
sorte que m = + d, reformulez lequation des etats estimes et deduisez-en les equations detat
des erreurs destimation , b .
Question 13 :
Exprimez le terme general de la suite k+1 et donnez sa valeur en regime permanent (lorsque k +). Vous montrerez que lestimation est biaisee c.-`
a-d. que le vecteur
detat estime diff`ere systematiquement du vecteur detat. Pour mener ce calcul, vous exprimerez
o`
H = F LC `
a partir de sa forme diagonale H = PHP
u P designe la matrice de passage
F LC dans la base modale.
Question 14 :
Question 15 :
5
et avec les valeurs de 1 , 2 trouvees
180
Question 16 :
11.4
SIGNAUX REELS
Question 17 :
Dans cette derni`ere partie, on va mettre en evidence le fait que lobservateur est un filtre
dont la bande passante depend des gains i de lobservateur. Pour cela on reformule lequation
detat de lobservateur comme suit :
x
k+1
u
k
= (F LC)
xk + G L
yk
y
k = C
xk
(11.3)
(11.4)
Question 18 :
Question 19 :
0.5i}.
42.4264 42.4264i
0.5 0.5i
1
0.8
0.01
114
2
-23.55
-0.005
11.4. SIGNAUX REELS
Bode Diagram
From: In(1)
From: In(2)
20
tf_filtre
ples 0.5+/0.5i
Magnitude (dB)
To: Out(1)
20
40
60
80
100
120
140 2
10
10
10
10
Frequency (rad/s)
10
10
115
116
TDAO
12
12.1
PRESENTATION
DU PROBLEME
Le radar de poursuite dun Awacs tente de localiser une cible qui cherche `a sechapper.
Outre le fait quelle soit tr`es manuvrante, cette cible brouille sa position en generant des
contre-mesures. Le probl`eme est represente sur la figure 12.1 et les deux avions evoluent `
a la
meme altitude. LAWACS vole `
a vitesse constante.
y
cible (xc , yc )
AWACS (xa , ya )
0
Figure 12.1 Vue schematique du probl`eme et photographie dun AWACS du 36e EDCA
117
12.2
`
MODELES
DE TRAJECTOIRES
Repr
esentation d
etat
Vous adopterez pour la representation detat de ce syst`eme les variables suivantes :
x1 = xc xa
x 2 = yc ya
x3 = x c x a
x4 = y c y a
(12.1)
Pour rendre compte du caract`ere aleatoire de la trajectoire, on ajoute un bruit detat, pratiquement il sagit dune acceleration de sorte que :
x 3 = x
c x
+ w1
x 4 = yc y + w2
Ecrire
lequation detat de ce syst`eme et precisez les expressions des matrices detat
et dentree. Par ailleurs, on mesure la position relative de la cible au chasseur selon les directions
x et y. Saisissez les expressions de ces matrices dans un script sous MATLAB que vous prendrez
soin de commenter.
Question 1 :
Ecrire
lequation detat approchee du syst`eme `
a temps discret equivalent pour une
periode dechantillonnage T = 200ms. Saisissez les expressions de ce mod`ele sous MATLAB
ss. Attention `
a bien respecter la syntaxe pour un syst`eme echantillonne.
Question 2 :
Mod`
ele des bruits d
etat et de mesure
Le bruit detat est dans un premier temps suppose blanc, centre. Les variances q12 de w1 et
q22 de w2 sont respectivement egales `
a 1 et 9 (exprimees en m2 .s4 ). Elles rendent compte des
accelerations auxquelles est soumise la cible tandis quelle manuvre pour eviter detre accrochee
par le radar.
Ecrire
lexpression de la matrice de variance du bruit detat Q, la saisir dans le
script sous MATLAB.
Question 3 :
Le bruit de mesure est suppose blanc, centre de variance r12 = r22 = 400m2 . Ces variances
rendent compte des contre-mesures qu brouillent le radar. Que representent-les ecarts-types r1
et r2 ?
Ecrire
lexpression de la matrice de variance du bruit de mesure R et la saisir dans
le script sous MATLAB.
Question 4 :
118
`
12.2. MODELES
DE TRAJECTOIRES
G
en
eration des trajectoires
La duree de la simulation est fixee `a 60 s. Vous devez, prealablement `a la generation des
trajectoires, definir un vecteur temps qui contient les instants auxquels on simule le syst`eme.
Pratiquement on proc`ede de la facon suivante :
1
2
3
4
T=0.2 s
Tsim = 6 0 ;
eration
t e m p s = 0 : T : Tsim ; %gen
dun vecteur ligne de longueur 301
t e m p s = temps
% transposition en vecteur colonne
Question 5 :
k = E[(xk x
k )(xk x
k )T ]
(12.2)
o`
ux
k = E[(xk ] est lesperance ou moyenne du vecteur detat.
1
2
3
% Boucle iterative
4
5
6
7
N= 1 0 0 ;
x=[1;0.5] ;
u= o n e s (N , 1 ) ;
% le nombre diterations
% les conditions initiales
: un echelon
% le signal dentree
unitaire de longueur N
A= [ 0 . 9 0 ; 0 0 . 2 ] ;
B=[0;0.1];
% declaration
des matrices
8
9
10
11
12
13
14
15
f o r i = 1 :N1 ,
x ( : , i +1)=Ax ( : , i ) +Bu ( i ) ;
end
% x est un vecteur de dimension 2*N
16
17
plot ( x ( 1 , : ) , x ( 2 , : ) , r , LineWidth , 2 )
119
12.3
FILTRE DE KALMAN
Question 8 :
Question 9 :
destimation.
En vous inspirant du programme joint ci-dessus, implementer les equations du
filtre de Kalman. Les variables detat estimees x
k seront stockees dans xest. Dans un premier
temps, letat initial est suppose parfaitement connu. Reglez les conditions initiales x
0 et P0
en consequence. Attention, dans les tableaux, MATLAB ne reconnat pas, contrairement au C,
lindice 0 et x
0 est en fait xest(1).
Afficher la trajectoire obtenue au moyen du filtre 1
Question 10 :
Calculez la somme quadratique des erreurs de mesure et celles des erreurs destimation. Comparez-les et mettez en evidence linteret du filtre par rapport a
` la mesure seule.
Question 11 :
Testez le filtre de Kalman pour des conditions initiales mal connues. Reglez les
conditions initiales x
0 . et P0 en consequence.
Question 12 :
12.4
MULTICIBLES
CAPACITE
On va, avec ce radar, essayer de suivre avec deux cibles simultanement. Le principe consiste
a` operer `a deux estimation a priori pour une mesure et une estimation a posteriori.
Generez les trajectoires de deux avions. Vous prendrez soin de distinguer pour
chacun deux les variables detat et de sortie qui les caracterisent. Soit par exemple x1 , x2 , y1 ,
y2 .
Question 13 :
Question 14 :
` ne
1. Vous pouvez egalement, avec la fonction quiver, materialiser par des fleches le cap de lappareil. A
faire que si vous jugez en avoir le temps.
120
12.5. A
12.5
Cette partie est facultative. Laffichage du bruit detat w modelise par un bruit blanc montre
que les variations de ce dernier, censees representer des accelerations sont peu realistes. Pour
lisser ces bruits, on peut les traiter par un syst`eme decrit par une representation detat :
!
!
!
!
!
T
0
0
1k
T + 1
1k
w
1k
=
+
+ T
(12.3)
0
T + 1
0
2k
2k
w2k
Ce qui equivaut `
a filtrer les composantes du bruit blanc w par un filtre passe-bas de pulsation
de coupure egale `
a 1 .
i (z)
=
wi (z)
z+
(12.4)
On obtient un vecteur de bruits dits colores . Les hypoth`eses posees par Kalman ne sont
cependant plus verifiees et lestimation de letat nest pas optimale.
Generer le vecteur des bruits colores en prenant = 1s, pour cela, vous devez
implementer sous MATLAB la representation detat (12.3).
Question 15 :
Simulez la trajectoire de la cible tandis que le bruit detat qui decrit les accelerations
auxquelles elle est soumise est desormais . Vous pouvez dans le meme temps soumettre la cible
aux accelerations modelisees par w et comparer les trajectoires obtenues.
Question 16 :
121
122
Quatri`
eme partie
ARCHIVES
123
ARCHIVES
Pr
esentation
On sinteresse `
a lasservissement de langle de gte sur un avion au moyen de la gouverne
de gauchissement l
d l < 0
f > 0
y
z h
lc
Cor ext
Cor int
l
Moteur
AVION
gyroscope
lc (rd)
Ci (p)
Km
p(1 + m p)
l (rd)
La boucle interne a pour but dagir sur la gouverne de gauchissement pour que son angle de
braquage l soit aussi conforme que possible a` langle de consigne elaboree par la boucle externe.
Le probl`eme comprend deux parties etudiant successivement les boucles internes et externes.
1.1
= 0, 52
126
50
40
20
0.25 dB
0.5 dB
0d
30
1 dB
3 dB
10
6 dB
0
10
20
30
G.M.: Inf @ Inf
P.M.: 28.9 deg @ 242 rad/sec
Stable loop
40
50
180
165
150
135
120
105
90
Cette question nest pas facile. Ny consacrez pas trop de temps et continuez le probl`eme
avec la marge donnee meme si vous ne voyez pas pourquoi on la choisie.
Question 3 :
Magnitude (dB)
20
40
60
0
Phase (deg)
45
90
135
180
1
10
10
10
10
1.2
Etude du syst`
eme complet
(p)
Ka
=
avec Ka = 70 et
l (p)
p(1 + a p)
a = 0, 2s
On note la fonction de transfert du correcteur de la boucle externe Ce (p)
Question 6 :
Question 7 :
Question 9 :
Question 10 :
1
36,1
-100
5
20
-135
10
9,7
-153
18,5
0
-165
50
-17
-174
129
130
ARCHIVES
Mod`
ele
On cherche `
a etablir le mod`ele de la trajectoire dun avion qui vole `a vitesse constante V0 et
qui doit rejoindre un couloir aerien, ce probl`eme est illustre sur 2.1. On note :
couloir aerien
y
131
Archives 2. Contr
ole de la trajectoire dun avion
Equations du mod`
ele
Langle de gte est commande en braquant les ailerons a . On note s la variable de Laplace ;
dautre part, le mod`ele qui lie a (s) `
a (s) est donne par la fonction de transfert :
(s)
100
=
a (s)
0, 1s(s + 1)
(2.1)
(t)
= V0 (t)
g
y(t)
=
(t)
V0
(2.2)
(2.3)
Le pilote automatique etudie et represente sur la figure 2.2 realise la tenue de trajectoire de
lavion. Il est constitue de deux boucles.
1. Une boucle interne dite petite boucle qui assure le controle de langle de gte.
2. Une boucle externe dite grande boucle qui assure le maintien de la trajectoire de lavion
le long du couloir aerien.
Yc
Cy (s)
a +
+
C (s)
100
s(0, 1s + 1)
m
petite boucle
1
gyroscope
1
VOR
2.1
La petite boucle
Question 1 :
Question 2 :
Le correcteur C (s) est un gain note k . Calculez ce gain pour que le facteur
damortissement de la petite boucle soit egal `
a 0, 4.
Question 3 :
132
Nichols Chart
40
0 dB
30
20
System: sys
0.25 dB
Gain (dB): 16
0.5 dB
Phase (deg): 137
Frequency (rad/sec):
1 dB 10.8
1 dB
3 dB
10
3 dB
6 dB
0
6 dB
10
12 dB
20 dB
20
30
40
270
40 dB
225
180
135
OpenLoop Phase (deg)
90
45
Calculez H(j) =
(j)
(j)
Question 8 :
133
Archives 2. Contr
ole de la trajectoire dun avion
On admet que ces perturbations sont tr`es lentement variables. Justifiez pourquoi
Ts + 1
un correcteur proportionnel-integral de fonction de transfert C (s) = k
peut contribuer
Ts
au rejet de ces perturbations. En utilisant le lieu de Black trace `
a la question 6, proposez une
valeur pour T .
Question 9 :
Ebauchez sur ce meme lieu de Black, le lieu de la FTBO du syst`eme corrige par
le correcteur proportionnel-integral.
Question 10 :
2.2
La grande boucle
Dans cette partie, la petite boucle (supposee beaucoup plus rapide que la grande boucle) est
vue par la grande boucle comme un gain unitaire et on consid`ere les perturbations nulles.
Question 11 :
Question 12 :
figure 2.
On suppose pour linstant Cy (s) = 1. Etablissez lexpression de la FTBO de la
Y (s)
grande boucle soit M (s) =
.
y (s)
Question 13 :
Sur votre copie, tracez le lieu de Black de M (j) et portez sur ce lieu la pulsation
pour laquelle le gain est nul. Soit 0dB cette pulsation.
Question 14 :
On suppose quun correcteur proportionnel-derivee dont les param`etres ont ete judicieusement choisis permet de realiser une correction satisfaisante. On admet (ce qui ne correspond pas
aux resultats que vous pourriez trouver mais qui permet de mener une etude sans avoir `a faire
c (s)
de calcul) que ce correcteur a pour fonction de transfert Cy (s) =
= 1 + s. Sur la figure 4,
y (s)
on a represente les chronogrammes de la trajectoire de lavion partant dune position initiale de
100m, la consigne yc est nulle .
Tracez lallure de c (t) . Pour ce faire, vous tracerez lallure de y (t) et de sa
derivee. Pour chacun de ces deux signaux dites qualitativement son effet sur le syst`eme (imaginez
vous `
a bord dun avion ou dun planeur devant realiser la manuvre etudiee).
Question 16 :
134
ARCHIVES
Pr
esentation
Lobjet de ce probl`eme est letude dun syst`eme constitue dun missile et dune cible. Dans un
premier temps, vous etudierez les performances de ce syst`eme en boucle ouverte et limpossibilite
pour le missile datteindre la cible. Dans une seconde partie, vous etudierez une loi de commande
par retour detat visant `
a guider le missile vers la cible. Dans la troisi`eme partie, vous mettrez
en uvre un observateur, et cela afin de tenir compte des contre-mesures generees par la cible.
Lobjectif etant de fournir au missile des informations pertinentes quant `a sa position et sa
vitesse par rapport `
a celle de la cible.
Notations
M
T
x1
x2
x3
x4
designe le missile,
designe la cible,
la position relative cible/missile dans la direction y,
la position relative cible/missile dans la direction z,
la vitesse relative cible/missile dans la direction y,
la vitesse relative cible/missile dans la direction z.
On fait lhypoth`ese que lengagement se situe dans le plan et que les accelerations de la cible
aT y et aT z selon les axes y et z sont nulles (la cible se deplace `a vitesse constante). De plus on
T
avec u1 = aM y et u2 = aM z ; de plus, ces
definit le vecteur des commandes U = u1 u2
commandes ne sont pas contraintes.
3.1
Mod
elisation du syst`
eme missile-cible
Mod
elisation du syst`
eme missile-cible
Question 1 :
=
On adopte pour vecteur detat X
135
x1 x2 x3 x4
T
Citer un ou des capteurs embarques sur lavion qui tire le missile ou sur le missile
qui realiseraient la mesure du vecteur detat (question hors bareme).
Question 2 :
Pour simplifier letude, on decouple les equations qui decrivent le syst`eme selon les axes y et
z.
Ecrivez les equations detat et dobservation qui rendent compte de la dynamique du
syst`eme cible-missile selon la direction y, on notera X, U et Y les vecteurs detat, de commande
et de mesure reduits. Desormais vous ne travaillerez plus que sur ces equations dans toute la
suite du probl`eme.
Question 3 :
1000N.kg 1 ,
Calculez les gains de la matrice de contre-reaction K de sorte que le syst`eme missilecible se comporte comme un syst`eme du second ordre de facteur damortissement unitaire et tel
que le temps de reponse `
a 5% soit inferieur ou egal `
a 3s.
Question 8 :
136
3.1. Mod
elisation du syst`
eme missile-cible
Question 9 :
Quels effets physiques r`egle-t-on avec les gains de cette matrice de contre-reaction ?
Les contre-mesures de la cible sont `a lorigine dune erreur systematique constante sur la
mesure de la position relative cible/missile :
X = AX + BU
(3.1)
(3.2)
= CX +
On concoit bien que si la mesure de la position est entachee dune erreur, le missile natteindra
jamais la cible. On envisage donc de munir le missile dun observateur capable destimer letat X
soit decouplee de lerreur systematique . X
designe
et tel que lerreur destimation = X X
letat estime. Cet observateur na pas ete etudie en cours, cependant, les questions sont posees
de sorte que vous puissiez letudier sans difficultes majeures.
le vecteur detat estime par cet observateur.
On note Z le vecteur detat de lobservateur et X
Une estimation correcte se traduit par 0, et cela meme en presence de . Les equations dun
tel observateur sont :
Z = M Z + N U + P Y
= Z LY
X
(3.3)
(3.4)
137
Question 14 :
Montrez que = f (, X, U, , )
(il faut faire disparatre Z).
Question 15 :
Ecrivez lexpression de (t) qui ne doit pas depende de . A quelle condition sur
M les erreurs destimation convergent-elles vers 0 ?
Question 16 :
138