Inversione differenziale della Cinematica

Presentazione sul tema: "Inversione differenziale della Cinematica"— Transcript della presentazione:

1 Inversione differenziale della Cinematica
Si era visto a proposito dell’inversione della cinematica tramite cinematica diretta, che il problema ammette soluzioni in forma chiusa solo per strutture di manipolazione semplici Sorgono immediatamente problemi quando: il manipolatore ha una struttura complessa (non facilmente risolvibile o soluzioni non in forma esplicita) è ridondante (infinite soluzioni) in corrispondenza di posture singolari … ma adesso abbiamo un nuovo strumento: la Cinematica Differenziale che ci fornisce la relazione tra la velocità ai giunti e le velocità nello spazio operativo (in funzione della postura) Dunque perché non invertire la relazione cinematica differenziale ed integrare? Inversione differenziale della Cinematica

2 Inversione differenziale della Cinematica
Basterà assegnare la traiettoria specificando v(t) e le sue condizioni iniziali di posizione ed assetto nello spazio operativo e di postura nello spazio dei giunti e determinare q(t) tramite: L’integrazione potrà essere fatta nel tempo discreto (tramite ad esempio la formula di Eulero) in forma ricorsiva ed implementata quindi in tempo reale: Inversione differenziale della Cinematica

3 Inversione differenziale della Cinematica
… ma lo Jacobiano deve essere quadrato e di rango pieno Se il manipolatore è ridondante (r < n) tale condizione non è verificata (J è rettangolare bassa) ed in generale esistono più soluzioni Per risolvere il problema della determinazione della soluzione tra tante, occorre specificare criteri di scelta E quindi trasformare il problema in un problema di ottimizzazione vincolata (in cui ci sarà un funzionale da minimizzare che determinerà la scelta): ad esempio si cerca quella soluzione che minimizza il funzionale: (ovvero le velocità ai giunti) Con il vincolo: il funzionale è quadratico con matrice W simmetrica e definita positiva (ovvero il funzionale è sempre > 0 per ogni valore di dq/dt ≠ 0) Inversione differenziale della Cinematica

4 Inversione differenziale della Cinematica
Il problema di minimo vincolato può essere risolto con i moltiplicatori di Lagrange mediante il funzionale modificato Tè il vettore 1 x r dei moltiplicatori che permette di incorporare il vincolo nel funzionale (non modificandolo in quanto il vincolo è una equazione pari a zero) il funzionale (funzione di dq/dt e ) viene derivato per determinarne il minimo (il funzionale è una forma quadratica associata ad una matrice definita positiva, nel caso scalare è come se fosse a·x2 il cui minimo si determina mediante semplice derivazione) Inversione differenziale della Cinematica

5 Inversione differenziale della Cinematica
(con il suggerimento di Bertolazzi) Matrice simmetrica È uno scalare quindi uguale al suo trasposto Inversione differenziale della Cinematica

6 Inversione differenziale della Cinematica

7 Inversione differenziale della Cinematica
Nel caso in cui W = I la soluzione impiega la pseudo-inversa J†, e la soluzione trovata è quindi quella che minimizza la norma di tutte le velocità ai giunti senza distinzione Se invece: In questo caso la prima componente delle velocità dei giunti viene minimizzata in maniera più marcata rispetto alla seconda (1/3) Inversione differenziale della Cinematica

8 Inversione differenziale della Cinematica
Come visto in precedenza, evitare le configurazioni di singolarità è un requisito fondamentale nella pianificazione della traiettoria Dunque perché non specificare un funzionale in cui la soluzione si avvicini il più possibile ad una soluzione in grado di evitare le singolarità? Trovata la traiettoria delle variabili di giunto in grado di evitare le singolarità Si stabilisce il seguente funzionale da minimizzare: Con il vincolo: (in maniera analoga a quanto visto prima) … che risulta essere proprio della forma: Inversione differenziale della Cinematica

9 Inversione differenziale della Cinematica
Se infatti: Si ha che: Ovvero P è proprio il proiettore sul nullo di J Inversione differenziale della Cinematica

