a p p o r t
d e r e c h e r c h e
N 0 2 4 9 -6 3 9 9 IS R N IN R IA /R R -- 6 3 8 0 -- F R + E N G
Thème NUM
An H ∞ LPV Design for Sampling Varying Controllers : Experimentation with a T Inverted
Pendulum
David Robert — Olivier Sename — Daniel Simon
N° 6380
Décembre 2007
Centre de recherche Inria de Grenoble – Rhône-Alpes
Pendulum
David Robert
∗†
,OlivierSename
∗†
, DanielSimon
‡†
ThèmeNUMSystèmesnumériques
Équipe-ProjetNeCS
Rapportdereherhe n°6380Déembre200725pages
Abstrat: "This work has beensubmitted to the IEEE for possible publi-
ation. Copyrightmaybetransferred withoutnotie, after whih this version
maynolongerbeaessible."
This report dealswith the adaptation of a real-time ontroller's sampling
period to aountfor theavailable omputing resourevariations. Thedesign
of suh ontrollers requires aparameter-dependent disrete-time model of the
plant, where the parameteris the sampling period. A polytopi approah for
LPV(LinearParameterVarying)systemsisthendevelopedtogetan
H ∞
sam-plingperioddependentontroller. Aredutionofthepolytopesize ishereper-
formed whih drastiallyredues theonservatismof theapproahand makes
easiertheontrollerimplementation. SomeexperimentalresultsonaTinverted
pendulumareprovidedtoshowtheeienyoftheapproah.
Key-words: Digitalontrol,linearparametervarying systems,
H ∞
ontrol,realexperiments.
∗
GIPSA-lab(ControlSystemsDpt.),UMRINPG-CNRS5216, ENSIEG-BP 46,38402
SaintMartind'HèresCedex,Frane
†
Thisworkispartiallysupportedbythe Safe_NeCSprojetfundedbythe ANRunder
grantANR-05-SSIA-0015-03
‡
INRIARhne-Alpes,Inovallée655avenuedel'Europe,Montbonnot,38334Saint-Ismier
Cedex,Frane
H ∞
appliation à un pendule inversé
Résumé: Cerapportexamineleproblèmedel'adaptationen temps-réelde
lapérioded'éhantillonnaged'unontrleur,andeluipermettredes'adapter
aux variationsde la ressourede alul disponible. La oneptiondu ontr-
leurnéessited'avoirunmodèleentemps disretparamétréduproédé,où le
paramètre variable est la période d'éhantillonnage. Une méthode basée sur
l'approhepolytopique (LPV)estutiliséepoursynthétiserunontrleur
H ∞
àpériodevariable. L'utilisationd'unpolytopedetailleréduitepermetderéduire
fortementleonservatismeetlaomplexitédereonstrutionduontrleur. La
méthodeestvalidéeexpérimentalementsurunpendule inversé.
Mots-lés : Commande numérique, systèmes à paramètresvariables, om-
mande
H ∞
,validationexpérimentale1 Introdution
High-tehnologyappliations(ars,householdapplianes..) areusingmoreand
moreomputing andnetwork resoures,leadingto aneed ofonsumption op-
timisationfordereasingtheostorenhaningreliabilityandperformanes. A
solutionistoimprovetheexibilityof thesystembyon-lineadaptationofthe
proessor/networkutilisation,eitherbyhangingthealgorithmorbyadapting
the sampling period. This paper deals with the latter ase and presents the
synthesisofaontrollawwithvaryingsampling period.
Few reentworkshavebeendevotedto the omputingresourevariations.
In[1℄afeedbakontrollerwithasamplingperioddependentPIDontrolleris
used. In[2,3℄afeedbakshedulerbasedonaLQoptimisationofthe ontrol
tasks periods is proposed. In [4℄ aproessor load regulation is proposed and
applied for real-timeontrolof arobot arm. Thedesign ofasampling period
dependentRSTontrollerwasproposedin[5℄. Thislatterpaperdealtwiththe
ontrol of linear SISOsystems at a variable sampling rate, and its promising
resultsalledforextensionstowardsmultivariablesystems.
The presented ontribution enhanes aprevious paper ([6℄) using a linear
parameter-varying(LPV) approahof thelinearrobustontrol framework [7℄.
The LPV approah primarily dealswith variationsof theplant's parameters,
althoughithasbeenappliedalsotoaplantparameterdependentsamplingvia
aliftingtehniqueasin[8℄.
Thispaperprovidesamethodologyfordesigningasamplingperioddepen-
dentontrollerwithperformaneadaptation,whih anbeusedin theontext
ofembeddedontrolsystems. Firstweproposeaparametriseddisretizationof
theontinuoustimeplantandoftheweightingfuntions,leadingtoadisrete-
time samplingperiod dependentaugmentedplant. Inpartiular theplantdis-
retizationapproximates thematrixexponentialbyaTaylorseriesoforder
N
.ThereforeweobtainapolytopiLPVmodel madeof
2 N
verties,aspresentedin [6℄. Inthis paper we exploit thedependenybetweenthevariables param-
eters, whih are the suessivepowersof the sampling period
h, h 2 , ..., h N
, toredue the numberof ontrollers to beombinedto
N + 1
. TheH ∞
ontroldesign method for polytopi models [7℄ is thenused to get asampling period
dependentdisrete-time ontroller. The redutionof the polytopi set drasti-
ally dereasesboththeomplexityandtheonservatismofthepreviouswork
andmakesthesolutioneasiertoimplement. Thisapproahisthenvalidatedby
experimentsonreal-time ontrolofaTinvertedpendulum.
The outline of this paper is as follows. Setion 2desribesthe plant dis-
retization and the redution of theoriginal omplexityusing theparameters
dependeny. In setion 3 the losed-loop objetives are stated and expressed
asweightingfuntions in the
H ∞
framework. Setion 4ommentsbriey theaugmentedplantandgivesbakgroundon
H ∞
/LPVontroldesign. Theexper-iments onthe "T" inverted pendulum are desribed in setion 5. Finally, the
paperendswithsomeonlusionsandfurtherresearhdiretions.
2 A sample dependent LPV disrete-time model
Inthissetionthewaytoobtainapolytopidisrete-timemodel,theparameter
ofwhihbeingthesamplingperiod,isdetailed.
Weonsiderastatespaerepresentationofontinuoustime plantsas:
G :
x ˙ = Ax + Bu
y = Cx + Du
(1)where
x ∈ R n
,u ∈ R m
andy ∈ R p
. The exat disretization of this system withazeroorderholdatthesamplingperiodh
leadstothedisrete-timeLPV system(2)G d :
x k+1 = A d (h) x k + B d (h) u k
y k = C d (h) x k + D d (h) u k
(2)
with
A d = e Ah B d = Z h
0
e Aτ dτ B C d = C D d = D
(3)
Thestatespaematriesareusuallyomputedusingexpression(4)and(5) ,
see[9℄.
A d B d
0 I
= exp
A B 0 0
h
(4)
C d = C D d = D
(5)with
h
rangingin[h min ; h max ]
1. Howeverin(4)A d
andB d
arenotaneonh
.2.1 Preliminary approah: Taylor expansion
Ouraim isto get apolytopi model in order to satisfyone of theframeworks
of
H ∞
ontrolfor LPVsystems. We herepropose to approximate the matrix exponentialbyaTaylorseriesoforderN
as:A d (h) ≈ I +
N
X
i=1
A i
i! h i
(6)B d (h) ≈
N
X
i =1
A i −1 B
i! h i
(7)HoweveritiswellknownthattheTaylorapproximationisvalidonlyforparam-
etersnear zero. As
h
is assumedto belong to theinterval[h min
,h max
℄withh min > 0
theapproximationwillbeonsideredaroundthenominalvalueh 0
ofthesampling period,as:
h = h 0 + δ
withh min − h 0 ≤ δ ≤ h max − h 0
(8)Thenweget:
A d B d
0 I
=
A h 0 B h 0
0 I
A δ B δ
0 I
(9)
1
thevariablesamplingperiodshouldbehoseninarangewheretheontrolperformane
ishighly sensitivew.r.t. tothe samplingrate, e.g. aordingtothe ruleof thumb
ω cl h ≈
0.2 . . . 0.6
whereω cl
isthedesiredlosed-loopfrequeny[9℄where
A h 0 B h 0
0 I
= exp
A B 0 0
h 0
,
A δ B δ
0 I
= exp
A B 0 0
δ
Thisleadsto
A d = A h 0 A δ
B d = B h 0 + A h 0 B δ
(10)
Remark 1 When
δ = 0
, thenA δ = I
andB δ = 0
whih means that, asexpeted,
A d = A h 0
andB d = B h 0
.As
h 0
is known at design time and onstant, the Taylorapproximation is thenusedonlyforA δ
andB δ
,as:A d (h) ≈ A h 0 (I +
N
X
i =1
A i
i! δ i ) := A d (δ)
(11)B d (h) ≈ B h 0 + A h 0 (
N
X
i=1
A i −1 B
i! δ i ) := B d (δ)
(12)To evaluate the approximation error due to the Taylor approximation, a
riterionbasedonthe
H ∞
norm ishosenheretoexpress theworstaseerrorbetween
G d e
andG d
, both disrete-time models using respetively the exat method and the approximated one (i.e. the Taylor series approximation oforder
N
).J N = max
h min <h<h max
k G d e (h, z) − G d (h, z) k ∞
(13)2.2 A rst polytopi model
As
h
belongstotheinterval[h min
,h max
℄,thenweandeneH = [δ, δ 2 , . . . , δ N ]
thevetorof parameters.
H
belongsto aonvexpolytope(hyper-polygon)H
(14)with
2 N
verties,.H =
2 N
X
i =1
α i (δ)ω i : α i (δ) ≥ 0,
2 N
X
i =1
α i (δ) = 1
(14)
{δ, δ 2 , . . . , δ N }, δ i ∈ {δ i min , δ max i }
(15)Eahvertexisdenedbyavetor
ω i = [ν i 1 , ν i 2 , . . . , ν i N ]
whereν i j
antaketheextremumvalues
{δ min j
,δ max j }
withδ min = h min −h 0
andδ max = h max −h 0
.The matries
A d (δ)
andB d (δ)
are therefore ane inH
and given by thepolytopiforms:
A d (H) =
2 N
X
i =1
α i (δ)A d i , B d (H ) =
2 N
X
i =1
α i (δ)B d i
where the matries at the verties, i.e.
A d i
andB d i
, are obtained by thealulationof
A d (δ)
andB d (δ)
ateahvertexofthepolytopeH
. Thepolytopioordinates
α i
whih represent the position of a partiular parameter vetorH(δ)
in thepolytopeH
aregivensolving:H (δ) =
2 N
X
i=1
α i (δ)ω i , α i (δ) ≥ 0 ,
2 N
X
i=1
α i (δ) = 1
(16)Asanillustration,gure1showsthis transformationfor
N = 2
withA d 1 = A d (H 1 )
orH 1 = [δ min , δ min 2 ]
A d 2 = A d (H 2 )
orH 2 = [δ max , δ 2 min ] A d 3 = A d (H 3 )
orH 3 = [δ min , δ max 2 ] A d 4 = A d (H 4 )
orH 4 = [δ max , δ max 2 ]
H = Co {H 1 , H 2 , H 3 , H 4 }
δ min δ max
δ δ 2
δ 2 min δ 2 max
H
b b b
b b
A d (H 1 ) A d (H 2 ) A d (H 4 ) A d (H 3 )
Figure1: Exampleofpolytopefor
A d (δ)
withδ min = 0
Thisleadstotheplantpolytopimodel(17)where
G d i
areG d (H )
evaluatedattheverties
ω i
.G d (H ) =
2 N
X
i =1
α i (δ)G d i and H =
2 N
X
i =1
α i (δ)ω i
(17)Asthegain-sheduledontrollerwillbeaonvexombinationof
2 N
"vertex"ontrollers, the hoie of the series order
N
givesa trade-o between theap-proximationaurayand theontrolleromplexity. Indeedoneshould notie
that:
The raw approah does not take into aount the dependene between
δ, δ 2 , . . . , δ N
. Indeed,asshowningure1,thesetofparameters{[δ, δ 2 ], 0 ≤ δ ≤ δ max }
, represented by the paraboli urve, is inluded in the large polytopi box with 4 verties. This will of ourse indue some onser-vatismintheontroldesign.
Moreover, when a the order of the Taylor approximation inreases, we
will see (in setion4.1) that thenumberof LMIs to besolved, whih is
2 ∗2 N +1
willgrowexponentiallywhihanleadtounfeasibleoptimisation problems. Finallytheimplementation oftheontrollerisalsodiretly linkedto the
numberofvertiesofthepolytope.
Toredue the omplexity (and the onservatismof theorresponding ontrol
designaswell),aredutionofthepolytopeisproposed below.
Remark 2 Notethat exatalulations ofmatrix exponential via diagonalisa-
tion or Cayley-Hamilton theorems are more involved here as their expression
willlead tonon anerepresentationsof
A d (H )
andB d (H )
.2.3 Redution of the polytope
It is here proposed to redue the size of the polytope using the dependeny
betweenthe suessivepowersof theparameter
δ
. This redutiononlystandsfor
δ min = 0
, whih means thath 0 = h min
is the minimal sampling period,i.e. relatedwithaslakonstraintonomputingresoure. Forontrolpurpose
thishoieisquitelogialasthenominalbehaviourorrespondstotheminimal
sampling period in normal situations. This period would inrease only when
omputingresoureswill belimited.
Thewaytoreduethesizeofthepolytopisetanbeseenontheexamplein
gure1,wheretheparaboliparameterslousisenlosedinthetriangledened
by
{0, 0}
,{δ max , 0}
and{δ max , δ max 2 }
. Thereforeitisnotneessarytoonsiderthevertex
{0, δ 2 max }
to buildapolytopeenompassingtheparameterslous.Todevelopand extendthismethod toapolytopeofsize
N
,letuswrite:h = h min + δ, 0 ≤ δ ≤ δ max , δ max = h max − h min ,
(18)Thentheinequalitybelowisalwayssatised:
δ δ n ≤ δ max n+1
δ max n δ n
i.e.δ n +1 ≤ δ max δ n
(19)Then it is proposed to delete the verties whih do not satisfy the above
inequality. Astheverties
H i
ofH
aregivenbyavetor(ν 1 , ν 2 , . . . , ν N )
whereν i = 0
orδ i max
aording to the onsidered vertex, then the inequality to besatisedisgivenby:
ν n+1 ≤ δ max ν n
(20)Thisleadstothefollowingsetof admissibleverties:
(0, 0, 0, . . . , 0) (δ max , 0, 0, . . . , 0)
(δ max , δ 2 max , 0, . . . , 0)
(21).
.
.
(δ max , δ 2 max , δ 3 max , . . . , δ max N )
Remark 3 The vertex
(0, δ 2 max , 0, . . . , 0)
does not satisfy inequality (20) andan bedisarded.
Thismethodleadstoasetof
N + 1
vertiesinsteadof2 N
. Notethatthesevertiesarelinearlyindependentandmakeasimplex,whihisitselfbasiallya
polytope[10℄ofminimaldimensiononsideringtheparametersspaeofdimen-
sionN.
When
N = 2
(andfor0 < δ < δ max
)thesquareisdownsizedtothetriangleingure2. When
N = 3
thepyramidin gure3istheredutionofaube.Figure2: PolytoperedutionforN=2
Figure3: PolytoperedutionforN=3
3 Formulation of the
H ∞
/LPV ontrol problemInthissetionwerstpresenttheformulationofthe
H ∞
ontrolproblemusingweighting funtion depending on the sampling period. Indeed the provided
methodologywillallowforperformaneadaptationaordingtotheomputing
resouresavailability.
The
H ∞
frameworkisbasedonthegeneralontrolongurationofgure4,where
W i
andW o
are some weighting funtions representingthe speiation ofthedesiredlosed-loopperformanes(see[11℄). Theobjetiveisheretondaontroller
K
suh internal stability is ahieved andk zk ˜ 2 < γk wk ˜ 2
, whereγ
representsthe
H ∞
attenuationlevel.- - -
-
-
W o
W i
K
z
y w
u
˜
˜ z w
P P ˜
Figure4: Fousedinteronnetion
3.1 Towards disrete-time weighting funtions
Classialontroldesignassumesonstantperformaneobjetivesandprodues
a ontroller with an unique sampling period. The sampling period is hosen
aordingto theontrollerbandwidth,thenoisesensibilityandtheavailability
ofomputationresoures.Whenthesamplingperiodvariestheusableontroller
bandwidthalsovariesandthelosed-loopobjetivesshouldlogiallybeadapted.
Thereforeweproposetoadaptthebandwidthoftheweightingfuntionstothe
samplingperiod.
Themethodologyisasfollows. First
W i
andW o
aresplitintotwoparts : aonstantpartwithonstantpolesand zeros. This allows,forinstane,
toompensateforosillations orexible modes whih are, bydenition,
independentofthesamplingperiod.
thevariablepartontainspolesandzeroswhosepulsationsareexpressed
asananefuntionofthesamplingfrequeny
f = 1/h
. Thisallowsforanadaption of thebandwidth of the weighting funtions, and henefor an
adaption of the losed-loop performane w.r.t. the available omputing
power. These poles and zeros are here onstrained to be real by the
disretizationstep.
First of all the onstant parts of the weightingfuntions are merged with
the ontinuous-time plant model. Then a disrete-time augmented system is
developedaspresentedabove.
Thevariable part
V (s)
ofaweightingfuntion is thedisretizedaordingtothefollowingmethodology:
1. fatorise
V (s)
as aprodut of rst order systems. We here hose polesandzerosdependinglinearlyofthesamplingfrequeny
f = 1/h
,as:V (s) = β Y
i
s − b i f
s − a i f = β Y
i
V i (s)
(22)with
a i , b i ∈ R
2. Considerthestatespaeobservableanonialformfor
V i (s) V i (s) :
( x ˙ i = a i f x i + f (a i − b i ) u i
y i = x i + u i
(23)
3. form the series interonnetion of the statespae representation of eah
V i (s)
. ThisallowstogetV (s)
oftheform(24)withappropriatedimensions ofthestatespaematries.V (s) :
x ˙ v = A v f x v + B v f u v
y v = C v x v + D v u v
(24)
4. Get thedisrete-time state spaerepresentation of
V (s)
. Thanks totheanedependenein
f
in(24)thedisrete-timemodelofthevariablepart beomesindependentofh
sine:
A v d = e A v f h = e A v
B v d = (A v f ) −1 (A v d − I)B v f = (A v ) −1 (A v d − I)B v
C v d = C v and D v d = D v
(25)
Remark4 Theserial interonnetionof twosystemsofthe form (26)leads to
asystemofthe form (27) .
( x ˙ = Af x + Bf u
y = C x + D u
(26)A =
A 1 0 B 2 C 1 A 2
B =
B 1
B 2 D 1
x =
x 1
x 2
C = D 2 C 1 C 2
D = D 2 D 1
(27)
Asseenmatries
C
andD
onlydepend onC i
orD i
,i = 1, 2
,whihensuresthat they do not depend on
f
. Then there is no oupling betweenA i
andB i
,i = 1, 2
,whih keepsthelineardependeneonf
ofthe statespae equation. Asillustration andforward, the interonnetionof 3systemsleads toastatespae
representation (28):
A =
A 1 0 0
B 2 C 1 A 2 0 B 3 D 2 C 1 B 3 C 2 A 3
B =
B 1
B 2 D 1
B 3 D 2 D 1
x =
x 1
x 2
x 3
C = D 3 D 2 C 1 D 3 C 2 C 3
D = D 3 D 2 D 1
(28)
By iteration, the serial interonnetion of more than three systems (26) still
keepsthe form (26). Therefore the interonnetion of systems
V i (p)
whih arein form (26) leads to a system in the form (24) where the dependene on
f
makeseasier the disretizationstep.
Remark5 The simpliation between
f
andh
in (25) makes easy the dis-retizationstep. Thisiswhytheplantandtheweightingfuntionsareseparately
disretized, andthe augmentedplant is obtainedin disrete timeafterwards by
interonnetion. Thisisalsoaonsequeneoftheuseoftheobservableanonial
form.
3.2 The disrete-time augmented plant
Let us herepresent theoverall methodologyto get thedisrete-time plantin-
teronnetion.
Let rst onsider the followingontinuous-time model where the onstant
part of the weighting funtion
W i
andW o
has been onneted to the plantmodel:
P :
˙
x(t) = Ax(t) + B w w(t) + B u u(t) z(t) = C z x(t) + D zw w(t) + D zu u(t) y(t) = C y x(t) + D yw w(t) + D yu u(t)
(29)
where
x ∈ R n
isthestate,w ∈ R m w
representstheexogenousinputs,u ∈ R m u
theontrolinputs,
z ∈ R p z
theontrolledoutputandy ∈ R p y
themeasurement vetor.Adisrete-time representationofthe abovesystemis rstobtainedthanks
to the previous methodology. For simpliity we will note, aording to the
representation(1):
A = A B = B w B u
C = C z
C y
D =
D zw D zu
D yw D yu
(30)
Using the Taylor approximation at order
N
leads to apolytopeH
. Thispolytopehas
r
verties(wherer
equals2 N
forthebasiaseandN + 1
fortheredued one). Eah of the
r
verties is desribed by a vetorω i
of the form(δ 1 , δ 2 , . . . , δ r )
whereδ i
=δ i min
orδ i max
.TheLPVpolytopidisrete-timemodelisgivenby:
P (H) :
x k +1 = A(H )x k + B w (H )w + B u (H )u z = C z x k + D zw w + D zu u
y = C y x k + D yw w + D yu u
(31)
H = δ δ 2 . . . δ N
H ∈ H = Co {ω 1 , . . . , ω r } H =
r
X
i=1
α i ω i A(H) =
r
X
i=1
α i A i r
X
i=1
α i = 1 α i ≥ 0
(32)where, aordingtotherepresentation(2)
A d = A B d = B w B u
C d = C D d = D
(33)Now, the variable part of the weighting funtions
W i
andW o
are expressedaspreviouslypresented,whih leadsto bothdisrete-timerepresentations(34)
and(35)wherethesizeofthestatevetordependontheweightingfuntion:
W I :
( x I k+1 = A I x I k + B I w ˜ w = C I x I k + D I w ˜
(34)
W O :
( x O k+1 = A O x O k + B O z
˜
z = C O x O k + D O z
(35)Theaugmentedsystem
P ′ (H )
is obtainedbytheinteronnetion ofP (H)
,W I
andW O
. Therefore we obtain the following LPV polytopi disrete-time systemofstatevetorx ′ k = (x k x I k x O k ) T
:P ′ (H ) :
x ′ k +1 = A ′ (H )x ′ k + B ′ w (H ) ˜ w + B ′ u (H )u
˜
z = C z ′ x ′ k + D ′ zw w ˜ + D ′ zu u y = C y ′ x ′ k + D yw ′ w ˜ + D yu ′ u
(36)
with
A ′ (H ) =
A(H ) B w (H )C I 0
0 A I 0
B O C z B O D zw C I A O
B w ′ (H ) =
B w (H)D I
B I
B O D zw D I
B ′ u (H ) =
B u (H)
0 B O D zu
C z ′ = D O C z D O D zw C I C O
D ′ zw = D O D zw D I
D ′ zu = D O D zu C y ′ = C y D yw C I 0
D ′ yw = D yw D I
D yu ′ = D yu
4 Solution to the
H ∞
ontrol problem for LPVsystems
Weaimtouseherethe
H ∞
ontroldesignforlinearparameter-varyingsystems asstated in [7℄. Let the disrete-time LPV plant, mappingexogenous inputsw
andontrol inputsu
to ontrolled outputsz
and measuredoutputsy
, withx ∈ R n x
,begivenbythepolytopimodel:
x k+1 = A ′ (H )x k + B ′ w (H )w + B ′ u (H )u z = C z ′ x k + D zw ′ w + D ′ zu u
y = C y ′ x k + D ′ yw w + D ′ yu u
(37)
wherethedependeneofthestatespaematrieson
H
isaneandtheparam-etervetor
H
,rangesoveraxedpolytopeH
withr
vertiesω i
H = ( r
X
i =1
α i (δ)ω i : α i (δ) ≥ 0,
r
X
i =1
α i (δ) = 1 )
(38)
where
r
is equaltoN + 1
orto2 N
aordingtothekindofpolytope(reduedorfull).
4.1 Problem resolvability
Themethod onsideredhererequires thefollowingassumptions:
(A1)
D ′ yu (H) = 0
(A2)
B u ′ (H ), C ′ y , D ′ zu , D ′ yw
areparameter-independent(A3) the pairs
(A ′ (H), B ′ u (H ))
and(A ′ (H ), C y ′ )
are quadratially stabilisable anddetetable overH
respetively,Remark6 In (37)assumption (A2)isnotsatisedduetothe
B u (H )
terminB ′ u (H )
. To avoid this, a stritly proper lter isadded on the ontrol input, asexplained in [12 , 13 ℄. Itis anumerial artifat (whih of ourse inreases the
number of state variables
n e > n x
), therefore its bandwidth should be hosenhigh enough tobenegligible regarding theplant andobjetive bandwidths.
Proposition1 Following [7 ℄ , under the previous assumptions there exists a
gain-sheduledontroller(Figure 5 )
x K k+1 = A K (H )x K k + B K (H)y k
u k = C K (H )x K k + D K (H )y k
(39)
where
x K ∈ R n e
,whih ensures, overall parametertrajetories,that : thelosed-loop systemisinternallyquadratistable;
the
L 2
-induednorm of the operator mappingw
intoz
isbounded byγ
,i.e.
kzk 2 < γkwk 2
if andonly ifthereexist
γ
andtwosymmetri matries(R, S)
satisfying2r + 1
LMIs(whih are omputedo-line) :
N R 0 0 I
T
L 1
N R 0 0 I
< 0, i = 1 . . . r
(40)N S 0
0 I T
L 2
N S 0 0 I
< 0, i = 1 . . . r
(41)R I
I S
≥ 0
(42)where
L 1 =
A ¯ i R A ¯ T i − R A ¯ i RC 1 T i B ¯ 1i
C ¯ 1i R A ¯ T i −γI + ¯ C 1i R C ¯ 1 T i D ¯ 11i
B ¯ T 1 i D ¯ T 11 i −γI
L 2 =
A ¯ T i S A ¯ i − S A ¯ T i S B ¯ 1 i C ¯ 1i T B ¯ T 1i S A ¯ i −γI + B T 1i S B ¯ 1 i D ¯ T 11i
C ¯ 1i D ¯ 11i −γI
where
A ¯ i
,B ¯ 1i
,C ¯ 1i
,D ¯ 11i
areA(H) ¯
,B w ′ (H)
,C z ′ (H )
,D ′ zw (H )
evaluated atthe
i th
vertexoftheparameterpolytope.N S
andN R
denotebasesofnullspaesof
( ¯ B 2 T , D ¯ T 12 )
and( ¯ C 2 , D ¯ 21 )
respetively.P (H )
K(H ) -
- -
u y
˜ z
˜ w
H
Figure5: Closed-loopoftheLPVsystem
4.2 Controller reonstrution
One
R
,S
andγ
areobtained,theontrollersarereonstrutedateahvertex oftheparameterpolytopeasshownin[12℄. Thegain-sheduledontrollerK(H )
isthentheonvexombinationof theseontrollers
K ( H ) :
„ A K ( H ) B K ( H ) C K ( H ) D K ( H )
«
=
r
X
i =1
α i ( δ )
„ A K i B K i
C K i D K i
«
(43)
with α i ( δ ) such that H =
r
X
i =1
α i ( δ ) ω i
(44)Notethaton-lineshedulingoftheontrollerneedstheomputationof
α i (δ)
knowing
h
. Forthefullpolytopeasethepolytopioordinatesaresolutionsofthefollowingunder-onstrainedsystem([14,15℄):
( P 2 N
i =1 α i (δ)ω i = H = [δ, δ 2 , ..., δ N ] P 2 N
i=1 α i (δ) = 1, α i (δ) ≥ 0
(45)
whihanbesolvedusinganalgorithmoftheLMItoolbox[16℄. Whenthepoly-
topeis reduedto a simplex(using inequality (20)) the polytopi oordinates
aregivensolvingasimplersystem:
( P N +1
i =1 α i (δ)ω i = H = [δ, δ 2 , ..., δ N ] P N +1
i =1 α i (δ) = 1, α i (δ) ≥ 0
(46)forwhihexpliitsolutionsareeasily reursivelyomputed:
α 1 = δ max δ max − δ − min δ
α n = δ n δ n max − δ n
max − δ n min − P n −1
1 α i , n = [2, ..., N]
α N +1 = 1 − P N 1 α i
(47)
Thisleads, forthease
N = 2
andδ min = 0
of thenextsetion tothe simpleexpliitsolutions:
α 1 = δ max − δ δ max
, α 2 = δ max 2 − δ 2
δ max 2 − α 1 , α 3 = 1 − (α 1 + α 2 )
5 Control of the T inverted pendulum
This setionis devoted to anexperimental validation of the approah using a
"T"invertedpendulumofEduationalControlProduts 2
,availableatGIPSA-
lab,in theNeCS (Network Controlled Systems)team. These experimentswill
emphasisetheeetiveness oftheproposeddesignmethod.
2
http://www.epsystems. om/ ont rols _pe ndul um.h tm
5.1 System desription
The pendulum shown in gures6 and 7 is made of tworods. A vertialone
whihrotatesaroundthepivotaxle,andanhorizontalslidingbalaneone. Two
optionalmassesallowtomodifytheplant'sdynamialbehaviour.
Theontrolatuator(DCmotor)deliversafore
u
tothehorizontalslidingrod,throughadrivegear-rak.
The
θ
angle,positiveinthetrigonometrisense,ismeasuredbytherodangle sensor. Thepositionz
ofthehorizontalrodismeasuredbyasensorloatedatthemotoraxle.
TheDCmotoris torqueontrolledusing aloal urrentfeedbakloop(as-
sumedtobeasimplegainduetoitsfastdynamis). Thedynamialbehaviour
ofthesensorsisalsonegleted.
Figure6: PitureoftheTpendulum
θ(t) z(t) u(t)
Figure 7: Coordinatesof theT pendu-
lum
5.2 Modelling
A mehanialmodelof thependulum ispresentedbelow, whih takesinto a-
ountthevisousfrition(butnottheCoulombfrition).
m 1 m 1 l 0
m 1 l 0 J ¯
¨ z θ ¨
+
−f v z −m 1 z θ ˙ 2m 1 z θ ˙ 0
˙ z θ ˙
+
−m 1 sin θ
−(m 1 l 0 + m 2 l c ) sin θ − m 1 z cos θ
g = u
0
(48)
wherethetimedependeneofthestatevariablesisimpliit,andtheparameter
valuesofgivenbelowintable 1.
Table1: Parameters
Name Value Desription
m 1
0.217kg horizontalslidingrodmassm 2
1.795kg vertialrodmassl 0
0.33 vertialrodlengthl c
-0.032m vertialrodpositionoftheentreofgravityg
9.81m.s−2
gravityaelerationJ ¯
0.061Nm2
Nominalinertiaf v z
0.1kg.s−1
visousfrition
Choosing thestatevetoras
x = [z, z, θ, ˙ θ] ˙
,weget thefollowingnon linearstatespaerepresentation:
˙ x 1 = x 2
˙
x 2 = −l 0 x ˙ 4 + x 1 x 2 4 + g sin x 3 − f v z
m 1
x 2 + u m 1
˙ x 3 = x 4
˙
x 4 = 1 J 0 (x 1 ) − m 1 l 2 0
(+g(m 1 x 1 cos x 3 + m 2 l c sin x 3 )
−m 1 (l 0 x 4 + 2x 2 )x 1 x 4 − l 0 u)
(49)
with
J 0 (x 1 ) = ¯ J + m 1 x 2 1
. Thesteady-statelinearisationaroundx = [0, 0, 0, 0]
givesthelinearstatespae representation
x(t) = ˙ Ax(t) + Bu(t)
,y(t) = Cx(t)
with
A =
0 1 0 0
− l 0 gm 1
J ¯ − m 1 l 2 0 − f m vz 1 − J ¯ l − 0 gm m 1 2 l l 2 0 c + g 0
0 0 0 1
gm 1
J ¯ − m 1 l 0 0 J ¯ gm − m 2 1 l c l 2 0 0
, B =
0
l 2 0
J ¯ − m 1 l 2 0 + m 1
1
0
− l 0
J ¯ − m 1 l 2 0
C =
1 0 0 0 0 0 1 0
whihgivesnumerially:
A = 0 B B
@
0 1 0 0
− 18 . 79 − 0 . 46 14 . 82 0
0 0 0 1
56 . 92 0 −15 . 18 0 1 C C A
B = 0 B B
@ 0 7 . 52
0
−8 . 82 1 C C A
(50)
The poles of the linear model are
p 1,2 = −0.122 ± 6.784
,p 3 = −3.592
andp 4 = 3.376
.5.3 Performane speiation
Assuh aTpendulum systemisdiult to be ontrolled,ourmain objetive
isheretogetalosed-loopstable system,to emphasisethepratialfeasibility
oftheproposedmethodologyforreal-timeontrol.
Frompreviousexperimentswiththis plantthesampling periodis assumed
tobeintheinterval
[1, 3] ms
.The hosen performane objetives are represented in gure 8, where the
trakingerrorandtheontrolinputareweighted(asusualinthe
H ∞
method-ology).
+ d u
+ G
r K y
W u
M
W e
+
− θ
˜ e
˜ u
Figure 8: Generalontrolonguration
Thisorrespondsto thesimplemixedsensitivityproblem givenin(51).
W e (I − M S y GK 1 ) W e M S y G W u S u K 1 W u T u
∞
≤ γ
(51)with
K =
K 1 K 2
M =
0 0 1 0 S u = (I − K 2 G) −1 S y = (I − GK 2 ) −1
T u = −K 2 G(I − K 2 G) −1
(52)Theperformaneobjetivesarerepresentedbyweightingfuntionsandmaybe
givenbytheusualtransferfuntions [11℄:
W e (p, f) = p M S + ω S (f ) p + ω S ǫ S
ω S (f ) = h min ω S max f
(53)W u (p, f) = 1 M U
(54)
where
f = 1/h
,ω S max
=1,5rad/s,M S
=2,ǫ S
=0.01andM U
=5.Notiethat only
W e
dependsonthesamplingfrequenytoaountforper-formaneadaptation.
5.4 Polytopi disrete-time model
We follow herethemethodology proposed in setion2. Theapproximationis
donearoundthenominal period
h o = 1ms
,forh ∈ [1, 3] ms
,i.e.δ h ∈ [0, 2] ms
(seeRemark2).
On gure 9 the riterion (13) is evaluated for dierent sampling periods
(
h ∈ [1, 3]ms
) and dierent orders of the Taylor expansions (k ∈ [1, 5]
). Itshowsthatthis errormaybelargeonlyiftheorder
1
isused.On gure10
|G d e (δ h , z) − G d (δ h , z)|
is plotted aordingto the frequeny,evaluatedfor
5
samplingperiods(i.e.δ h ∈ [0, 2]ms
)andfortwoasesofTaylorexpansions (
2
and4
). This allows to onlude that the hoie of an order2
ofthe Taylorexpansionis alreadyquite good asit leadsto an approximation
errorless than
−40dB
in the seleted sampling frequenyinterval. Note thathoosingthease"order2"leadstoareduedpolytopewith
3
verties.1 1.5 2 2.5
3 1
2 3 4 5 10 −20
10 −15 10 −10 10 −5 10 0 10 5
k Erreur d’approximation : hinfnorm (G
approx −G d )
h (ms)
Erreur
Figure9: Approximationerror
5.5 LPV/
H ∞
designTherststep isthedisretization of theweightingfuntions. Theaugmented
systemis got, using apreliminary rst-order lteringof theontrol input, to
satisfythedesignassumptions. Theaugmentedsystemisoforder
6
.Applying the designmethod developed in setion 4 leadsto the following re-
sults,ombiningtheTaylorexpansionorderandthepolytoperedution:
Polytope Nb verties
γ opt
TaylororderN=2 full 4 1.1304
TaylororderN=2 redued 3 1.1299
TaylororderN=4 full 16 1.1313
TaylororderN=4 redued 5 1.1303
Thistableemphasisesthatbothdesignoforders2and4arereliable. Forim-
plementationreasons(simpliityandomputationalomplexity)wehavehosen
theaseofthereduedpolytopeusingaTaylorexpansionoforder2.
Theorrespondingsensitivityfuntionsofthehosendesignareshowning-
ure11. Using
S e = e/r
thesteady-statetrakingerrorislessthan−46dB
,withavaryingbandwidthfrom
0.4
to1.2 rad/s
, i.e theratio3,speiedaordingtotheintervalofsamplingperiod, issatised.
10 −2 10 0 10 2 10 4
−350
−300
−250
−200
−150
−100
−50 0
N=2
Magnitude (dB)
10 −2 10 0 10 2 10 4
−350
−300
−250
−200
−150
−100
−50 0
N=4
Frequency (rad/s)
Magnitude (dB)
Figure10:
|G d e (δ h , z) − G d (δ h , z)|
for6= h
-Taylororder2and4Thepeak valueof
S u K 1
varies from1.2
to10.8dB
, whih isreasonableforthe ontrol gain. Note that in this partiular ase study we will benetfrom
the relativelyhigh sensitivity in high frequenies, asit allowssome persistent
ditheringin theontrolationand reduestheeet offrition, aswewill see
in theexperiments.
Finallythefuntion
M S y Gd u
is verylowsothat theeetofinput distur-bane
d u
onthetrakingerrorwill begreatlyattenuated.Figure12showsthetime-domainresponseofthenonlinearpendulummodel
(angleand position)interonneted withthedisrete-timeLPVsamplingvari-
able ontroller (here for dierent frozenvaluesof the sampling periods). The
settling time varies from
1.1
to4.8
se, i.e. in aratio4.3
. Indeed weobserveherethegraefulandontrolleddegradationoftheperformaneduetotheadap-
tionof thesamplingdependentweightingfuntions. There isnoovershoot,as
expetedfrom thefrequenyresponsesof thesensitivityfuntion
S y GK 1
.5.6 Simulation results
Inthissetion,theappliationoftheproposedsamplingvariableontrollerwhen
thesamplingperiod varieson-linebetween
1
and3
mse. isprovided.Twoases are presented. First in gure13 the sampling period variation
is ontinuous and followsa sinusoidalsignal of frequeny
0.15rad/s
. Then ingure14somestephangesofthesamplingperiodaredone.
10 −2 10 0 10 2
−60
−40
−20 0 20
1/Wed Se
10 −2 10 0 10 2
−150
−100
−50 0 50
1/Wud SuK1
10 −2 10 0 10 2
−150
−100
−50 0 50
1/Wed MSyGdu
10 −2 10 0 10 2
−150
−100
−50 0
SyGK1 Se (e/r)
Frequency (rad/sec)
Singular Values (dB)
SuK1 (u/r)
Frequency (rad/sec)
Singular Values (dB)
MSyGdu (e/du)
Frequency (rad/sec)
Singular Values (dB)
SyGK1 (y/r)
Frequency (rad/sec)
Singular Values (dB)
Figure11: Sensitivityfuntions
0 1 2 3 4 5 6 7 8 9 10
−0.05 0 0.05 0.1 0.15 0.2
θ (rad)
Réponse indicielle du procédé non linéaire à temps continu
0 1 2 3 4 5 6 7 8 9 10
−0.06
−0.04
−0.02 0 0.02 0.04
z (m)
Temps (s)
Figure12: Responsetimeoftheontinuoustimenon-linearproess
These results show that, as expeted from the performane speiation,
thesettlingtimeofthelosed-loopsystemvariesaordinglywiththesampling
period. Whentheperiodislarge(i.eat
t = 10sec
)thependulumisslower,whilewhentheperiodissmall(i.eat
t = 30sec
inFig. 13)thependulumresponseisfaster.Moreover,thankstotheLPVapproah,thevariations(sinusoidalorstep
hanges)ofthesamplingperioddonotleadtoabrupttransientofthependulum
behaviour. This is a great benet from the LPV approah whih ensuresthe
stability forarbitrarily fast variationsof theparameter in their allowed range
(this is due to the use of a single Lyapunov funtion in the design [7℄). The
sameassessmentanbedonefortheontrolinput.
TheLPVshemeallowsheretoguaranteethelosed-loopquadratistability,
tohaveabounded
L 2
-induednormforallvariationofthesamplingperiodand tohaveapreditable losed-loopbehaviour.0 10 20 30 40 50 60 70 80 90
−0.4
−0.2 0 0.2 0.4
Angle du pendule
θ [rad]
r θ
0 10 20 30 40 50 60 70 80 90
−2
−1 0 1 2
u []
Commande
0 10 20 30 40 50 60 70 80 90
1 1.5 2 2.5
3 x 10 −3
h [s]
Période d’échantillonnage
Temps [s]
Figure13: MotionoftheTpendulum underasinusoidalsamplingperiod
0 10 20 30 40 50 60 70 80 90
−0.4
−0.2 0 0.2 0.4
Angle du pendule
θ [rad]
r θ
0 10 20 30 40 50 60 70 80 90
−2
−1 0 1 2
u []
Commande
0 10 20 30 40 50 60 70 80 90
0 1 2 3 4 x 10 −3
h [s]
Période d’échantillonnage
Temps [s]
Figure14: MotionoftheTpendulumunder asquaresamplingperiod
5.7 Experiments
Thesenarii of theprevioussetion (simulationresults) are now implemented
forthereal plantofgure6. TheplantisontrolledthroughMatlab/Simulink
usingtheReal-time WorkshopandxPCTarget.
0 10 20 30 40 50 60 70 80 90
−0.5 0 0.5
θ [rad]
Pendulum angle
0 10 20 30 40 50 60 70 80 90
−4
−2 0 2 4
u []
Control input
0 10 20 30 40 50 60 70 80 90
1 1.5 2 2.5
3 x 10 −3
Time [s]
h [s]
Sampling period
r θ
u
h
Figure15: ExperimentalmotionoftheTpendulumunderasinusoidalsampling
period
0 10 20 30 40 50 60 70 80 90
−0.5 0 0.5
θ [rad]
Pendulum angle
0 10 20 30 40 50 60 70 80 90
−5 0 5
u []
Control input
0 10 20 30 40 50 60 70 80 90
0 1 2 3 4 x 10 −3
Time [s]
h [s]
h u r θ
Figure 16: Experimental motion ofthe T pendulum under asquare sampling
period
Theresultsare given in gures15 and16. Asin the previoussetion, the
settlingtimeismaximalwhenthesamplingperiodismaximal,andonversely.
Inthesameway,thereisnoabrupthangesintheontrolinput(evenwhenthe
samplingperiodabruptlyvariesfrom1to3ms asingure16).
Note that,as explainedbefore, thereal ontrol input is sensitiveto noise,
allowing to minimise the frition eet, and therefore to obtaina losed-loop
systemwithmuh lessosillations.
Finally we get similar results in simulation and experimental tests whih
showstheinherentrobustnesspropertyofthe
H ∞
design.These resultsemphasise the great advantage and exibility of themethod
when the available omputing resouresmay vary, and when sampling period
variationsareusedtohandleomputingexibilitysuhasin [4℄.
6 Conlusion
In this paper, an LPV approah is proposed to design a disrete-time linear
ontrollerwithavaryingsamplingperiodandvarying performanes. Awayto
redue thepolytopefrom
2 N
toN + 1
verties (whereN
is the Taylor orderexpansion)isprovided,whihdrastiallyreduesboththeonservatismandthe
omplexityof theresultingsampling dependentontrollerandmakesthesolu-
tion easierto implement. Further developmentsmay onernthe redutionof
theonservatismwhih isdue to tothe useaonstant Lyapunovfuntion ap-
proah,whihisknowntoprodueasub-optimalontroller. Anotherapproah
basedon [17℄is presentedin [13℄ but upto now didnotgiveimprovementsin
theresults.
Also the omplete methodology has been implemented for the ase of a
"T"invertedpendulum,whereexperimentalresultshavebeenprovided. These
resultsemphasisetherealeetivenessoftheLPVapproahaswellasitsinterest
intheontextofadaptationtovaryingproessorornetworkloadwhereabankof
swithingontrollerswouldneedtoomuhresoures. Inourase,usingasingle
ontroller synthesis,the stability andperformane property ofthe losed-loop
systemareguaranteedwhateverthespeedofvariationsofthesamplingperiod
are. In addition we also observed an interesting robustness of this ontroller
w.r.t. samplinginauraies,e.g. whihould beinduedbypreemptions ina
multi-taskingoperatingsystems.Asshowninpreliminarystudies([4,13℄),these
propertiesareofprimeinterestinthedesignofmoreomplexsystemsombining
several suhontrollersunder supervisionofafeedbak-sheduler: theontrol
periodsanbevariedarbitrarilyfastbyanoutershedulingloopunder aQoS
objetivewithnoriskofjeopardisingtheplantsstability. Howeverthespei
robustnessw.r.t. timingunertaintiesdeserveto befurtherinvestigated.
Referenes
[1℄ A. Cervin and J. Eker, Feedbak sheduling of ontrol tasks, in Pro-
eedings of the 39th IEEE Conferene on Deision and Control, Sydney,
Australia,De.2000.
[2℄ A. Cervin, J. Eker, B. Bernhardsson, and K.-E. Årzén, Feedbak-
feedforwardshedulingof ontrol tasks, Real-Time Systems, vol. 23, no.
12,pp.2553,July2002.
[3℄ J.Eker,P.Hagander,andK.-E.Årzén,Afeedbakshedulerforreal-time
ontroller tasks, Control Engineering Pratie, vol. 8, no. 12, pp. 1369
1378,De.2000.
[4℄ D. Simon, D. Robert, and O. Sename, Robust ontrol/sheduling o-
design: appliation to robot ontrol, in RTAS'05 IEEE Real-Time and
Embedded Tehnology andAppliations Symposium,SanFraniso,marh
2005.
[5℄ D. Robert, O. Sename, and D. Simon, Sampling period dependent rst
ontrollerusedinontrol/shedulingo-design, inProeedings ofthe16th
IFACWorld Congress,Czeh Republi,July2005.
[6℄ ,SynthesisofasamplingperioddependentontrollerusingLPVap-
proah, in 5thIFACSymposiumon RobustControlDesign ROCOND'06,
Toulouse,Frane,july2006.
[7℄ P. Apkarian, P. Gahinet, and G. Beker, Self-sheduled H
∞
ontrol oflinearparameter-varyingsystems: Adesignexample,Automatia,vol.31,
no.9,pp.12511262,1995.
[8℄ K.Tan,K.-M.Grigoriadis,and F.Wu, Output-feedbakontrolof LPV
sampled-datasystems,Int.JournalofControl,vol.75,no.4,pp.252264,
2002.
[9℄ K.J. ÅströmandB.Wittenmark,Computer-Controlled Systems,3rded.,
ser.Information and systemssienesseries. New Jersey: Prentie Hall,
1997.
[10℄ S. BoydandL.Vandenberghe,ConvexOptimization. CambridgeUniver-
sityPress,2004.
[11℄ S.SkogestadandI.Postlethwaite,MultivariableFeedbakControl: analysis
anddesign. JohnWileyandSons,1996.
[12℄ P. Gahinet and P. Apkarian,A linearmatrix inequality approah to
h ∞
ontrol,InternationalJournalofRobustandNonlinearControl,vol.4,pp.
421448,1994.
[13℄ D.Robert,Contributiontoontrolandshedulinginteration, Ph.D.dis-
sertation,INPG-Laboratoired'AutomatiquedeGrenoble(infrenh),jan-
uary11,2007.
[14℄ J.-M. Bianni,Commanderobuste dessystèmes àparamètresvariables,
Ph.D. dissertation,ENSAE, Toulouse,Frane,1996.
[15℄ A. Zin, On robust ontrol of vehile suspensions with a view to global
hassisontrol,Ph.D.dissertation,INPG-Laboratoired'Automatiquede
Grenoble, november3,2005.
[16℄ P. Gahinet, Expliit ontroller formulas for LMI-based H
∞
synthesis,Automatia,vol.32,no.7,pp.100714,1996.
[17℄ M. Oliveira, J. Geromel, and J. Bernussou, Extended h2 and hinf norm
haraterizations and ontroller parametrizations for disrete-time sys-
tems, International JournalofControl,vol.75,no.9,pp.666679,2002.
655, avenue de l’Europe - 38334 Montbonnot Saint-Ismier (France)
Centre de recherche INRIA Futurs : Parc Orsay Université - ZAC des Vignes 4, rue Jacques Monod - 91893 ORSAY Cedex
Centre de recherche INRIA Nancy – Grand Est : LORIA, Technopôle de Nancy-Brabois - Campus scientifique 615, rue du Jardin Botanique - BP 101 - 54602 Villers-lès-Nancy Cedex
Centre de recherche INRIA Rennes – Bretagne Atlantique : IRISA, Campus universitaire de Beaulieu - 35042 Rennes Cedex Centre de recherche INRIA Paris – Rocquencourt : Domaine de Voluceau - Rocquencourt - BP 105 - 78153 Le Chesnay Cedex Centre de recherche INRIA Sophia Antipolis – Méditerranée : 2004, route des Lucioles - BP 93 - 06902 Sophia Antipolis Cedex
Éditeur
INRIA - Domaine de Voluceau - Rocquencourt, BP 105 - 78153 Le Chesnay Cedex (France)
http://www.inria.fr