11 controlloadattativodeluca/rob2/11_controlloadattativo.pdf · title: 11_controlloadattativo.ppt...
TRANSCRIPT
![Page 1: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/1.jpg)
Robotica 2 A.A. 2008-2009A. De Luca
Corso di Robotica 2
Prof. Alessandro De Luca
Controllo Adattativo
![Page 2: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/2.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 2
Motivazioni e approccio
necessità dell’adattamento nella legge di controllo incertezza sui parametri dinamici del robot scarsa conoscenza del carico
caratteristiche del controllo adattativo riduzione a zero dell’errore di traiettoria senza necessaria identificazione dei parametri
(= controllo adattativo diretto)
metodologia parametrizzazione lineare della dinamica del robot legge di controllo non lineare di tipo dinamico
![Page 3: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/3.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 3
Parametri meccanici del robot parametri assunti noti
descrizione cinematica con i parametri di Denavit-Hartenberg{αi, di, ai, i = 1,…,N} (caso giunti tutti rotatori), tra cui lelunghezze dei bracci (calibrazione cinematica)
parametri incerti identificabili fuori linea masse mi, posizioni rci dei baricentri e matrici d’inerzia Ii dei
singoli bracci nelle loro combinazioni (coefficienti) ⇒ 10 × N
parametri variabili (lentamente) nel funzionamento attrito viscoso Fvi, secco Fsi, di primo distacco FDi per ogni giunto
⇒ 1÷3 × N parametri incogniti
massa, baricentro, momenti d’inerzia del carico rispetto alla pinza
quando il carico è solidale con l’ultimo braccio, si modificano soloi 10 parametri ad esso relativi (con influenza però su tutta la dinamica!)
![Page 4: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/4.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 4
Obiettivi del controllo adattativo
data un’arbitraria traiettoria qd(t) desiderata eventuale inversione cinematica + interpolazione ai giunti note anche velocità qd(t) ed accelerazione qd(t) desiderate
si vuole eseguire la traiettoria con un errore transitorio che si annulla asintoticamente
garantendo globalmente tale comportamento, con stime inizialidei parametri incogniti ed errore di stato iniziale entrambi arbitrari
non sempre interessa identificare i parametri se la traiettoria è a eccitazione persistente, si ha anche identificazione con schemi di controllo adattativo indiretto si può garantire la
convergenza dei coefficienti dinamici ai valori veri
. ..
![Page 5: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/5.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 5
Parametrizzazione lineare
esiste sempre un vettore a (p-dimensionale) di coefficientidinamici rispetto ai quali il modello è lineare
il vettore a contiene solo parametri incogniti o incerti le componenti di a sono in generale combinazioni dei
parametri fisici (non necessariamente tutti) dipendenza della matrice Y di regressione: lineare da q,
quadratico da q, trigonometrico (nonlineare) da q.
..
trascuratonel seguito
![Page 6: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/6.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 6
Controllori di traiettoria basati su stime
controllo (lineare) in avanti a dinamica inversa + PD
controllo (non lineare) con feedback linearization
stime approssimate dei coefficienti dinamici possonoanche indurre instabilità per una parziale o inappropriatacancellazione delle nonlinearità
rendere adattativi questi due schemi non è banale
![Page 7: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/7.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 7
Uno schema più semplice da “adattare” controllo (non lineare) di traiettoria senza cancellazioni
e con caratteristiche di globale asintotica stabilizzazione
una naturale versione adattativa richiederebbe
un’opportuna legge di aggiornamento… (a tempo continuo)
è facile mostrare che si riesce ad “agganciare” la traiettoriadesiderata (errore nullo in velocità), ma in generale può rimanereun errore residuo in posizione
modifica in linea del riferimento di velocità
tipicamente (tutte matrici diagonali)
![Page 8: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/8.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 8
Interpretazione di qr
caso elementare massa in moto lineare ‘in ritardo’
.
q qd(t)e
u
riferimentomobile
massacontrollata
q.
qd.
qr = qd + Λe . .
s = qr - q > qd - q = e. . . . .
errore ‘amplificato’ di velocità
u = KDs = KD(qr-q) = KD(qd+Λe-q) = KDe+KDΛe. . . . .
KP massa in moto lineare ‘in anticipo’
in modo speculare, ci sarà un errore ‘ridotto’ di velocità (s < e).
![Page 9: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/9.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 9
sostituendo qr=qd+Λe, qr=qd+Λe nella precedente espressione delcontrollore di traiettoria
legge di aggiornamento dei coefficienti dinamici ( è lo statop-dimensionale del controllore dinamico)
dinamica parametricacon le stime correnti
(notare i 4 argomenti in Y!)
stabilizzazione PD(matrici diagonali, >0)
guadagni dello stimatore(rapidità di variazione delle stime)
(diagonale)
.. .. ...
Legge di controllo adattativa
![Page 10: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/10.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 10
con il controllore adattativo precedente, l’errore di inseguimentodella traiettoria desiderata è globalmente asintoticamente stabile
candidata di Lyapunov per lo stato del sistema ad anello chiuso(robot + controllore dinamico)
errore ‘modificato’ di velocità matrice costante(ancora da specificare)
Stabilità asintotica dell’errore di traiettoria
Teorema
Dimostrazione
errore di stimaparametrica
⇔ &
![Page 11: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/11.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 11
la derivata temporale di V è
essendo
Dimostrazione (cont)
ad anello chiuso, si ha la dinamica
e sottraendo i due membri dasi ottiene
con
![Page 12: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/12.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 12
per la linearità nei coefficienti dinamici, segue che
Dimostrazione (cont)
sostituendo in V, assieme a , e per l’antisimmetria dellamatrice si ha
esplicitando ed essendo diagonale
![Page 13: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/13.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 13
posto infine (tutte le matrici sono diagonali)
Dimostrazione (fine)
si ottiene
e quindi
e la tesi segue da LaSalle
⇔
l’insieme degli stati a cui si converge ha errore nullo di traiettoria estima ad un valore costante non necessariamente esatto ( )
![Page 14: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/14.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 14
Commenti
se la traiettoria desiderata qd(t) è a eccitazione persistente, si haanche che convergenza della stima al valore vero
condizione di eccitazione
per un sistema lineare: # di componenti frequenziali nella traiettoriadesiderata pari ad almeno al doppio del # di coefficienti incogniti
per un sistema non lineare: la verifica si può fare solo a posteriori (suun opportuno integrale temporale)
in caso di assenza nota di attrito viscoso (Fv ≡ 0), vale la stessadimostrazione (più semplice nella parte finale)
il controllore adattativo non usa né l’inversa della matrice di inerzia(vera o stimata) né l’accelerazione attuale (solo quella desiderata)
la versione non adattativa (con stime esatte) è un controllore chesfrutta la proprietà di passività dei robot
![Page 15: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/15.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 15
Esempio: singolo braccio
modello
parametrizzazione
controllore adattativo
![Page 16: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/16.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 16
Simulazione dinamica
coefficienti effettivi
stime iniziali
parametri del controllore
traiettorie di test (a partire da ) prima
seconda
![Page 17: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/17.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 17
Risultatiprima traiettoria
errori di posizione e di velocità coppia di controllo
si nota la dinamica non lineare(a regime non è una sinusoide)!
!
˙ e
e
![Page 18: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/18.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 18
Risultatiseconda traiettoria
errori di posizione e di velocità coppia di controllo
si nota la discontinuità di coppia(dovuta a quella dell’accelerazione desiderata)
!
˙ e
e
![Page 19: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/19.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 19
Confronto tra convergenza di stime
seconda traiettoriaprima traiettoria
errori
converge solo la stima del coefficiente viscoso
convergono le stime di tuttie tre i coefficienti dinamici
!
I " ˆ I
!
mgd "m ˆ g d
!
fv "ˆ f v
!
I " ˆ I
!
fv "ˆ f v
!
mgd "m ˆ g d
![Page 20: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/20.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 20
Esercizio: robot Comau Smart 6.10R
robot 6R con polso sferico e strutturasimmetrica (no offsets)
bloccare gli ultimi tre giunti nellaconfigurazione in figura (robot 3R)
assumere i baricentri posti sugli assicinematici dei bracci
assumere diagonali le matrici di inerziadei singoli bracci
ricavare il modello dinamico determinare una parametrizzazione
lineare (possibilmente minima) ricavare le espressioni della legge di
controllo adattativo di traiettoria simulare il tutto con stime iniziali
errate (o esatte! cosa succede allora?)in configurazione
![Page 21: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/21.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 21
Un caso speciale:compiti di regolazione adattativa
situazione di adattamento quando qd è costante non ci sono semplificazioni rilevanti per il controllore
adattativo precedente progettato per l’asservimento…
perchè qr = Λ (qd-q) e qr = -Λq non svaniscono! diverso sarebbe il caso con una versione adattativa del
controllore di traiettoria
rimanendo, per il caso qd costante, solo l’adattamentodel termine di gravità (come è più naturale…)
. .. .
![Page 22: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/22.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 22
Regolatore adattativo
si usa la parametrizzazione lineare del solo termine digravità
con ag vettore pg-dimensionale un regolatore adattativo con globale asintotica stabilità
dello stato di equilibrio (qd,0) è dato da
con KP>0, KD>0 (simmetriche), β>0 sufficientementegrande, e=qd-q
!
g(q) = G(q)ag
!
u = G(q)ˆ a g + KP(qd "q) "KD˙ q
ˆ ˙ a g = # GT(q)
2e
1 + 2 e2"$ ˙ q
%
& ' '
(
) * *
# > 0
![Page 23: 11 ControlloAdattativodeluca/rob2/11_ControlloAdattativo.pdf · Title: 11_ControlloAdattativo.ppt Author: Alessandro De Luca Created Date: 4/21/2009 7:27:29 PM](https://reader033.vdocuments.pub/reader033/viewer/2022052007/601b5abf3f486767d254eac2/html5/thumbnails/23.jpg)
Robotica 2 A.A. 2008-2009 A. De Luca 23
Regolatore adattativoCenni sull’analisi di stabilità
si usa la funzione di Lyapunov
una condizione sufficiente affinché V sia una candidata è che
una condizione sufficiente che garantisce anche
è che
!
V ="
2˙ q TB(q)˙ q + eTKpe( ) # 2˙ q
TB(q)e
1 + 2 e2
+1
2ˆ a g # ag( )
Tˆ a g # ag( ) $ 0
!
" >2B
M
BmK
P,m
!
˙ V = ... " #a e2#b ˙ q
2" 0 a > 0,b > 0
!
" > max2B
M
BmK
P,m
,1
KD,m
KD,m
2
2KP,m
+ 4BM
+#
S
2
$
% & &
'
( ) )
$
% & &
'
( ) )
!
AM
= "max(A) = "
max(A
TA) = A
Am
= "min(A)
!
S q, ˙ q ( ) "#S˙ q
!
1
2˙ q TB(q)˙ q "
1
2Bm
˙ q 2
N.B. per una matrice A simmetrica, definita positiva
da cui, ad es.