Cinematica del braccio robotico: dal PWM alla cinematica inversa

La cinematica del braccio robotico è la geometria che collega due elementi che un manipolatore deve conciliare: gli angoli dei giunti che può davvero comandare e la posizione dello strumento che vuoi nello spazio. Procedere in una direzione, dagli angoli alla posizione, è cinematica diretta ed è semplice. Procedere nell’altra, dalla posizione agli angoli, è cinematica inversa, ed è lì che si pongono i problemi interessanti: due soluzioni, limiti non raggiungibili e pose in cui il braccio perde temporaneamente il controllo di una direzione.

Questo percorso costruisce la comprensione dalle basi. Inizi con l’hardware: portare un servomotore a un angolo comandato tramite un driver PCA9685, calibrazione inclusa. Poi impari la geometria: come gli angoli di un braccio a due segmenti determinano la posizione dello strumento e come invertire il calcolo per raggiungere un punto di arrivo. Infine lo esplori in tempo reale nel simulatore, trascinando un punto di arrivo e osservando il risolutore scegliere gli angoli dei giunti, raggiungere il limite dello spazio di lavoro e segnalare gli irraggiungibili.

Segui i nodi in ordine: ogni nodo sblocca il successivo dopo che lo hai completato e i tuoi progressi vengono salvati su questo dispositivo. Quando sarai pronto a costruire il sistema reale, questo percorso prosegue direttamente nel progetto del braccio robotico a 4-DOF.

Prima di iniziare

Devi conoscere la trigonometria, in particolare sin, cos e atan2, e sapere scrivere una funzione che restituisca due valori. L’esperienza con i servomotori aiuta, ma il percorso la copre. Nulla qui richiede il braccio fisico: l’intera geometria si può imparare nel simulatore.

Che cosa saprai fare

• Calcolare la posizione dello strumento di un braccio a due segmenti dagli angoli dei giunti, quindi invertire il calcolo per trovare gli angoli che raggiungono un punto.
• Scegliere deliberatamente tra le due soluzioni, gomito in alto o gomito in basso, invece di usare quella restituita dalla matematica.
• Prevedere il limite dello spazio di lavoro raggiungibile e rilevare un punto di arrivo esterno prima che il braccio provi a muoversi.
• Riconoscere una singolarità quando il braccio si avvicina all’estensione completa, dove una piccola variazione della posizione dello strumento richiede una variazione enorme dell’angolo del giunto.
• Misurare il gioco dei tuoi giunti e stabilire quanto dell’errore della pinza dipende dal meccanismo anziché dalla matematica.

Dove le persone si bloccano

Uso di atan invece di atan2. Il normale atan non distingue il quadrante in cui si trova il punto di arrivo, quindi il braccio raggiunge correttamente i punti di arrivo davanti e si muove simmetricamente dietro. atan2 prende separatamente le due componenti e gestisce correttamente tutti e quattro i quadranti.

Errore di dominio in acos. Quando il punto di arrivo è più lontano di quanto possano raggiungere i segmenti, il teorema del coseno produce un argomento fuori dall’intervallo da −1 a 1 e acos restituisce NaN. Questo NaN entra nel comando del servomotore come angolo privo di significato. Verifica la raggiungibilità prima della trigonometria, non dopo.

Confondere l’angolo del giunto con quello del servomotore. Lo zero di un servomotore dipende dalla posizione in cui è stata montata la sua aletta e il servomotore può ruotare nel verso opposto ai calcoli. Ogni giunto richiede un offset di calibrazione e forse l’inversione del segno. Saltarlo produce un braccio che si muove fluidamente e termina ben lontano dal punto di arrivo.

Ignorare la gravità in estensione. La geometria presuppone che il braccio vada dove comandato. Un servomotore hobbistico che sostiene un segmento completamente esteso è nel suo caso peggiore di vantaggio meccanico e la posizione reale cede sotto quella comandata, in modo più evidente al limite esterno dello spazio di lavoro.

