CINEMATICA DIFFERENZIALE

Documenti analoghi
Inversione della cinematica differenziale

Cinematica differenziale inversa Statica

Docente Vincenzo LIPPIELLO Dipartimento di Informatica e Sistemistica Universitá degli Studi di Napoli Federico II

PIANIFICAZIONE DI TRAIETTORIE

Cinematica differenziale

Corso di Robotica 1 Cinematica inversa

UNIVERSITÀ DEGLI STUDI DI NAPOLI FEDERICO II

Robotica: Errata corrige

Spazio dei giunti e spazio operativo

Corso di Percezione Robotica (PRo) Modulo B. Fondamenti di Robotica

di manipolatori seriali

1 Cinematica del punto Componenti intrinseche di velocità e accelerazione Moto piano in coordinate polari... 5

Robot con ridondanza cinematica

Modello dinamico dei robot: approccio di Newton-Eulero

DEDUZIONE DEL TEOREMA DELL'ENERGIA CINETICA DELL EQUAZIONE SIMBOLICA DELLA DINAMICA

MOMENTO DI UNA FORZA RISPETTO A UN PUNTO. Obiettivi

Elementi di Cinematica e Dinamica dei Robot

Robotica industriale. Richiami di statica del corpo rigido. Prof. Paolo Rocco

OSCILLATORE ARMONICO SEMPLICE

Robotica Modellistica, pianificazione e controllo

4 Cinematica diretta dei robot

Corso di Percezione Robotica Modulo B. Fondamenti di Robotica

SISTEMI DI CONTROLLO CINEMATICA E DINAMICA DEI ROBOT

Cinematica dei robot

MECCANICA DEI ROBOT E DELLE MACCHINE AUTOMATICHE LM Anno accademico (ing. M. Troncossi)

Analisi e Controllo di un manipolatore S.C.A.R.A.

ẋ 1 = 2x 1 + (sen 2 (x 1 ) + 1)x 2 + 2u (1) y = x 1

1 Sistemi di riferimento

Argomenti Capitolo 1 Richiami

Compito di Meccanica Razionale

UNIVERSITÀ DEGLI STUDI DI FIRENZE. Registro dell'insegnamento

PROVA SCRITTA DI MECCANICA RAZIONALE (11 giugno 2005) (C.d.L. Ing. Edile - Architettura. Prof. A. Muracchini)

Progetto e Realizzazione di un Robot a Cinematica Parallela per Applicazioni Mediche

Corso di Fisica I per Matematica

Richiami di algebra delle matrici a valori reali

Macchina a regime periodico

UNIVERSITÀ DEGLI STUDI DI NAPOLI FEDERICO II FACOLTÀ DI INGEGNERIA TESINA DI CONTROLLO DEI ROBOT

EQUAZIONI DIFFERENZIALI

Calcolo vettoriale. Versore: vettore u adimensionale di modulo unitario (rapporto tra un vettore e il suo modulo)

Applicazioni delle leggi della meccanica: moto armnico

CONCETTO DI STABILITÀ NEI SISTEMI DI CONTROLLO. Sistema in condizioni di equilibrio a t = 0. d(t) = 0. u(t) = 0. y(t) = 0. Sistema

1.3 Sistemi non lineari ad 1 grado di libertà. 1.4 Sistemi non lineari a 2 gradi di libertà 1.5 Sistemi multicorpo. 1.6 La dinamica del corpo rigido

Compito del 14 giugno 2004

La fisica di Feynmann Meccanica

Esame di Meccanica Razionale. Allievi Ing. MAT Appello del 6 luglio 2007

Esercitazioni di Meccanica Razionale

Modellistica di sistemi elettromeccanici

Formulario Meccanica

Cinematica, dinamica e controllo di un manipolatore 3-RPR parallelo

Dinamica del punto materiale

5 Un applicazione: le matrici di rotazione

Design di schiere nel piano interpalare

Modello dinamico dei robot:

Lezione VI Cinematica e dinamica del manovellismo. Cinematica e dinamica di un manovellismo ordinario centrato

