Robust Simple Adaptive Control with Relaxed Passivity and PID control...

14
Robust Simple Adaptive Control with Relaxed Passivity and PID control of a Helicopter Benchmark Dimitri Peaucelle Vincent Mahout Boris Andrievsky Alexander Fradkov IFAC World Congress / Milano / August 28 - September 2, 2011

Transcript of Robust Simple Adaptive Control with Relaxed Passivity and PID control...

Page 1: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Robust Simple Adaptive Control with Relaxed Passivity

and PID control of a Helicopter Benchmark

Dimitri Peaucelle

Vincent Mahout

Boris Andrievsky

Alexander Fradkov

IFAC World Congress / Milano / August 28 - September 2, 2011

Page 2: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Introduction

n Considered problem:

l Stabilization with simple adaptive control

u = Ky , K̇ = −GyyT Γ + φ

l For MIMO LTI systems

Σ

K

yu

n Assumptions:

l There exists a (given) stabilizing PI control

u = FPy + FI

∫Ey

Σyu

F

E

n Why simple adaptive control?

l Expected to be more robust

l No need for estimation K 6= F (θ̂)

yuΣ

θ

K

1 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 3: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Outline

n PI structure of the adaptive controller

l Adaptation that stops as the output reaches the reference

n Design of the adaptive law: K̇ = −GyyT Γ + φ

l Virtual feedthrough D & barrier function φ for bounding K

l LMI based results⇒ guaranteed robustness

n Preliminary tests on a 3D helicopter Benchmark

l Adaptive PID

2 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 4: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

PI structure of Adaptive Control

n Assumptions:

l There exists a (given) stabilizing PI control

u = FP (y − yref ) + FI

∫E(y − yref )

l Integral term: precision to constant reference

u+

−yref

F

E

n Impossible to apply the following adaptive control:

u = Kη , K̇ = −GηηT Γ + φ , η =

(y − yref∫E(y − yref )

)

Σu

+y

−yref

E

K

NO! because∫E(y − yref ) does not go to 0

3 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 5: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

PI structure of Adaptive Control

n Proposed PI adaptive control law: u = KP (y − yref ) +KI

∫E(y − yref )

K̇P = −GP

y − yref∫E(y − yref )

(y − yref )T ΓP + φP

K̇I = −GI(y − yref )(∫

E(y − yref ))T

ΓI + φI

l When (y − yref ) goes to zero adaptation stops

n Results applicable to any controller structure of the type

u = K1y1 +K2y2 ,K̇1 = −G1z1y

T1 Γ1 + φ1

K̇2 = −G2z2yT2 Γ2 + φ2

as long as stability and/or tracking imply that y1 and z2 go to zero.

l Can also be extended to more than 2 terms (u = K1y1+K2y2+K3y3+. . .)

4 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 6: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Design of the adaptive law

n Passivity-Based Adaptive Control [Fradkov 1974, 2003]

& Simple Adaptive Control [Kaufman, Barkana, Sobel 94]

l Let Σ ∼ (A,B,C,D) be a MIMO system with m inputs / p ≥ m outputs.

l If ∃ (G,F ) ∈ (Rp×m)2 such that the following system is passive

y+

zv

F

G

l then the following adaptive law stabilizes the system for all Γ > 0

K̇ = −GyyT Γ , u = Ky

5 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 7: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Design of the adaptive law

n Proposed result

l If ∃ (G1, G2, F1, F2, D1, D2) such that the system below is passive

2

+

+z

z1

2 2

1

u Σ

1

2

y1 y

2

1

FF

GG

DD

l then the following adaptive law stabilizes the system for all Γ1 > 0, Γ2 > 0

u = K1y1 +K2y2 ,K̇1 = −G1z1y

T1 Γ1 − φ1(K1)

K̇2 = −G2z2yT2 Γ2 − φ2(K2)

where φ1(K1) and φ1(K2) are to be determined (depend of D1 and D2).

6 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 8: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Design of the adaptive law

n 2 step LMI design procedure

l Step 1: Given stabilizingF1,F2 solve LMI problemL1 to get (G1, G2, D1, D2):

