PIANIFICAZIONE DI TRAIETTORIE generazione degli ingressi di riferimento per il sistema di controllo del moto Percorso e traiettoria Traiettorie nello spazio dei giunti Traiettorie nello spazio operativo Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 1
PERCORSO E TRAIETTORIA generazione di traiettorie a curvatura regolare Percorso: luogo dei punti dello spazio dei giunti (spazio operativo) che il manipolatore deve descrivere nell esecuzione del movimento assegnato (descrizione geometrica) Traiettoria: percorso su cui sia specificata la legge oraria di moto (ad es. velocità e/o accelerazioni) Algoritmo di pianificazione della traiettoria ingressi definizione del percorso vincoli al percorso vincoli dovuti alla dinamica del manipolatore uscita traiettorie dei giunti (o dell organo terminale) espresse come sequenza temporale di valori assunti da posizione, velocità e accelerazione Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 2
Numero ristretto di parametri percorso punti estremi eventuali punti intermedi primitive geometriche legge di moto tempo complessivo velocità e/o accelerazione max velocità e/o accelerazione in punti assegnati Traiettorie nello spazio operativo descrizione naturale del compito vincoli sul percorso singolarità ridondanza Traiettorie nello spazio dei giunti inversione cinematica azione di controllo Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 3
TRAIETTORIE NELLO SPAZIO DEI GIUNTI Generazione di una funzione che interpola i valori assegnati per le variabili di giunto nel rispetto dei vincoli imposti. traiettorie generate poco onerose dal punto di vista computazionale posizioni e velocità (e accelerazioni) dei giunti funzioni continue del tempo effetti indesiderati minimizzati (ad es. traiettorie a curvatura non regolare) Moto punto punto punti estremi e tempo di transizione Moto su percorso assegnato punti estremi, punti intermedi e tempi di transizione Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 4
Moto punto punto generazione di che realizza il moto da a in un tempo Polinomio cubico calcolo dei coefficienti Polinomio quintico (accelerazioni iniziale e finale) "!! Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 5
Esempio pos 3 [rad] 2 1.2.4.6.8 1 5 vel [rad/s^2] [rad/s] 4 3 2 1.2.4.6.8 1 acc 2 1 1 2.2.4.6.8 1 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 6
Profilo di velocità trapezoidale Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 7
assegnata ( ) traiettoria Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 8
Esempio pos 3 [rad] 2 1.2.4.6.8 1 5 vel [rad/s^2] [rad/s] 4 3 2 1.2.4.6.8 1 acc 2 1 1 2.2.4.6.8 1 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 9
assegnata Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 1
Moto su percorso assegnato opportunità di specificare punti intermedi (sequenza di punti) Assegnati punti di percorso, trovare una funzione interpolante che passi per tali punti polinomio di grado non è possibile assegnare velocità iniziale e finale al crescere del grado di un polinomio aumenta il suo carattere oscillatorio (traiettorie poco naturali) l accuratezza numerica con cui può essere calcolato un polinomio peggiora all aumentare del suo grado una volta impostato il sistema di equazioni dei vincoli, risulta oneroso risolverlo i coefficienti del polinomio dipendono da tutti i punti assegnati se si vuole cambiare uno dei punti di percorso, si deve ricalcolare il tutto Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 11
Sequenze di polinomi interpolatori di grado più basso (cubici) uniti tra di loro nei punti assegnati lungo il percorso i valori di in corrispondenza dei punti di percorso sono imposti arbitrariamente i valori di in corrispondenza dei punti di percorso sono assegnati in base ad un opportuno criterio l accelerazione deve essere continua in corrispondenza dei punti di percorso Sequenze di polinomi di grado minore di tre (passaggio in prossimità dei punti di percorso imposti) Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 12
Sequenza di polinomi con vincoli imposti sulle velocità nei punti di percorso continuità delle velocità nei punti intermedi Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 13
Esempio pos [rad] 6 4 2 2 4 6 vel 5 [rad/s] 5 2 4 6 acc 2 [rad/s^2] 2 4 2 4 6 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 14
Sequenza di polinomi con velocità calcolate nei punti di percorso Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 15
Esempio pos 6 [rad] 4 2 2 4 6 vel 5 [rad/s] 5 [rad/s^2] 2 4 6 acc 3 2 1 1 2 3 2 4 6 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 16
Sequenza di polinomi con accelerazione continua nei punti di percorso (spline) equazioni nei coefficienti incogniti (polinomi di quarto grado per il primo e l ultimo segmento?) punti virtuali (continuità su posizione, velocità e accelerazione) polinomi cubici Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 17
equazioni per gli punti di percorso interni: equazioni per i punti iniziale e finale equazioni per i punti virtuali Sistema di equazioni per la determinazione dei coefficienti degli polinomi cubici Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 18
algoritmo efficiente dal punto di vista computazionale incognite:,, e Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 19
variabili per vincoli di continuità su e vincoli di continuità su e assegnate vincoli di continuità su per e assegnate assegnate per.. sistema di equazioni lineari....... Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 2
Esempio pos 6 [rad] 4 2 1 2 3 4 5 vel 5 [rad/s] 5 1 2 3 4 5 [rad/s^2] 3 2 1 1 2 3 acc 1 2 3 4 5 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 21
Sequenza di polinomi parabolico-lineari con passaggio in prossimità di punti di via Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 22
Esempio pos 6 [rad] 4 2 1 2 3 4 5 vel 4 2 [rad/s] 2 4 6 4 1 2 3 4 5 acc 2 [rad/s^2] 2 4 1 2 3 4 5 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 23
Applicazione della legge trapezoidale al problema dell interpolazione [rad] pos 5 4 3 2 1.5 1 1.5 2 vel 4 3 [rad/s] 2 1 [rad/s^2].5 1 1.5 2 acc 2 1 1 2.5 1 1.5 2 Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 24
TRAIETTORIE NELLO SPAZIO OPERATIVO Sequenze di punti assegnati inversione cinematica traiettorie nello spazio dei giunti microinterpolazione Punti di percorso componenti raccordate secondo sequenze di polinomi interpolatori Primitive di percorso espressione analitica del moto Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 25
Primitive di percorso Rappresentazione parametrica di una curva nello spazio Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 26
Segmento nello spazio Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 27
Circonferenza nello spazio Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 28
Traiettorie di posizione e di orientamento Posizione polinomio interpolatore segmento circonferenza Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 29
Orientamento interpolazione delle componenti di,,? interpolazione di asse equivalente di rotazione ( ) : Illustrazioni dal Testo di Riferimento per gentile concessione degli Autori 3