10 Come evitare le SINGOLARITA’
Rimane solo da determinare in modo tale che le singolarità vengano evitate. Definita la funzione: Basta scegliere: Con k0 > 0 Spiegazione: la funzione w(q) è pari a zero in corrispondenza delle singolarità, cresce man mano che ci si allontana dalle configurazioni singolari Dunque scegliere lungo il gradiente vuol dire allontanarsi dalle configurazioni non desiderate! Come evitare le SINGOLARITA’

11 Come evitare situazioni di FINE CORSA
… se si vuole evitare le situazioni di fine-corsa (anche esse generalmente singolari) che creano situazioni di limitazione alla destrezza del manipolatore La w(q) la si definisce come segue: dove: qiM e qim rappresentano la massima e minima escursione alla rispettiva variabile di giunto qi il valore medio della corsa Come evitare situazioni di FINE CORSA

12 Come evitare OSTACOLI … se si vuole evitare ostacoli
La w(q) la si definisce come segue: dove: o è il vettore posizione di un opportuno punto dell’ostacolo (ad esempio il centro) p è un opportuno punto (od una collezione di punti, oppure …) della struttura come ad esempio l’organo finale in operazioni di inserimento Come evitare OSTACOLI

13 NO, LA DERIVA !!! Inversione differenziale della Cinematica
… siamo sicuri che determinare lo stato delle variabili di giunto mediante una operazione di integrazione non crei dei problemi? NO, LA DERIVA !!! Inversione differenziale della Cinematica

14 Inversione differenziale della Cinematica
Per ovviare all’inconveniente della deriva che porta a seguire traiettorie che si discostano in modo pressoché proporzionale con il tempo dalla traiettoria desiderata, occorre considerare l’errore nello spazio operativo: Dove xd(t) è la traiettoria desiderata ed x(t) è la traiettoria calcolata mediante inversione differenziale della cinematica Derivando rispetto al tempo: Che, mediante la scelta , conduce a problemi di deriva in quanto il termine di incertezza  è sempre presente (ad esempio errori numerici o di modellazione) Inversione differenziale della Cinematica

15 ≠ Inversione differenziale della Cinematica
Dunque bisogna scegliere l’andamento di dq/dt che tenga conto dell’errore nello spazio operativo e possibilmente che presenti una dinamica stabile dell’errore in modo che converga a zero: Con K definita positiva ed autovalori tutti > 0 Ricordando: ≠ Inversione differenziale della Cinematica

16 Inversione differenziale della Cinematica
Quale è lo schema a blocchi dinamico che implementa tale metodo di integrazione basato sulla retroazione dall’errore nello spazio operativo? Impiegare i blocchi sottostanti: Costante di retroazione Iacobiano inverso Integratore Cinematica diretta (Ingressi) (uscita) Inversione differenziale della Cinematica

17 Serve un richiamo di Simulink?

18 Inversione differenziale della Cinematica
Quale è lo schema a blocchi dinamico che implementa il metodo di integrazione basato sulla retroazione dall’errore nello spazio operativo, di seguito riportato? Inversione differenziale della Cinematica

19 Inversione differenziale della Cinematica
Se il manipolatore è ridondante la J non è quadrata e non è possibile invertirla, per cui si ha la generalizzazione: P: proiettore nel nullo Stessa formula con il solo impiego della pseudo-inversa Parte dedicata al controllo dei moti interni indirizzati ad evitare le singolarità, gli ostacoli, i finecorsa, a minimizzare l’energia, etc Inversione differenziale della Cinematica

20 Inversione differenziale della Cinematica
A volte invertire lo Jacobiano può risultare non ottimale dal punto di vista computazionale (nel caso di microprocessori a scarsa velocità/memoria/potenza di calcolo, caso sempre meno frequente ma ancora possibile in talune applicazioni industriali) Dunque si vuole evitare l’inversione … e quindi perché non retroazionare semplicemente (con una semplice operazione di trasposizione) rispetto all’errore? In questo caso si ha una variazione dello stato nello spazio operativo solo se l’errore è diverso da zero. Equivale ad una azione proporzionale. Si dimostra che il metodo è asintoticamente stabile (mediante il criterio di Liapunov) Inversione differenziale della Cinematica

21 Inversione differenziale della Cinematica
Quale è lo schema a blocchi dinamico che implementa tale metodo di integrazione basato sulla retroazione dall’errore nello spazio operativo? Inversione differenziale della Cinematica

22 Inversione differenziale della Cinematica