Cooperative transportation of a cable–suspended underactuated planar load through model-based motion planning

Sintesi Tecnica: Trasporto Cooperativo di un Carico Planare Sospeso mediante Cavi e Sottoattuato

Definizione del Problema
Il documento affronta la sfida del trasporto e della manipolazione cooperativa di un carico planare sottoattuato e sospeso tramite cavi, utilizzando due carrelli indipendenti che si muovono lungo una comune guida lineare. Il sistema è costituito da una trave rigida (il carico) con tre gradi di libertà (posizione orizzontale, posizione verticale e orientamento) sospesa da due cavi rigidi di lunghezza fissa collegati a due carrelli. Poiché il sistema è controllato da solo due forze indipendenti (gli attuatori dei carrelli) ma possiede tre gradi di libertà, esso è intrinsecamente sottoattuato.

La difficoltà principale risiede nel fatto che il carico è "cinematicamente indeterminato"; la sua posizione non è definita univocamente solo dalle posizioni dei carrelli a causa della dinamica simile a quella di un pendolo e dell'accoppiamento non lineare. La pianificazione tradizionale basata sulla cinematica fallisce in questo caso, poiché il carico può oscillare o spostarsi anche quando le posizioni dei carrelli sono fisse. Inoltre, in scenari industriali che richiedono una sincronizzazione precisa (ad esempio, linee di produzione o di confezionamento), il carico deve seguire una traiettoria prestabilita esattamente sia nel tempo che nello spazio, senza modificare il percorso desiderato. Un vincolo significativo è che l'architettura di controllo è spesso "collocata", il che significa che sensori e attuatori sono situati solo sui carrelli, senza feedback diretto dal carico. Ciò rende difficile il rifiuto dei disturbi e la soppressione delle oscillazioni, poiché i controllori dei carrelli sono ampiamente insensibili allo stato dinamico del carico a causa del basso rapporto tra l'inerzia del carico e quella del motore.

Metodologia
Gli autori propongono un approccio di pianificazione del moto basato su un modello che tratta il problema come un'inversione del modello dinamico. Invece di affidarsi all'ottimizzazione o alla levigatura euristica (come i profili limitati dal jerk), il metodo calcola le traiettorie di riferimento esatte per i carrelli attuati necessarie per forzare il carico a seguire una specifica traiettoria predefinita.

La metodologia procede come segue:

1. Modellazione del Sistema: Il sistema è modellato utilizzando un insieme di equazioni differenziali-algebriche (DAE) non lineari di indice 3 basate su coordinate ridondanti. Tuttavia, per l'algoritmo di pianificazione, gli autori utilizzano la forma normale input-output della dinamica del carico. Il carico è trattato come un corpo non vincolato soggetto a tensioni nei cavi, con i vincoli cinematici dei cavi esplicitamente inclusi.
2. Formulazione della Dinamica Inversa: Gli output controllati sono definiti come le coordinate del centro di massa del carico ($x_G, y_G$). Esprimendo la dinamica del carico in termini di tensioni dei cavi ($\tau$) e utilizzando la forma normale input-output, gli autori derivano una relazione algebrica tra l'accelerazione desiderata del carico e le tensioni dei cavi richieste. Ciò comporta una "matrice di disaccoppiamento" che mappa gli input di controllo sulle accelerazioni di output.
3. Soluzione Numerica: Poiché il sistema non è "flat" (non ammette una soluzione puramente algebrica della dinamica inversa), il metodo impiega un'integrazione numerica esplicita. Partendo da condizioni iniziali note, l'algoritmo utilizza uno schema Runge-Kutta del quarto ordine per l'integrazione in avanti delle equazioni del moto. Ad ogni passo temporale, esso:
   • Calcola lo stato del carico ($\chi, \dot{\chi}$).
   • Risolve le equazioni del vincolo cinematico non lineare per determinare le posizioni dei carrelli richieste ($x_C$).
   • Calcola le tensioni dei cavi necessarie algebricamente.
   • Deriva le velocità e le accelerazioni dei carrelli tramite la differenziazione dei vincoli cinematici.