Esame di Fisica per Ingegneria Elettronica e delle Telecomunicazioni (Parte I):

Controlli Automatici II. Controllo dei robot manipolatori

Elementi di Algebra Lineare. Spazio Vettoriale (lineare)

Costruzione di Macchine Verifica a fatica degli elementi delle macchine

Il teorema dei lavori virtuali, l elasticità lineare ed il problema dell equilibrio elastico

Le trasformazioni geometriche nel piano cartesiano. x = ϕ(x', y') τ 1 : G(x', y') = 0. la sua inversa.

DINAMICA DI SISTEMI AEROSPAZIALI

Capitolo 12. Moto oscillatorio

Introduzione e modellistica dei sistemi

Geometria BATR-BCVR Esercizi 9

Unità didattica 2. Seconda unità didattica (Fisica) 1. Corso integrato di Matematica e Fisica per il Corso di Farmacia

Controllo del robot Pendubot

4 Analisi nel dominio del tempo delle rappresentazioni in

Lezione 23: Sistemi a più gradi di libertà: sistemi continui (3)

EQUAZIONI DIFFERENZIALI

ESAME DI AERODINAMICA 12/12/2006

Fondamenti di Automatica

Sintesi Cinematica e Dinamica di un robot a cinematica parallela a 3 g.d.l

7. Forze elastiche. Nella figura 1 il periodo è T = 2s e corrisponde ad un moto unidimensionale limitato tra i valori x = 0 ed x = 1.

Esercitazione 2. Soluzione

Risposta temporale: esempi

MECCANICA APPLICATA ALLE MACCHINE L

1) Per quale valore minimo della velocità angolare iniziale il cilindro riesce a compiere un giro completo.

Meccanica quantistica (5)

Esercitazioni di Meccanica Razionale

Dinamica Rotazionale

Laboratorio di automazione

Fisica Generale I A.A , 16 Giugno Esercizi di meccanica relativi al primo modulo del corso

Compito di Meccanica Razionale

Compito di Meccanica Razionale M-Z

Cinematica in due o più dimensioni

Grandezze angolari. Lineare Angolare Relazione x θ x = rθ. m I I = mr 2 F N N = rf sin θ 1 2 mv2 1

CAPITOLO. 1 Gli strumenti di misura Gli errori di misura L incertezza nelle misure La scrittura di una misura 38

Meccanica Applicata alle Macchine

Calcolo vettoriale. 2. Nel piano Oxy sono dati i vettori. con la direzione positiva dell asse x,

Transcript:

CINEMATICA DIFFERENZIALE relazioni tra velocità dei giunti e velocità dell organo terminale Jacobiano geometrico Singolarità cinematiche Analisi della ridondanza Inversione della cinematica differenziale Jacobiano analitico Algoritmi per l inversione cinematica STATICA relazioni tra forze all organo terminale e coppie ai giunti

JACOBIANO GEOMETRICO T(q) = R(q) p(q) 0 T 1 Obiettivo ṗ = J P (q) q ω = J O (q) q v = [ ] ṗ ω = J(q) q

Derivata di una matrice di rotazione R(t)R T (t) = I Ṙ(t)R T (t) + R(t)ṘT (t) = O Posto S(t) = Ṙ(t)RT (t) S(t) + S T (t) = O Ṙ(t) = S(ω(t))R(t) S = 0 ω z ω y ω z 0 ω x ω y ω x 0

Esempio R z (α) = cosα sinα 0 sinα cosα 0 0 0 1 S(t) = = αsinα α cosα 0 cosα sinα 0 α cosα α sinα 0 sinα cosα 0 0 0 0 0 0 1 0 α 0 α 0 0 = S(ω(t)) 0 0 0

p 0 = o 0 1 + R 0 1p 1 ṗ 0 = ȯ 0 1 + R0 1ṗ1 + Ṙ0 1 p1 = ȯ 0 1 + R 0 1ṗ1 + S(ω 0 1)R 0 1p 1 = ȯ 0 1 + R 0 1ṗ1 + ω 0 1 r 0 1