Regolare un errore meccanico. Se il braccio raggiunge lo stesso punto in modo diverso a seconda del lato da cui arriva, nessun guadagno lo risolve: è gioco di inversione, moltiplicato per tutta la lunghezza del braccio. Quattro gradi alla spalla che azionano un segmento di 150 mm corrispondono a oltre 10 mm alla pinza.

Attraversare una singolarità. Vicino all’estensione completa, la soluzione inversa diventa mal condizionata e un percorso liscio dello strumento si trasforma in un movimento brusco dei giunti. Mantieni i percorsi a una certa distanza dal limite, senza aderirvi.

Che cosa serve

Perché il percorso segue quest’ordine

Pilotare i servomotori viene prima della geometria, anche se non è ovvio che debba essere così. Il motivo è la calibrazione. Quando puoi comandare un giunto e vedere dove arriva davvero, hai un modo per confrontare ogni risultato successivo con la realtà. Se impari prima la geometria, non hai modo di distinguere un risolutore errato da un’aletta del servomotore montata in modo sbagliato: due guasti molto diversi che appaiono identici a distanza.

Seguono i tipi di braccio, perché spiegano che cos’è un «segmento». I bracci cartesiani, SCARA e delta risolvono lo stesso problema con geometrie completamente diverse; vederne tre chiarisce che la cinematica riguarda la disposizione dei giunti, non un braccio specifico. Spiega anche perché la cinematica inversa di un SCARA è quasi banale e quella di un delta non lo è.

La cinematica inversa viene terza, quando entrambi i prerequisiti sono disponibili. È il cuore del percorso ed è l’unico nodo in cui dedicherai tempo alla matematica.

Il simulatore viene quarto perché rende visibile ciò che è invisibile. Raggiungibilità, i due rami del gomito e singolarità sono fenomeni che puoi dimostrare sulla carta, ma che non capirai davvero fino a quando non avrai trascinato un punto di arrivo sul limite dello spazio di lavoro e osservato cambiare il comportamento del risolutore. Trascinare è anche il modo più rapido per riconoscere la forma dello spazio di lavoro, che è una corona circolare anziché un disco quando i segmenti hanno lunghezze diverse.

Il gioco di inversione chiude il percorso intenzionalmente. È il punto in cui non puoi più migliorare la precisione del braccio con una matematica migliore. Ogni nodo precedente riguarda il calcolo dell’angolo corretto; questo riguarda i millimetri tra l’angolo corretto e la posizione corretta.

Checkpoint: come sapere che una tappa è stata superata

Dove termina questo percorso

Questo percorso copre la soluzione planare a due segmenti risolta in forma chiusa: la geometria dietro spalla e gomito di quasi ogni braccio hobbistico. È la cosa giusta da imparare prima perché puoi derivarla, verificarla e vedere esattamente perché si verifica ogni errore.

Si ferma prima di diversi aspetti che incontrerai in seguito. La cinematica generale a n-DOF usa i parametri di Denavit–Hartenberg e le matrici di trasformazione omogenee per descrivere sistematicamente qualsiasi catena di giunti, invece di risolvere a mano la geometria di ogni braccio. La cinematica inversa numerica, con iterazioni basate sul giacobiano, si usa quando non esiste una soluzione in forma chiusa, cioè normalmente oltre quattro o cinque giunti; inoltre degrada in modo controllato vicino alle singolarità, dove una soluzione in forma chiusa smette semplicemente di funzionare.

La risoluzione della ridondanza affronta il caso di un braccio con più giunti di quanti il compito ne vincoli e quindi con infinite soluzioni valide: un problema davvero interessante che questo percorso non deve mai affrontare, perché un braccio a due segmenti ne ha esattamente due.

La dinamica è l’altra metà della manipolazione: la cinematica non dice nulla su forze, inerzia o sulla velocità massima di un giunto senza superare la posizione desiderata. Tutto qui presuppone che il braccio vada dove gli viene ordinato, abbastanza lentamente da rendere valida la presupposizione.