4. Verifica della Fattibilità: Una caratteristica critica dell'approccio è il calcolo esplicito delle tensioni dei cavi ad ogni passaggio. Ciò consente un controllo immediato della fattibilità della traiettoria, assicurando che le tensioni rimangano positive (cavi tesi) e rientrino nei limiti fisici.
5. Implementazione: Le traiettorie di riferimento risultanti (posizione, velocità e accelerazione) per i carrelli vengono calcolate offline e caricate sul controllore industriale. Il controllo a cascata nativo dei carrelli segue quindi questi riferimenti.

Contributi Chiave

• Tracciamento Esatto della Traiettoria: Il metodo assicura che il carico segua una traiettoria prestabilita esattamente nel tempo e nello spazio senza alterare il percorso desiderato, un requisito spesso non soddisfatto dagli approcci senza modello.
• Compatibilità con il Controllo Collocato: L'approccio è progettato specificamente per sistemi in cui il feedback del carico non è disponibile. Esso si affida interamente al modello per dare forma al moto del carrello, rendendolo compatibile con i controllori industriali proprietari che non possono essere modificati per accettare il feedback esterno del carico.
• Efficienza Computazionale: Utilizzando schemi di integrazione esplicita (Runge-Kutta) piuttosto che complessi calcoli di "flatness" simbolica o ottimizzazioni pesanti, il metodo mantiene un basso carico computazionale adatto alla pianificazione offline e all'implementazione su hardware industriale con risorse limitate.
• Controllo Integrato della Fattibilità: La formulazione fornisce naturalmente i valori di tensione dei cavi, consentendo ai progettisti di verificare se una traiettoria è fisicamente realizzabile (ovvero, i cavi non diventano lenti) prima dell'esecuzione.

Risultati Sperimentali
Il metodo è stato validato su una configurazione di grado industriale utilizzando un sistema a motore sincrono lineare a magneti permanenti B&R ACOPOStrak con due carrelli (0,7 kg ciascuno) e un carico a barra d'acciaio (0,244 kg). Sono stati eseguiti due casi di test: una traslazione orizzontale (0,3 m) e un movimento combinato di sollevamento orizzontale-verticale (200 mm orizzontali, 50 mm verticali), entrambi eseguiti in 1,5 secondi utilizzando profili polinomiali di nono grado da fermo a fermo.

Il metodo proposto di "inversione del modello" è stato confrontato con un approccio di "pianificazione del moto rigido" (che trascura la sottoattuazione e tratta il carico come un corpo rigido attaccato ai carrelli).

• Traslazione Orizzontale: L'approccio basato sul modello ha ridotto l'errore massimo di tracciamento nella direzione orizzontale da 40,9 mm a 0,7 mm (una riduzione del 98,3%) e nella direzione verticale da 5,2 mm a 0,5 mm (riduzione del 90,7%). Anche gli errori RMS sono stati ridotti di oltre l'85%.
• Movimento di Sollevamento: Sono stati osservati miglioramenti simili nel movimento di sollevamento, con l'errore massimo di tracciamento orizzontale ridotto del 98% e l'errore verticale dell'85,6%. L'errore di contorno (capacità di tracciamento nello spazio cartesiano) è stato ridotto di circa il 94%.
• Oscillazioni Residue: Il metodo proposto ha soppresso significativamente le oscillazioni residue dopo il completamento del moto rispetto all'approccio di pianificazione rigida, che mostrava vibrazioni persistenti.

Significato e Rivendicazioni
Il documento sostiene che l'approccio proposto offre una soluzione praticamente percorribile per il trasporto cooperativo di precisione nell'automazione industriale. Il suo significato primario risiede nella capacità di ottenere un tracciamento ad alta precisione e la soppressione delle oscillazioni senza richiedere modifiche all'architettura di controllo nativa o l'aggiunta di sensori sul lato carico. Ciò lo rende particolarmente attraente per le industrie che utilizzano controllori proprietari chiusi dove i loop di feedback interni non possono essere modificati.

Gli autori sottolineano che l'affidamento del metodo all'integrazione numerica esplicita permette una facile implementazione e un basso costo computazionale, mentre il calcolo esplicito della tensione fornisce uno strumento prezioso per la dimensionatura del sistema e l'analisi della fattibilità della traiettoria durante la fase di progettazione. I risultati confermano che la pianificazione basata sul modello è superiore ai metodi euristici senza modello per i sistemi sospesi tramite cavi sottoattuati, raggiungendo errori di tracciamento nell'ordine del sub-millimetro (picco di 0,7 mm) con oscillazioni residue trascurabili.