Velocità di un braccio Velocità lineare p i = p i 1 + R i 1 r i 1 i 1,i ṗ i = ṗ i 1 + R i 1 ṙ i 1 i 1,i + ω i 1 R i 1 r i 1 i 1,i = ṗ i 1 + v i 1,i + ω i 1 r i 1,i

Velocità angolare R i = R i 1 R i 1 i S(ω i )R i = S(ω i 1 )R i + R i 1 S(ω i 1 i 1,i )Ri 1 i = S(ω i 1 )R i + S(R i 1 ω i 1 i 1,i )R i ω i = ω i 1 + R i 1 ω i 1 i 1,i = ω i 1 + ω i 1,i

ω i = ω i 1 + ω i 1,i ṗ i = ṗ i 1 + v i 1,i + ω i 1 r i 1,i Giunto prismatico ω i 1,i = 0 v i 1,i = d i z i 1 ω i = ω i 1 ṗ i = ṗ i 1 + d i z i 1 + ω i r i 1,i Giunto rotoidale ω i 1,i = ϑ i z i 1 v i 1,i = ω i 1,i r i 1,i ω i = ω i 1 + ϑ i z i 1 ṗ i = ṗ i 1 + ω i r i 1,i

Calcolo dello Jacobiano J = j P1... j Pn j O1 j On Velocità angolare giunto i prismatico q i j Oi = 0 = j Oi = 0 giunto i rotoidale q i j Oi = ϑ i z i 1 = j Oi = z i 1

Velocità lineare giunto i prismatico q i j Pi = d i z i 1 = j Pi = z i 1 giunto i rotoidale q i j Pi = ω i 1,i r i 1,n = ϑ i z i 1 (p p i 1 ) j Pi = z i 1 (p p i 1 )

Colonna dello Jacobiano geometrico [ jpi j Oi ] [ ] zi 1 0 = [ ] zi 1 (p p i 1 ) z i 1 per un giunto prismatico per un giunto rotoidale z i 1 = R 0 1(q 1 )...R i 2 i 1 (q i 1)z 0 p = A 0 1 (q 1)...A n 1 n (q n ) p 0 p i 1 = A 0 1(q 1 )...A i 2 i 1 (q i 1) p 0

Rappresentazione in terna differente [ ] ṗt ω t = = J t = [ ] [ ] R t O ṗ O R t ω [ ] R t O O R t J q [ R t O O R t ] J

Manipolatore planare a tre bracci

J(q) = [ ] z0 (p p 0 ) z 1 (p p 1 ) z 2 (p p 2 ) z 0 z 1 z 2 p 0 = 0 0 0 p 1 = a 1c 1 a 1 s 1 0 p 2 = a 1c 1 + a 2 c 12 a 1 s 1 + a 2 s 12 0 p = a 1c 1 + a 2 c 12 + a 3 c 123 a 1 s 1 + a 2 s 12 + a 3 s 123 0 z 0 = z 1 = z 2 = 0 0 1

J = a 1 s 1 a 2 s 12 a 3 s 123 a 2 s 12 a 3 s 123 a 3 s 123 a 1 c 1 + a 2 c 12 + a 3 c 123 a 2 c 12 + a 3 c 123 a 3 c 123 0 0 0 0 0 0 0 0 0 1 1 1 J P = [ ] a1 s 1 a 2 s 12 a 3 s 123 a 2 s 12 a 3 s 123 a 3 s 123 a 1 c 1 + a 2 c 12 + a 3 c 123 a 2 c 12 + a 3 c 123 a 3 c 123

Manipolatore antropomorfo

J = [ ] z0 (p p 0 ) z 1 (p p 1 ) z 2 (p p 2 ) z 0 z 1 z 2 p 0 = p 1 = 0 0 p 2 = 0 z 0 = p = 0 0 1 c 1(a 2 c 2 + a 3 c 23 ) s 1 (a 2 c 2 + a 3 c 23 ) a 2 s 2 + a 3 s 23 z 1 = z 2 = a 2c 1 c 2 a 2 s 1 c 2 a 2 s 2 s 1 c 1 0

