Simulatore di braccio robotico: cinematica e ROS

Controlli

Il simulatore fornisce cursori per i giunti, un bersaglio utensile trascinabile, sovrapposizioni di sistemi di riferimento e controlli delle dimensioni dei link, con la base centrata in modo che l’intero spazio di lavoro raggiungibile a 360° sia visibile. La modalità diretta calcola la posizione dell’utensile dagli angoli dei giunti impostati. La modalità inversa segue un bersaglio che trascini: risolve gli angoli dei giunti in tempo reale e segnala bersagli irraggiungibili o ambigui invece di spostarsi silenziosamente su un risultato. Una terza modalità di prelievo e posizionamento ti permette di posizionare un punto di raccolta e una destinazione, poi esegue l’intero compito: il braccio si muove verso l’oggetto, lo afferra, lo trasporta e lo rilascia nell’area di rilascio, il lavoro canonico per cui è costruito ogni manipolatore reale.

Teoria

Ogni giunto contribuisce con una trasformazione tra sistemi di riferimento. Moltiplicando queste trasformazioni dalla base all’utensile si ottiene la posizione cinematica diretta. La cinematica inversa lavora al contrario e può non avere soluzioni, averne una o averne diverse.

Vicino a una singolarità un piccolo movimento dell’utensile può richiedere un movimento enorme dei giunti. Un pianificatore deve inoltre rispettare i limiti di posizione, velocità, accelerazione, coppia e collisione. La sola raggiungibilità geometrica non rende sicura una traiettoria.

Algoritmo

1. Definisci lunghezze dei link, assi dei giunti, trasformazioni iniziali e limiti dei giunti.
2. Calcola la cinematica diretta per lo stato corrente dei giunti.
3. Confronta la posizione corrente dell’utensile con il bersaglio richiesto.
4. Usa un risolutore analitico o numerico per ridurre l’errore di posizione entro i limiti.
5. Scarta i candidati in collisione o singolari e seleziona una soluzione continua.
6. Parametrizza il percorso nel tempo e invia valori di riferimento sincronizzati ai controllori dei giunti.

Codice sorgente

Un braccio piano a due link ha un modello diretto compatto:

from math import cos, sin

def forward_kinematics(theta_1, theta_2, link_1, link_2):
    elbow = (link_1 * cos(theta_1), link_1 * sin(theta_1))
    tool = (
        elbow[0] + link_2 * cos(theta_1 + theta_2),
        elbow[1] + link_2 * sin(theta_1 + theta_2),
    )
    return elbow, tool

Per i bracci fisici, valida ogni traiettoria pianificata in un ambiente limitato e sensibile alle collisioni prima di abilitare l’alimentazione degli attuatori.

Ipotesi e differenze hardware

Il braccio è piano, con due o tre giunti rotativi, link perfettamente rigidi, risposta di velocità istantanea e nessuna gravità, dinamica o collisione: puoi passare da gomito in alto a gomito in basso senza limite di coppia. I servomotori reali hanno limiti di posizione e velocità, gioco di inversione del riduttore, coppia limitata dalla corrente e cedimento dipendente dal carico; inoltre un braccio a 6 assi deve gestire anche orientamento, singolarità e lavoro vicino ai limiti dei giunti. Questo laboratorio ti fa capire perché un bersaglio dentro l’anello può avere due soluzioni e perché un bersaglio sul bordo è singolare, prima di aggiungere le dinamiche che rendono difficili da mantenere quelle pose.

Schema elettrico

Separa l’alimentazione degli attuatori ad alta corrente da quella di calcolo, mantenendo i segnali di riferimento e sicurezza richiesti dall’hardware selezionato.

Esperimenti guidati

Trascinare un bersaglio è il modo più rapido per costruire l’intuizione su cose noiose da dimostrare su carta e costose da scoprire sull’hardware.

1. Trova la forma dello spazio di lavoro

Trascina lentamente il bersaglio verso l’esterno finché il risolutore non lo segnala irraggiungibile, poi segui quel bordo per tutto il giro. Ora trascinalo verso l’interno, in direzione della base.

Con lunghezze dei link diverse troverai due bordi: un cerchio esterno a L1 + L2 e uno interno a |L1 − L2|. Lo spazio di lavoro è un anello, non un disco, e al centro c’è un buco che il braccio non può raggiungere fisicamente.

L’ultima riga è un fatto di progettazione davvero utile: lunghezze uguali dei link eliminano completamente la zona morta. Se il tuo braccio deve lavorare vicino alla propria base, è questo il motivo per sceglierle.

2. Osserva le due soluzioni fondersi

Alterna tra i rami con gomito in alto e gomito in basso su un bersaglio vicino al centro dello spazio di lavoro: due pose del braccio chiaramente diverse che raggiungono lo stesso punto.

Ora trascina quel bersaglio verso l’esterno, in direzione del bordo. Le due pose convergono e, con l’estensione completa, diventano la stessa posizione. Questa è una singolarità, il punto in cui il braccio perde la possibilità di muovere l’utensile in una direzione, qualunque cosa facciano i giunti.

3. Senti quanto costa una singolarità

Trascina il bersaglio lungo una retta che passa vicino all’estensione completa, lentamente e con costanza. Osserva gli angoli dei giunti, non il braccio.

L’utensile si muove a velocità costante; i giunti no. Vicino al bordo un piccolo movimento dell’utensile richiede un movimento enorme dei giunti, quindi un percorso cartesiano fluido diventa un movimento brusco dei giunti. Sull’hardware questo è un servomotore che si porta al limite.

Mantieni i percorsi pianificati entro circa il 95% della portata massima e il problema scompare.

4. Attraversa il bordo di un ramo e osserva il salto

Imposta il risolutore perché scelga sempre il gomito in alto, poi trascina il bersaglio attraverso una regione in cui quel ramo incontra un limite del giunto e il risolutore cambia ramo. Il braccio compie un movimento ampio, rapido e completamente non pianificato.

Ecco perché il valore predefinito corretto è il movimento minimo: scegli il ramo più vicino alla posizione corrente, invece di scegliere sempre un ramo fisso. Un cambio di ramo silenzioso a metà percorso sull’hardware reale è allarmante e può essere distruttivo.

Cosa devi osservare

Passaggio all’hardware

La geometria si trasferisce esattamente. Nient’altro, e il divario è dove il primo braccio costruito passa il tempo:

Due numeri rendono il punto. Quattro gradi di gioco alla spalla su una portata di 190 mm corrispondono a più di 13 mm alla pinza: un errore maggiore di qualsiasi errore introdotto dalla matematica. E una lunghezza di link misurata 10 mm più lunga su un link di 95 mm è un errore sistematico del 10% che nessuna regolazione rimuoverà.

La conseguenza pratica è che la precisione sull’hardware deriva da calibrazione e direzione di avvicinamento coerente, non da una cinematica migliore. Avvicinati sempre a un bersaglio dalla stessa direzione: il gioco di inversione diventa uno scostamento riproducibile che puoi sottrarre. Il risolutore completo, con tutti i casi di errore gestiti, è in cinematica inversa per un braccio a due link.