Cinematica differenziale

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

1 Cinematica differenziale
La cinematica differenziale caratterizza i legami tra le velocità dei giunti e la corrispondente velocità lineare ed angolare dell’organo terminale Tali legami sono descritti tramite una matrice denominata Jacobiano Geometrico Se la postura dell’organo terminale è espressa facendo riferimento ad una rappresentazione in forma minima (angoli di Eulero, Cardano, asse-angolo, quaternioni, …), è possibile calcolare lo Jacobiano direttamente mediante differenziazione rispetto alle variabili di giunto. Quello che si ottiene è lo Jacobiano Analitico (può essere diverso dall’altro) Lo Jacobiano è utile per: l’analisi delle singolarità analisi di ridondanza inversione cinematica determinazione legame tra forze applicate all’organo terminale e le coppie/forze ai giunti Cinematica differenziale

2 Cinematica differenziale – Jacobiano Geometrico
Manipolatore ad n gradi di mobilità, l’equazione cinematica diretta: In cui q = [q1 … qn]T è il vettore delle variabili di giunto Legami tra le velocità dei giunti e la corrispondente velocità lineare ed angolare dell’organo terminale: In forma compatta: Jacobiano Geometrico funzione delle variabili di giunto q: Cinematica differenziale – Jacobiano Geometrico

3 Derivata di una matrice di Rotazione
Si tratterà di derivare la matrice di trasformazione per cui è ora necessario ricavare come si deriva una componente fondamentale: la matrice di rotazione La matrice di rotazione in una traiettoria generica sarà funzione del tempo, per cui: Derivata di una matrice di Rotazione

4 Derivata di una matrice di Rotazione
Se definiamo la SKEW MATRIX: Ovvero la matrice S(t) è anti-simmetrica (ha gli elementi sulla diagonale nulli e la parte triangolare superiore di segno opposto rispetto alla parte inferiore) Riprendendo il risultato di prima: Derivata di una matrice di Rotazione

5 Proprietà della Skew Matrix
Consideriamo un punto p’ solidale ad un corpo sottoposto ad un moto rigido di sola rotazione La sua posizione nello spazio è pari a p(t) = R(t) p’ Dunque la derivata: Che può scriversi: Del resto sappiamo che la rotazione nel tempo di un vettore può essere espressa tramite il vettore velocità angolare (t): Proprietà della Skew Matrix

6 Proprietà della Skew Matrix
Dunque la Skew Matrix descrive il prodotto vettoriale tra il vettore velocità angolare e la matrice di rotazione: Tale risultato è di importanza fondamentale in quanto trasforma equazioni in cui è presente la derivata od il prodotto vettoriale in equazioni in cui compare semplicemente il prodotto tra matrici Tale artificio è in qualche modo analogo all’uso della trasformata di Fourier nel campo dell’analisi segnali in quanto si trasformano relazioni poco trattabili (in quel caso equazioni differenziali nel dominio del tempo) in equazioni algebriche Poiché la Skew Matrix descrive il prodotto vettoriale tra il vettore velocità angolare e la matrice di rotazione essa sarà pari a: Proprietà della Skew Matrix

7 Si consideri la rotazione elementare attorno all’asse z:
Supponendo  funzione del tempo e che: Esempio - Skew Matrix

8 Proprietà della Skew Matrix
Cerchiamo adesso una proprietà notevole: Consideriamo di nuovo un punto p’ solidale ad un corpo sottoposto ad un moto rigido di sola rotazione Il risultato del prodotto vettoriale tra due vettori p1 e p2 ruotato di R è pari al prodotto vettoriale dei due vettori ruotati di R: (scaturisce da semplici considerazioni geometriche di tipo vettoriale) Si noti come tale proprietà denoti che il prodotto vettoriale non segue affatto le regole di composizione algebrica Proprietà della Skew Matrix

9 Proprietà della Skew Matrix
In cui, eliminando l’esplicita dipendenza dal tempo: Proprietà della Skew Matrix

10 i-1 i 0 terna di base Velocità di un braccio - Lineare
(quando in apice non appare simbolo vuol dire che il vettore è espresso rispetto alla terna di base) i i-1 0 terna di base derivando = 0 giunto rotativo  0 giunto prismatico Espressione della velocità lineare del braccio i in funzione della velocità lineare ed angolare del braccio i-1 Nota: si omette l’indicazione esplicita dell’apice “0” delle grandezze riferite alla terna di base Velocità di un braccio - Lineare

11 Velocità di un braccio - Angolare
Partendo dalla composizione delle rotazioni e derivando: d/dt Dove indica la velocità angolare della terna i rispetto alla i-1 espressa nella terna i-1 Velocità di un braccio - Angolare

12 Velocità di un braccio - Angolare
Espressione della velocità angolare del braccio i in funzione della velocità angolare del braccio i-1 ed angolare relativa tra braccio i ed i-1 Velocità di un braccio - Angolare

13 Calcolo dello Jacobiano
In definitiva: Da cui si nota come l’effetto di un giunto j si ripercuota solamente sui giunti successivi (come del resto doveva essere trattandosi di catene cinematiche aperte) Vogliamo adesso calcolare lo Jacobiano definito come: (generalizzando al caso rotativo e prismatico) Calcolo dello Jacobiano

14 Calcolo dello Jacobiano
Mediante moltiplicazione matriciale: Nota: dqj/dt è uno scalare JPj e JOj sono vettori 3x1 In cui, evidentemente: rappresenta il contributo della derivata della variabile di giunto j alla velocità lineare dell’end-effector (con tutti gli altri giunti fermi) rappresenta il contributo della derivata della variabile di giunto j alla velocità angolare dell’end-effector (con tutti gli altri giunti fermi) Il ché vuol dire che per determinare gli elementi dello Jacobiano si può applicare il principio di sovrapposizione degli effetti (del resto l’operazione di derivazione porta ad una approssimazione lineare) Calcolo dello Jacobiano

15 Calcolo dello Jacobiano – Contributo Lineare
Calcolo di : Poiché l’effetto di un giunto j si ripercuote solamente sui giunti successivi: Solo il braccio j si muove, quindi alcuni termini si annullano Nel giunto rotoidale : Nel giunto prismatico : Calcolo dello Jacobiano – Contributo Lineare

16 Giunto Prismatico – Contributo Lineare
Calcolo di : = 0 poiché non ci sono giunti rotoidali in azione = 0 poiché gli altri giunti prismatici sono fermi Nel giunto prismatico : Prismatico Giunto Prismatico – Contributo Lineare

17 Giunto Rotoidale – Contributo Lineare
Calcolo di : Tutte le velocità angolari sono uguali in quanto si ha l’effetto del giunto rotoidale anche sugli altri giunti = 0 poiché non ci sono giunti prismatici in azione Nel giunto rotoidale : Rotoidale Giunto Rotoidale – Contributo Lineare

18 Calcolo dello Jacobiano – Contributo Rotazionale
Calcolo di : = 0 poiché solo il giunto i_esimo è in azione Nel giunto prismatico : Nel giunto rotoidale : Prismatico Rotoidale Calcolo dello Jacobiano – Contributo Rotazionale

19 … e quindi dalla postura del robot
In definitiva: Rotoidale Che dipendono da: Prismatico … e quindi dalla postura del robot Calcolo dello Jacobiano

20 Calcolo dello Jacobiano
Tali relazioni consentono il calcolo dello Jacobiano in maniera semplice e sistematica sulla base delle relazioni cinematiche dirette, in particolare: Calcolo dello Jacobiano

21