J = s 1 (a 2 c 2 + a 3 c 23 ) c 1 (a 2 s 2 + a 3 s 23 ) a 3 c 1 s 23 c 1 (a 2 c 2 + a 3 c 23 ) s 1 (a 2 s 2 + a 3 s 23 ) a 3 s 1 s 23 0 a 2 c 2 + a 3 c 23 a 3 c 23 0 s 1 s 1 0 c 1 c 1 1 0 0 J P = s 1(a 2 c 2 + a 3 c 23 ) c 1 (a 2 s 2 + a 3 s 23 ) a 3 c 1 s 23 c 1 (a 2 c 2 + a 3 c 23 ) s 1 (a 2 s 2 + a 3 s 23 ) a 3 s 1 s 23 0 a 2 c 2 + a 3 c 23 a 3 c 23

Manipolatore di Stanford

J = [ z0 (p p 0 ) z 1 (p p 1 ) z 2 z 0 z 1 0 z 3 (p p 3 ) z 4 (p p 4 ) z 5 (p p 5 ) z 3 z 4 z 5 ] p 0 = p 1 = 0 0 0 p 3 = p 4 = p 5 = c 1s 2 d 3 s 1 d 2 s 1 s 2 d 3 + c 1 d 2 c 2 d 3 p = c 1s 2 d 3 s 1 d 2 + d 6 (c 1 c 2 c 4 s 5 + c 1 c 5 s 2 s 1 s 4 s 5 ) s 1 s 2 d 3 + c 1 d 2 + d 6 (c 1 s 4 s 5 + c 2 c 4 s 1 s 5 + c 5 s 1 s 2 ) c 2 d 3 + d 6 (c 2 c 5 c 4 s 2 s 5 ) z 0 = 0 0 1 z 1 = s 1 c 1 0 z 2 = z 3 = c 1s 2 s 1 s 2 c 2 z 4 = c 1c 2 s 4 s 1 c 4 s 1 c 2 s 4 + c 1 c 4 s 2 s 4 z 5 = c 1c 2 c 4 s 5 s 1 s 4 s 5 + c 1 s 2 c 5 s 1 c 2 c 4 s 5 + c 1 s 4 s 5 + s 1 s 2 c 5 s 2 c 4 s 5 + c 2 c 5

SINGOLARITÀ CINEMATICHE v = J(q) q se J diminuisce di rango = singolarità cinematiche (a) perdita di mobilità (b) infinite soluzioni al problema cinematico inverso (c) velocità elevate nello spazio dei giunti (nell intorno di una singolarità) Classificazione Singolarità ai confini dello spazio di lavoro raggiungibile Singolarità all interno dello spazio di lavoro raggiungibile

Manipolatore planare a due bracci [ ] a1 s J = 1 a 2 s 12 a 2 s 12 a 1 c 1 + a 2 c 12 a 2 c 12 det(j) = a 1 a 2 s 2 ϑ 2 = 0 ϑ 2 = π [ (a 1 + a 2 )s 1 (a 1 + a 2 )c 1 ] T parallelo a[ a 2 s 1 a 2 c 1 ] T (componenti di velocità dell organo terminale non indipendenti)

Disaccoppiamento di singolarità calcolo delle singolarità della struttura portante calcolo delle singolarità del polso

J = [ ] J11 J 12 J 21 J 22 J 12 = [ z 3 (p p 3 ) z 4 (p p 4 ) z 5 (p p 5 ) ] J 22 = [ z 3 z 4 z 5 ] p = p W = p W p i paralleli a z i, i = 3, 4, 5 J 12 = [ 0 0 0 ] det(j) = det(j 11 )det(j 22 ) det(j 11 ) = 0 det(j 22 ) = 0

Singolarità di polso z 3 parallelo a z 5 ϑ 5 = 0 ϑ 5 = π rotazioni uguali e opposte di ϑ 4 e ϑ 6 non producono alcuna rotazione dell organo terminale