L1 :

AT (F1, F2)P + PA(F1, F2) PB − C1T G1

T PB − CT2 G2

T

BT P −G1C1 −2D1 0

BT P −G2C2 0 −2D2

< 0.

l Step 2: Given (G1, G2, F1, F2, D1, D2) solve LMI problem L2 (see paper)

to get α1 and α2 that define the functions φ1, φ2:

dead-zone: φi(Ki) = 0 if Tr((Ki − Fi)

TDi(Ki − Fi))≤ αi

barrier: φi(Ki)→ +∞ if Tr((Ki − Fi)

TDi(Ki − Fi))→ αiβ

7 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 9: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Design of the adaptive law

n Properties of the LMI design procedure

l Applicable as soon as there is a given stabilizing control F1, F2

l The TV gains K1, K2 are guaranteed to be bounded in

Tr((Ki(t)− Fi)

TDi(Ki(t)− Fi))< αiβ

l It is possible to maximize the domain of admissible adaptation values by

minimizing Tr(Di) in the first LMI step

maximizing αi in the second LMI step

l Proof of stability with adaptive control using Lyapunov function

V (x,K1, K2) = xTQx+2∑

i=1

Tr(

(Ki − F̂i)Γi−1(Ki − F̂i)

T)

where Q, F̂1 and F̂2 are solutions to the LMI problem L2

8 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 10: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Design of the adaptive law

n Robustness properties of the LMI design procedure

l In case of polytopic uncertainties[A(ζ) B(ζ)

]=

N∑j=1

ζj

[A[j] B[j]

],

N∑j=1

ζj = 1 , ζj ≥ 0

l Robust LMI version of second step (based on slack variables technique)

proves stability with parameter-dependent Lyapunov function

V (x,K1, K2, ζ) = xTQ(ζ)x+2∑

i=1

Tr(

(Ki − F̂i(ζ))Γi−1(Ki − F̂i(ζ))T

)where Q(ζ) =

∑Nj=1 ζjQ

[j] and F̂i(ζ) =∑N

j=1 ζjF̂[j]i .

9 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 11: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

3DOF Helicopter control

n 3DOF helicopter from Quanser c© - LAAS configuration

l All states measured: elevation ε, pitch θ, travel λ and their derivatives

l Two inputs: drag forces due to the propellers

l Non linear model:

s linearized at operating point: allows to design an initial PID controller

(state-feddback problem)

s non-linearities taken into account through an uncertain linear model

Robust adaptive PID control design applied

10 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 12: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

3DOF Helicopter control

n Simulation results: travel and elevation (dotted: PID - solid: Adaptive)

0 50 100 150 200 250 300

0

5

10

Travel

0 50 100 150 200 250 300

0

2

4

6

8

10

Elevation

255 260 265 270 275 280 285 290 2958.5

9

9.5

10

10.5

11

11.5

Elevation

11 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 13: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

3DOF Helicopter control

n Simulation results: pitch and Adaptive PID gains

0 50 100 150 200 250 300−10

−5

0

5

10

Pitch

0 50 100 150 200 250 300

−300

−200

0 50 100 150 200 250 300−12

−10

−8

0 50 100 150 200 250 300

−1 000

−900

0 50 100 150 200 250 300

−200

−100

0 50 100 150 200 250 300−140−100−60

12 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011

Page 14: Robust Simple Adaptive Control with Relaxed Passivity and PID control …homepages.laas.fr/peaucell/presentation/ifac2011b.pdf · 2011-11-08 · Robust Simple Adaptive Control with

Conclusions

n LMI-based method that guarantees robust stability of Adaptive control

l Applies to any stabilizable LTI MIMO system

l Allows to keep some structure such as PID

l Adaptive gains are bounded and remain close to initial given values

n Prospectives

l More structured control (decentralized etc.)

l Guaranteed robustness for time-varying uncertainties

l Take advantage of flexibilities on G for engineering issues (saturations...)

l Apply to the actual helicopter benchmark

13 IFAC WC / Milano / Aug. 28 - Sept. 2, 2011