Gravity Compensation
- Detto anche: gravity balancing, zero-gravity mode
- Categoria: Control › Force & interaction control
- Tag: manipulator-control, robot-dynamics, feedforward, physical-interaction, hand-guiding
Annullare l'effetto della gravità su un robot, sommando ai comandi dei giunti le coppie gravitazionali previste dal modello oppure meccanicamente con contrappesi o molle.
Definizione
La compensazione della gravità (gravity compensation) consiste nel fornire le forze o le coppie necessarie a sostenere i link di un robot, e qualsiasi carico utile che trasporti, contro la gravità, in modo che il resto del controllore lavori con un sistema che si comporta come se fosse privo di peso. Nel software usa il termine gravitazionale della dinamica del corpo rigido, M(q)q̈ + C(q, q̇)q̇ + g(q) = τ: il controllore calcola g(q), le coppie ai giunti che la gravità produce nella configurazione corrente q, e le somma al proprio comando. Il vettore di gravità dipende solo dalla configurazione e dalle masse e dalle posizioni del centro di massa dei link, per cui può essere calcolato a basso costo da un modello di tipo URDF con l'algoritmo ricorsivo di Newton-Eulero o metodi simili.
La compensazione della gravità è un elemento di base di molti controllori. Il controllo PD più compensazione della gravità, τ = Kp(q_d − q) − Kd q̇ + g(q), è un classico regolatore a punto di lavoro la cui stabilità per manipolatori rigidi è stata dimostrata da Takegaki e Arimoto nel 1981. I controllori di impedenza e nello spazio operativo includono il termine gravitazionale affinché la rigidezza comandata non venga spesa per sostenere il braccio. Quando un controllore fornisce solo g(q), il braccio fluttua sul posto e può essere spinto a mano, ed è così che molti bracci controllati in coppia e collaborativi realizzano la guida manuale e l'insegnamento cinestetico. Senza compensazione, un controllore cedevole si abbassa sotto il peso stesso del braccio e uno rigido nasconde grandi coppie a regime nei propri termini di errore.
La compensazione meccanica della gravità svolge lo stesso compito in modo passivo. Contrappesi, molle disposte per bilanciare un link su tutta la sua escursione e meccanismi a parallelogramma riducono la coppia che i motori devono mantenere, il che fa risparmiare energia, consente attuatori più piccoli e continua a funzionare quando manca l'alimentazione. La compensazione software è valida quanto il suo modello: errori nelle masse dei link, un utensile o un fascio di cavi non modellati, oppure un carico utile che cambia a metà del compito lasciano un residuo che fa derivare il braccio verso l'alto o verso il basso. L'attrito nei giunti è un effetto distinto che la compensazione della gravità non elimina, e nei bracci con riduttori ad alto rapporto non reversibili l'attrito può essere abbastanza grande da impedire che un braccio con compensazione della gravità si muova a mano senza rilevamento della coppia ai giunti o della forza al polso.
Perché è importante
Quasi ogni controllore di braccio diverso dal controllo di posizione rigido ha bisogno della compensazione della gravità, ed è il passo che rende praticabili il controllo cedevole, l'interazione fisica sicura e la guida manuale. La sua qualità si vede subito sull'hardware: un modello ben identificato permette a un braccio di restare fermo con guadagni bassi, mentre uno scadente produce una deriva facilmente scambiata per un bug di controllo.
Applicazioni principali
- Guida manuale e insegnamento cinestetico su bracci collaborativi
- Controllo di impedenza, di ammettenza e nello spazio operativo
- Dispositivi aptici e bracci master di teleoperazione che devono risultare privi di peso
- Esoscheletri e dispositivi di assistenza che sostengono gli arti dell'utente
- Bracci bilanciati a molle e a contrappesi che mantengono la posizione senza alimentazione
- Stima del carico utile dalle coppie residue ai giunti
In pratica
Un ingegnere che prepara un braccio a sette giunti controllato in coppia per l'insegnamento cinestetico parte dall'URDF del costruttore e aggiunge la pinza e la telecamera al polso come un corpo rigido in più, con massa e centro di massa misurati. Con il controllore che fornisce solo g(q), porta il braccio in diverse pose e osserva se mantiene la posizione: una lenta deriva verso il basso al polso indica una massa dell'utensile sottostimata, e una deriva che cambia direzione con la posa indica un offset errato del centro di massa. Affina i parametri con una breve prova di identificazione che registra le coppie ai giunti in molte pose statiche e stima i termini di massa e di momento del primo ordine con i minimi quadrati, poiché le coppie gravitazionali sono lineari in quei parametri, e aggiunge la compensazione dell'attrito come termine separato. Quando in seguito il robot afferra un oggetto pesante, il controllore aggiorna il suo modello del carico utile in modo che il braccio non cada né salga quando l'operatore lo lascia.
Idee sbagliate comuni
- La compensazione della gravità rende il braccio privo di massa — annulla solo il peso statico; l'inerzia del braccio continua a opporsi all'accelerazione, quindi risulta pesante quando lo si muove rapidamente
- La compensazione della gravità elimina anche l'attrito — l'attrito è un effetto distinto e, nei bracci con riduttori, spesso domina ciò che l'operatore avverte
- Il modello del costruttore basta sempre — utensili, cavi e carichi utili cambiano le masse, e gli errori non corretti causano una deriva visibile a guadagni bassi
- La compensazione della gravità è un controllore a sé — è un termine in feedforward usato all'interno di molti controllori; una modalità di compensazione della gravità è semplicemente un controllore con tutti gli altri termini posti a zero
Chi dovrebbe saperlo
- Ingegneri del controllo di manipolatori
- Integratori di robot collaborativi
- Progettisti di dispositivi aptici e di esoscheletri
- Ricercatori nell'interazione fisica uomo-robot
Tecnologie correlate
- Algoritmo ricorsivo di Newton-Eulero (Recursive Newton-Eulero Algorithm)
- Pinocchio
- Sensori di coppia ai giunti (Joint Torque Sensors)
- Meccanismi di bilanciamento a molle (Spring Counterbalance Mechanisms)
- Compensazione dell'attrito (Friction Compensation)
- Identificazione del carico utile (Payload Identification)