Singolarità di struttura portante Manipolatore antropomorfo det(j P ) = a 2 a 3 s 3 (a 2 c 2 + a 3 c 23 ) s 3 = 0 a 2 c 2 + a 3 c 23 = 0 Singolarità di gomito ϑ 3 = 0 ϑ 3 = π

Singolarità di spalla p x = p y = 0

ANALISI DELLA RIDONDANZA Cinematica differenziale v = J(q) q se (J) = r dim ( R(J) ) = r dim ( N(J) ) = n r in generale dim ( R(J) ) + dim ( N(J) ) = n

Se N(J) ove q = q + P q a R(P) N(J) verifica: J q = J q + JP q a = J q = v q a genera moti interni della struttura

INVERSIONE DELLA CINEMATICA DIFFERENZIALE Equazione cinematica non lineare Equazione cinematica differenziale lineare nelle velocità Data v(t) + condizioni iniziali = (q(t), q(t)) se n = r q = J 1 (q)v q(t) = t 0 q(ς)dς + q(0) regola di integrazione numerica (Eulero) q(t k+1 ) = q(t k ) + q(t k ) t

Manipolatori ridondanti Per una data configurazione q, trovare le soluzioni q che soddisfino v = J q e che minimizzino g( q) = 1 2 qt W q metodo dei moltiplicatori di Lagrange g( q, λ) = 1 2 qt W q + λ T (v J q) ( ) T g = 0 q ( ) T g = 0 λ soluzione ottima q = W 1 J T (JW 1 J T ) 1 v se W = I ove q = J v J = J T (JJ T ) 1 è la pseudo-inversa destra di J

Utilizzo della ridondanza g ( q) = 1 2 ( qt q T a )( q q a ) come sopra... g ( q, λ) = 1 2 ( qt q T a )( q q a) + λ T (v J q) soluzione ottima q = J v + (I J J) q a

Caratterizzazione dei moti interni ( ) T w(q) q a = k a q misura di manipolabilità w(q) = det ( J(q)J T (q) ) distanza dai fine-corsa dei giunti w(q) = 1 2n n ( qi q i i=1 q im q im ) 2 distanza da un ostacolo w(q) = min p,o p(q) o

Singolarità cinematiche Le soluzioni precedenti valgono solo se J è di rango pieno Se J non è di rango pieno (singolarità) se v R(J) = soluzione q estraendo tutte le equazioni linearmente indipendenti (traiettoria fisicamente eseguibile) se v / R(J) = il sistema non è risolvibile (traiettoria non eseguibile) Inversione nell intorno di singolarità det(j) piccolo = q elevate inversa a minimi quadrati smorzata J = J T (JJ T + k 2 I) 1 ove q minimizza g ( q) = v J q 2 + k 2 q 2

JACOBIANO ANALITICO p = p(q) φ = φ(q) ṗ = p q q = J P(q) q φ = φ q q = J φ(q) q ẋ = [ ] ṗ φ = [ ] JP (q) J φ (q) q = J A (q) q J A (q) = k(q) q

Velocità di rotazione in terna corrente di angoli di Eulero ZYZ per effetto di ϕ: [ ω x ω y ω z ] T = ϕ [0 0 1] T per effetto di ϑ: [ ω x ω y ω z ] T = ϑ [ s ϕ c ϕ 0 ] T per effetto di ψ: [ω x ω y ω z ] T = ψ [ c ϕ s ϑ s ϕ s ϑ c ϑ ] T

Composizione di velocità di rotazione elementari ω = 0 s ϕ c ϕ s ϑ 0 c ϕ s ϕ s ϑ φ = T(φ) φ 1 0 c ϑ

Significato fisico di ω ω = [ π/2 0 0 ] T 0 t 1 ω = [ 0 π/2 0 ] T 0 t 1 ω = [ 0 π/2 0 ] T 1 < t 2 ω = [ π/2 0 0 ] T 1 < t 2 2 0 ωdt = [ π/2 π/2 0] T

Relazione tra Jacobiano analitico e Jacobiano geometrico v = [ ] I O ẋ = T O T(φ) A (φ)ẋ J = T A (φ)j A Jacobiano geometrico grandezze di significato fisico Jacobiano analitico grandezze differenziali di variabili nello spazio operativo

