Forward Kinematics Accuracy Enhancement of a Force-Torque Decoupled Spherical Parallel Manipulator near Singular Configurations within a Tripodal Robot

Sintesi Tecnica: Miglioramento dell'accuratezza della cinematica diretta di un manipolatore sferico parallelo con disaccoppiamento forza-coppia in prossimità di configurazioni singolari

Problematica
I manipolatori paralleli, in particolare i manipolatori sferici paralleli (SPM), sono soggetti a configurazioni singolari dove la relazione tra lo spazio dei giunti e lo spazio del compito diventa mal condizionata. In prossimità di queste singolarità, piccole imprecisioni di misura nelle coordinate dei giunti vengono amplificate, portando a errori significativi nella ricostruzione della postura dell'end-effector (EE). Questo degrado compromette la stabilità e l'accuratezza del controllo, aspetti critici per applicazioni che richiedono alta precisione, come le mansioni di locomozione e manipolazione proposte per il robot tripode descritto in questo lavoro. Sebbene le singolarità vengano tipicamente evitate, scenari pratici (ad esempio, un robot che adotta una postura seduta) possono rendere necessario il transito in regioni vicine a tali configurazioni. Il documento affronta la sfida specifica di migliorare l'accuratezza della cinematica diretta (FK) in questi stati mal condizionati senza alterare il condizionamento meccanico fondamentale del manipolatore.

Metodologia
La soluzione proposta prevede un design meccanico innovativo e un corrispondente algoritmo cinematico ridondante:

1. Design Meccanico (Disaccoppiamento Forza-Coppia):
   Gli autori presentano un design esteso di SPM che integra una struttura seriale interna (una catena RRR) all'interno dello spazio centrale inutilizzato del manipolatore. Ciò crea un meccanismo ibrido 3-CCC (guscio esterno) + RRR (catena interna).

   • Disaccoppiamento: Il collegamento 3-CCC esterno trasmette le coppie, mentre la catena RRR interna assorbe le forze, disaccoppiando efficacemente la trasmissione di forza e coppia.
   • Sensori Ridondanti: Questa struttura interna consente l'applicazione di un quarto sensore di giunto ($E_4$) sull'asse della base della catena interna ($\hat{c}_1$). Fondamentalmente, l'asse di misurazione coincide con l'asse di rotazione che diventa sensibile alle configurazioni singolari (specificamente, l'asse dove una singolarità di Tipo 2 causa un guadagno in un Grado di Libertà incontrollabile).

2. Formulazione Cinematica:

   • Derivazione dello Jacobiano: Viene derivata una matrice Jacobiana di sensori ridondanti ($J_{red}$), che mappa le velocità dai quattro giunti di ingresso (i tre attuatori della base e l'asse di supporto interno) alla piattaforma dell'utensile. Questa matrice è rettangolare ($3 \times 4$), permettendo l'uso della pseudo-inversa di Moore-Penrose.
   • Soluzione della Cinematica Diretta (FK): Il problema della FK viene trattato come un problema di ottimizzazione sovradeterminato grazie ai dati sensoriali ridondanti.
     • Passaggio 1: Un approccio classico di chiusura del ciclo utilizzando i tre sensori primari ($E_1$–$E_3$) fornisce una stima iniziale dell'orientamento dell'EE tramite l'algoritmo di Levenberg-Marquardt (LM).
     • Passaggio 2: Un passaggio di raffinamento minimizza l'errore tra il valore misurato del sensore ridondante ($\tilde{Z}$) e il valore previsto dalla cinematica inversa dell'orientamento stimato. Ciò comporta una minimizzazione dei minimi quadrati pesati, in cui il peso del sensore ridondante è regolabile.

3. Controllo di Attrazione Dinamica:
   Per evitare che il sensore ridondante degradi l'accuratezza in posture ben condizionate (dove potrebbe entrare in conflitto con i sensori primari), gli autori propongono un aggiustamento dinamico del coefficiente di attrazione ($k_4$) per il quarto sensore. Questo coefficiente viene modulato in base all'indice di condizionamento ($1/\kappa$) del manipolatore. Il sistema applica un'attrazione maggiore al sensore ridondante solo quando il manipolatore si avvicina a stati mal condizionati, salvaguardando così l'accuratezza vicino alle singolarità pur mantenendo la stabilità altrove.

Contributi Chiave

• Topologia Meccanica Innovativa: L'integrazione di una catena RRR interna in un SPM 3-CCC per ottenere il disaccoppiamento forza-coppia e consentire il posizionamento di un quarto sensore senza occupare spazio sui collegamenti sferici.
• Robustezza alle Singolarità: Un metodo per misurare esplicitamente la posizione angolare del DoF singolare, permettendo la ricostruzione della postura dell'EE in configurazioni in cui il metodo classico a tre sensori fallisce o diventa altamente impreciso.
• Algoritmo Adattivo: Un risolutore FK a due fasi con un coefficiente di attrazione del sensore regolato dinamicamente che bilancia l'influenza del sensore ridondante in base al condizionamento meccanico corrente.
• Validazione: Derivazione analitica completa, simulazione con segnali di misura distorti e validazione su un prototipo fisico costruito di un robot tripode.

Risultati

• Simulazione: Lo studio ha utilizzato profili di movimento simulati che si avvicinano a singolarità di Tipo 1 e Tipo 2. I risultati hanno dimostrato che il metodo classico a 3 sensori esibisce una crescita esponenziale dell'errore di orientamento man mano che l'indice di condizionamento ($1/\kappa$) si avvicina a zero. Al contrario, il metodo proposto a 4 sensori con attrazione dinamica ($4S_{ffk,D}$) ha mantenuto livelli di errore significativamente più bassi.
• Riduzione dell'Errore: Nelle regioni più mal condizionate, l'approccio dinamico a 4 sensori ha ridotto l'errore massimo di orientamento di un fattore di circa 3,45 rispetto al metodo a 3 sensori.
• Distribuzione Statistica: Sebbene la configurazione dinamica a 4 sensori abbia mostrato una dispersione leggermente più ampia degli errori degli angoli di giunto in generale, ha ridotto significativamente gli outlier e migliorato l'intervallo interquartile (IQR) per l'asse misurato direttamente ($Z$), indicando un tracciamento più coerente degli angoli ideali vicino alle singolarità.
• Validazione del Prototipo: Il metodo è stato implementato su un prototipo reale di robot tripode. L'analisi di tracciamento ottico ha confermato i risultati della simulazione, verificando che l'aggiustamento dinamico ha mitigato con successo gli errori vicino alle configurazioni singolari senza compromettere le prestazioni negli stati ben condizionati.

Significatività e Rivendicazioni
Il documento afferma che questo lavoro migliora l'accuratezza della ricostruzione del problema della cinematica diretta per gli SPM generici soggetti a imprecisioni di misura, specificamente vicino alle configurazioni singolari. Gli autori sottolineano che questo miglioramento è ottenuto senza alterare l'effettivo condizionamento meccanico del manipolatore; piuttosto, mitiga l'amplificazione degli errori di misura che tipicamente si verifica in posture mal condizionate.

La significatività risiede nel rendere robusto il controllo per i robot leggati che utilizzano SPM nelle loro articolazioni dell'anca, consentendo loro di attraversare posture (come la posizione seduta o specifiche transizioni di andatura) che altrimenti indurrebbero comportamenti incontrollabili o gravi perdite di accuratezza dovute alle singolarità. L'approccio è presentato come generalizzabile oltre il particolare robot tripode, estendendo l'ambito di applicazione tipico degli SPM a compiti che richiedono un'alta affidabilità in regioni singolari o quasi singolari, inclusi i contesti medici e chirurgici. Il lavoro valida che l'integrazione di sensori ridondanti nello spazio interno inutilizzato di un design disaccoppiato forza-coppia è una strategia valida per superare i limiti della classica cinematica dei manipolatori paralleli.