ALGORITMI PER L INVERSIONE CINEMATICA Inversione cinematica q(t k+1 ) = q(t k ) + J 1 (q(t k ))v(t k ) t fenomeni di deriva della soluzione Soluzione algoritmica errore nello spazio operativo e = x d x ė = ẋ d ẋ = ẋ d J A (q) q trovare q = q(e): e 0

(Pseudo-)inversa dello Jacobiano Linearizzazione della dinamica di errore q = J 1 A (q)(ẋ d + Ke) ė + Ke = 0 Per un manipolatore ridondante q = J A (ẋ d + Ke) + (I J A J A) q a

Trasposta dello Jacobiano q = q(e) senza linearizzare la dinamica di errore Metodo di Lyapunov V (e) = 1 2 et Ke ove V (e) > 0 e 0 V (0) = 0 V (e) = e T Kẋ d e T Kẋ = e T Kẋ d e T KJ A (q) q la scelta q = J T A(q)Ke comporta che V (e) = e T Kẋ d e T KJ A (q)j T A(q)Ke se ẋ d = 0 = V < 0 con V > 0 (asintotica stabilità) se N(J T A ) = V = 0 se Ke N(J T A ) q = 0 con e 0 (stallo?)

Se ẋ d 0 e(t) limitato (conviene aumentare la norma di K) e( ) 0

Esempio J T P = 0 0 0 c 1 (a 2 s 2 + a 3 s 23 ) s 1 (a 2 s 2 + a 3 s 23 ) 0 a 3 c 1 s 23 a 3 s 1 s 23 a 3 c 23 nullo di J T P ν y ν x = 1 tanϑ 1 ν z = 0

Errore di orientamento Errore di posizione e P = p d p(q) ė P = ṗ d ṗ Angoli di Eulero e O = φ d φ(q) ė O = φ d φ [ ] q = J 1 A (q) ṗd + K P e P φ d + K O e O agevole per assegnare l andamento temporale φ d (t) richiede comunque il passaggio attraversor = [ n s a ] Manipolatore con polso sferico calcolare q P = R W calcolare R T W R d = q O (angoli di Eulero ZYZ)

Asse/angolo R(ϑ, r) = R d R T errore di orientamento e O = r sinϑ = 1 2 (n n d + s s d + a a d ) ė O = L T ω d Lω ove L = 1 ( S(nd )S(n) + S(s d )S(s) + S(a d )S(a) ) 2 ė = [ ėp ė O ] = = [ ṗ d J P (q) q L T ω d LJ O (q) q ] [ ] [ ] ṗ d I O L T J q ω d O L [ ] q = J 1 ṗ (q) d + K P e P L ( ) 1 L T ω d + K O e O

Quaternione unitario errore di orientamento Q = Q d Q 1 e O = ǫ = η(q)ǫ d η d ǫ(q) S(ǫ d )ǫ(q) [ q = J 1 ṗd + K (q) P e P ω d + K O e O ] ω d ω + K O e O = 0 propagazione del quaternione η = 1 2 ǫt ω ǫ = 1 2 (ηi S(ǫ)) ω studio della stabilità V = (η d η) 2 + (ǫ d ǫ) T (ǫ d ǫ) V = e T O K Oe O

Algoritmi del secondo ordine derivata della cinematica differenziale ẍ e = J A (q) q + J A (q, q) q soluzione in accelerazione ai giunti q = J 1 A (ẍ (q) e J ) A (q, q) q ë + K D ė + K P e = 0

Confronto tra gli algoritmi per l inversione cinematica Manipolatore planare a tre bracci p x p y φ x = k(q) = a 1c 1 + a 2 c 12 + a 3 c 123 a 1 s 1 + a 2 s 12 + a 3 s 123 ϑ 1 + ϑ 2 + ϑ 3 a 1 = a 2 = a 3 = 0.5 m J A = a 1s 1 a 2 s 12 a 3 s 123 a 2 s 12 a 3 s 123 a 3 s 123 a 1 c 1 + a 2 c 12 + a 3 c 123 a 2 c 12 + a 3 c 123 a 3 c 123 1 1 1

q i = [ π π/2 π/2] T rad p di = [ 0 0.5] T m φ = 0 rad traiettoria desiderata p d (t) = [ ] 0.25(1 cosπt) 0.25(2 + sinπt) 0 t 4 φ d (t) = sin π 24 t 0 t 4 Simulazione in MATLAB con integrazione numerica di Eulero q(t k+1 ) = q(t k ) + q(t k ) t e t = 1 ms

q = J 1 A (q)ẋ 2 x 10 3 norma errore pos 0 x 10 5 errore orien 1.5 0.2 [m] 1 0.5 0 0 1 2 3 4 5 [s] [rad] 0.4 0.6 0.8 1 0 1 2 3 4 5 [s]

q = J 1 A (q)(ẋ d + Ke) K = diag{500, 500, 100} 5 pos giunti 10 vel giunti [rad] 0 1 3 [rad/s] 5 0 1 2 2 5 3 5 0 1 2 3 4 5 [s] 10 0 1 2 3 4 5 [s] 1 x 10 5 norma errore pos 0 x 10 8 errore orien 0.8 1 [m] 0.6 0.4 [rad] 2 3 0.2 4 0 0 1 2 3 4 5 [s] 5 0 1 2 3 4 5 [s]

φ libero (r = 2, n = 3) q = J P (ṗ d + K P e P ) K P = diag{500, 500} 5 x 10 6 norma errore pos 0.5 orien 4 [m] 3 2 [rad] 0 0.5 1 0 0 1 2 3 4 5 [s] 1 0 1 2 3 4 5 [s] q = J T P (q)k Pe P K P = diag{500, 500} 0.01 norma errore pos 0.5 orien 0.008 [m] 0.006 0.004 [rad] 0 0.5 0.002 0 0 1 2 3 4 5 [s] 1 0 1 2 3 4 5 [s]

q = J P (ṗ d + K P e P ) + (I J P J P) q a KP = diag{500, 500} misura di manipolabilità w(ϑ 2, ϑ 3 ) = 1 2 (s2 2 + s 2 3) ( ) T w(q) q a = k a k a = 50 q 5 1 pos giunti 5 1 pos giunti [rad] 0 3 2 [rad/s] 0 2 3 5 0 1 2 3 4 5 [s] 5 0 1 2 3 4 5 [s] 5 x 10 6 norma errore pos 1 manip 4 [m] 3 2 [rad] 0.95 0.9 1 0 0 1 2 3 4 5 [s] 0.85 0 1 2 3 4 5 [s]

distanza dai fine-corsa dei giunti 3 ( qi q i ) 2 w(q) = 1 6 i=1 q im q im 2π q 1 2π π/2 q 2 π/2 3π/2 q 3 π/2 ( ) T w(q) q a = k a k a = 250 q [rad] pos giunto 1 6 4 2 0 2 4 6 0 1 2 3 4 5 [s] [rad] pos giunto 2 6 4 2 0 2 4 6 0 1 2 3 4 5 [s] 5 pos giunto 3 2 x 10 4 norma errore pos 1.5 [rad] 0 [m] 1 0.5 5 0 1 2 3 4 5 [s] 0 0 1 2 3 4 5 [s]

STATICA Relazione tra forze e momenti (forze) γ all organo terminale e forze e/o coppie (coppie) τ ai giunti con il manipolatore in configurazione di equilibrio lavoro elementare compiuto dalle coppie dw τ = τ T dq lavoro elementare compiuto dalle forze dw γ = f T dp + µ T ωdt = f T J P (q)dq + µ T J O (q)dq = γ T J(q)dq spostamenti elementari spostamenti virtuali δw τ = τ T δq δw γ = γ T J(q)δq

Principio dei lavori virtuali il manipolatore è in equilibrio statico se e solo se δw τ = δw γ δq τ = J T (q)γ

Dualità cineto-statica N(J) R (J T ) R(J) N (J T ) forze γ N(J T ) interamente assorbite dalla struttura

Interpretazione fisica dello schema con la trasposta dello Jacobiano dinamica ideale τ = q forza elastica Ke che tira l organo terminale verso la postura desiderata nello spazio operativo ha effetto solo se Ke / N(J T )

Trasformazione di velocità e forze [ ṗ2 ω 2 ] = [ I S(r12 ) O I ][ ṗ1 ω 1 ] r 12 = R 1 r 1 12 ṗ 1 = R 1 ṗ 1 1 ṗ 2 = R 2 ṗ 2 2 = R 1 R 1 2ṗ2 2 ω 1 = R 1 ω 1 1 ω 2 = R 2 ω 2 2 = R 1 R 1 2ω 2 2

[ ṗ2 2 ω 2 2 ] = [ R 2 1 R1 2S(r1 12 ) ] [ ṗ1 1 O R1 2 ω 1 1 ] v 2 2 = J2 1 v1 1 in virtù della dualità cineto-statica: γ1 1 = J1 2T γ2 2 [ f 1 ] [ 1 R 1 ][ 2 O f 2 ] µ 1 = 2 1 S(r12 1 )R1 2 R2 1 µ 2 2

Catena chiusa Struttura ad albero equivalente a catena aperta [ ] qa q o = q u Risolvendo i vincoli: q u = q u (q a ) q o = Υ q a Υ = per la dualità cineto-statica I q u q a τ a = Υ T τ o Manipolatore a parallelogramma [ ] ϑ1 q a = q u = ϑ 1 Υ = 1 0 0 1 1 1 1 1 [ ] τ1 τ τ a = 2 + τ 3 τ 1 + τ 2 τ 3 [ ϑ2 ϑ 3 τ u = ] [ ] 0 0

ELLISSOIDI DI MANIPOLABILITÀ Ellissoide di manipolabilità in velocità insieme delle velocità ai giunti a norma costante q T q = 1 manipolatore ridondante q = J (q)v v T( J(q)J T (q) ) 1 v = 1 Assi autovettori u i di JJ T = direzioni valori singolari σ i = λ i (JJ T ) = dimensioni Volume proporzionale a w(q) = det ( J(q)J T (q) )

Manipolatore planare a due bracci Misura di manipolabilità w = det(j) = a 1 a 2 s 2 max per ϑ 2 = ±π/2 max per a 1 = a 2 (a parità di estensione a 1 + a 2 )

Ellissi di manipolabilità in velocità 1 0.5 [m] 0 0.5 1 0 0.5 1 1.5 2 [m] Valori singolari [m] 2.5 2 1.5 1 0.5 max min 0 0 0.5 1 1.5 2 [m]

Ellissoide di manipolabilità in forza insieme delle coppie ai giunti a norma costante τ T τ = 1 γ T( J(q)J T (q) ) γ = 1 Dualità cineto-statica una direzione lungo la quale si ha elevata manipolabilità in velocità è una direzione lungo la quale si ha scarsa manipolabilità in forza, e viceversa

Manipolatore planare a due bracci Ellissi di manipolabilità in velocità 1 0.5 [m] 0 0.5 1 0 0.5 1 1.5 2 [m] Ellissi di manipolabilità in forza 1 0.5 [m] 0 0.5 1 0 0.5 1 1.5 2 [m]

Manipolatore trasformatore meccanico di velocità e forze dallo spazio dei giunti allo spazio operativo rapporto di trasformazione lungo una direzione per l ellissoide in forza α(q) = ( ) 1/2 u T J(q)J T (q)u rapporto di trasformazione lungo una direzione per l ellissoide in velocità β(q) = (u T( J(q)J T (q) ) 1 u ) 1/2 utilizzazione di gradi di mobilità ridondanti

Compatibilità della struttura ad eseguire un compito assegnato lungo una direzione compito di scrittura su superficie orizzontale vel piano di scrittura forza compito di lancio di un peso in direzione orizzontale forza vel direzione di lancio