2025-11-23T18:40:17.722372

Adaptive Motion Planning via Contact-Based Intent Inference for Human-Robot Collaboration

Song, Liang, Zheng
Human-robot collaboration (HRC) requires robots to adapt their motions to human intent to ensure safe and efficient cooperation in shared spaces. Although large language models (LLMs) provide high-level reasoning for inferring human intent, their application to reliable motion planning in HRC remains challenging. Physical human-robot interaction (pHRI) is intuitive but often relies on continuous kinesthetic guidance, which imposes burdens on operators. To address these challenges, a contact-informed adaptive motion-planning framework is introduced to infer human intent directly from physical contact and employ the inferred intent for online motion correction in HRC. First, an optimization-based force estimation method is proposed to infer human-intended contact forces and locations from joint torque measurements and a robot dynamics model, thereby reducing cost and installation complexity while enabling whole-body sensitivity. Then, a torque-based contact detection mechanism with link-level localization is introduced to reduce the optimization search space and to enable real-time estimation. Subsequently, a contact-informed adaptive motion planner is developed to infer human intent from contacts and to replan robot motion online, while maintaining smoothness and adapting to human corrections. Finally, experiments on a 7-DOF manipulator are conducted to demonstrate the accuracy of the proposed force estimation method and the effectiveness of the contact-informed adaptive motion planner under perception uncertainty in HRC.
academic

Pianificazione del Movimento Adattivo mediante Inferenza dell'Intento Basata sul Contatto per la Collaborazione Uomo-Robot

Informazioni Fondamentali

  • ID Articolo: 2510.08811
  • Titolo: Adaptive Motion Planning via Contact-Based Intent Inference for Human-Robot Collaboration
  • Autori: Jiurun Song (Texas A&M University), Xiao Liang (Texas A&M University), Minghui Zheng (Texas A&M University)
  • Classificazione: cs.RO (Robotica)
  • Data di Pubblicazione: 9 ottobre 2024 (preprint arXiv)
  • Link dell'Articolo: https://arxiv.org/abs/2510.08811

Riassunto

La collaborazione uomo-robot (HRC) richiede che il robot si adatti all'intento umano per garantire una cooperazione sicura ed efficiente negli spazi condivisi. Sebbene i modelli linguistici di grandi dimensioni (LLM) forniscano capacità di ragionamento di alto livello per l'inferenza dell'intento umano, la loro applicazione nella pianificazione del movimento affidabile per HRC rimane una sfida. L'interazione fisica uomo-robot (pHRI) è intuitiva ma generalmente dipende da una guida cinestetica continua, che rappresenta un onere per l'operatore. Per affrontare queste sfide, il presente articolo introduce un framework di pianificazione del movimento adattivo basato su informazioni di contatto, che inferisce direttamente l'intento umano dal contatto fisico e lo utilizza per la correzione del movimento in linea in HRC.

Contesto di Ricerca e Motivazione

Problema Centrale

Nella collaborazione uomo-robot, il robot deve adattarsi in tempo reale all'intento umano per garantire una cooperazione sicura ed efficiente, in particolare in ambienti incerti e dinamici, quando il percorso pianificato dal robot non è coerente con l'intento umano e richiede un aggiustamento tempestivo.

Importanza del Problema

  1. Requisiti di Sicurezza: Nello spazio di lavoro condiviso, il robot deve essere in grado di rispondere alle correzioni di sicurezza umane
  2. Requisiti di Efficienza: Ridurre l'onere della guida fisica continua da parte dell'uomo e migliorare l'efficienza della collaborazione
  3. Considerazioni Pratiche: I metodi esistenti dipendono da sensori costosi o richiedono un intervento umano continuo

Limitazioni dei Metodi Esistenti

  1. Modelli Linguistici di Grandi Dimensioni: Applicabili alla pianificazione di compiti di alto livello, ma presentano ritardi e descrizioni incomplete nell'adattamento del movimento di basso livello continuo
  2. Guida Cinestetica: Richiede uno sforzo fisico continuo, creando un onere per l'operatore
  3. Sensori Tattili: Distribuzione complessa, costi elevati, sfide nell'adattamento a superfici curve e nella resistenza agli urti

Motivazione della Ricerca

Sfruttare il fatto che la magnitudine e la direzione della forza di contatto codificano naturalmente l'intento umano, trasmettendo l'intento di correzione attraverso contatti brevi piuttosto che guida continua.

Contributi Principali

  1. Metodo di Stima della Forza Guidato dall'Ottimizzazione: Inferire la forza di contatto e la posizione dell'intento umano basandosi sui sensori di coppia articolare e sul modello dinamico del robot, riducendo i costi e la complessità di installazione, realizzando la sensibilità dell'intero corpo
  2. Meccanismo di Rilevamento del Contatto Basato sulla Coppia: Introdurre la localizzazione a livello di collegamento per ridurre lo spazio di ricerca dell'ottimizzazione, realizzando la stima in tempo reale
  3. Pianificatore del Movimento Adattivo Basato su Informazioni di Contatto: Inferire l'intento umano dalle informazioni di contatto e repianificare il movimento del robot in linea, mantenendo la levigatezza e adattandosi alle correzioni umane
  4. Verifica Sperimentale: Verificare l'accuratezza del metodo di stima della forza su un braccio robotico a 7 gradi di libertà e l'efficacia del pianificatore del movimento adattivo in condizioni di incertezza percettiva

Dettagli del Metodo

Definizione del Compito

Dato un braccio robotico seriale a n gradi di libertà, stimare la forza di contatto e la posizione dell'intento umano attraverso la misurazione della coppia articolare e il modello dinamico del robot, e utilizzare queste informazioni per l'aggiustamento della pianificazione del movimento in linea.

Architettura del Modello

1. Modellazione Dinamica

L'equazione dinamica del robot include la forza di contatto esterna:

τ = M(q)q̈ + h(q,q̇) + τ_ext

dove τ_ext è la coppia articolare causata dalla forza di contatto esterna.

2. Rilevamento del Contatto

Statistica di rilevamento basata sulla coppia residua:

η(t) = ||W_τ τ̂_ext(t)||_2

Utilizzare il filtraggio della media mobile ponderata esponenzialmente (EWMA) e il meccanismo di isteresi per garantire transizioni di stato affidabili.

3. Localizzazione a Livello di Collegamento

Determinare il collegamento di contatto analizzando la distribuzione della coppia residua:

ℓ = max{j | |τ̂_ext,j| > τ_th and |τ̂_ext,j+1| < τ_th}

4. Stima della Forza di Contatto

Modellare il contatto come un contatto puntiforme sul collegamento, risolvere attraverso ottimizzazione non lineare vincolata:

min_{s,F_c} (1/2)∑_{k=1}^N ||τ̂_ext(t_k) - J_c(q(t_k),s)^T F_c||^2
s.t. 0 ≤ s ≤ 1, ||F_c|| ≤ F_max_c

5. Pianificazione del Movimento Adattivo

Aggiustare il percorso di riferimento in base alla forza di contatto stimata:

  • Calcolare la forza di contatto media e la direzione
  • Generare deviazione cartesiana: Δx_c^(r) = α sat(||F̄_c^(r)||, F_max_c) f̂^(r)
  • Utilizzare funzioni di bump polinomiale C¹ per garantire la levigatezza del percorso
  • Accumulo di deformazione per garantire che l'obiettivo finale rimanga invariato

Punti di Innovazione Tecnica

  1. Sensibilità dell'Intero Corpo: Realizzare la percezione del contatto dell'intero braccio robotico utilizzando i sensori di coppia articolare esistenti
  2. Prestazioni in Tempo Reale: Ridurre lo spazio di ricerca attraverso la localizzazione grossolana a livello di collegamento, realizzando la stima della forza in tempo reale
  3. Adattamento Liscio: Utilizzare funzioni di bump per garantire la continuità C¹ della correzione del percorso
  4. Inferenza dell'Intento: Mappare direttamente la magnitudine e la direzione della forza di contatto all'intento di correzione del movimento

Configurazione Sperimentale

Piattaforma Sperimentale

  • Robot: Braccio robotico Franka Research 3 a 7 gradi di libertà
  • Sensori: Sensori di coppia articolare
  • Ambiente: Scenario di collaborazione per lo smontaggio di computer

Metriche di Valutazione

  • Accuratezza della Stima della Forza: Valutare confrontando la coppia articolare prevista con il valore misurato
  • Adattabilità del Movimento: Valutare attraverso il tasso di successo dell'evitamento degli ostacoli e la levigatezza del percorso
  • Tempo di Risposta: Ritardo dal rilevamento del contatto all'aggiustamento del movimento

Progettazione Sperimentale

  1. Verifica della Stima della Forza: Il robot esegue una traiettoria circolare, l'uomo applica spinte, tirature e colpi su diversi collegamenti
  2. Correzione a Contatto Singolo: Scenario di evitamento degli ostacoli con percorso rettilineo
  3. Correzione a Contatti Multipli: Evitamento complesso degli ostacoli che richiede molteplici interventi umani

Risultati Sperimentali

Risultati Principali

1. Accuratezza della Stima della Forza

  • Errore Assoluto Medio: 0,665 N·m (stima della coppia articolare)
  • Coerenza Temporale: La coppia stimata e il valore misurato mostrano tendenze coerenti su tutti i 7 giunti
  • Rilevamento del Contatto: Tutti e 5 gli eventi di contatto sono stati rilevati tempestivamente

2. Prestazioni di Adattamento del Movimento

  • Correzione a Contatto Singolo: Evitamento riuscito di ostacoli posizionati verticalmente e orizzontalmente
  • Correzione a Contatti Multipli: 4 contatti consecutivi hanno guidato con successo il robot intorno a ostacoli complessi
  • Levigatezza del Percorso: Tutti i percorsi corretti mantengono la continuità C¹

Analisi dei Casi

Esperimento Uno: Evitamento di Ostacolo Verticale

  • L'uomo applica una forza di contatto orizzontale nella direzione negativa dell'asse x
  • Il robot evita con successo l'ostacolo con uno spostamento laterale
  • Il percorso converge dolcemente verso il punto obiettivo originale

Esperimento Due: Evitamento di Ostacolo Orizzontale

  • L'uomo applica una forza di contatto verso l'alto
  • Il robot aggira l'ostacolo da sopra
  • Dimostra la corretta comprensione dell'intento in diverse direzioni

Esperimento Tre: Correzioni Multiple

  • 4 contatti consecutivi: 2 laterali, 1 spostamento forzato, 1 correzione verso il basso
  • Dimostra la capacità di elaborare sequenze di intenti complessi
  • Verifica l'efficacia del meccanismo di correzione incrementale

Scoperte Sperimentali

  1. Coerenza della Direzione della Forza: La direzione della forza stimata rimane coerente all'interno di un singolo evento di contatto, indicando un intento dominante singolo
  2. Variazione della Magnitudine della Forza: La forza è minore all'inizio e alla fine del contatto, raggiungendo il picco nel mezzo, coerente con il modello di contatto naturale
  3. Prestazioni in Tempo Reale: Il sistema è in grado di rilevare il contatto e aggiustare il movimento in tempo reale, soddisfacendo i requisiti di collaborazione

Lavori Correlati

Principali Direzioni di Ricerca

  1. Applicazione dei Modelli Linguistici di Grandi Dimensioni in HRC: Pianificazione di compiti di alto livello e ragionamento semantico
  2. Interazione Fisica Uomo-Robot: Guida cinestetica, controllo dell'impedenza, controllo condiviso
  3. Tecnologie di Percezione del Contatto: Sensori tattili, stima della forza basata su modello
  4. Metodi di Inferenza dell'Intento: Apprendimento automatico, metodi di ottimizzazione, modelli probabilistici

Vantaggi di questo Articolo

  1. Rapporto Costo-Efficacia: Utilizzo dei sensori di coppia articolare esistenti, senza necessità di sensori tattili aggiuntivi
  2. Prestazioni in Tempo Reale: Realizzazione della stima in tempo reale attraverso una strategia di localizzazione gerarchica
  3. Percezione dell'Intero Corpo: Rispetto ai metodi limitati all'end-effector, realizzazione della sensibilità dell'intero braccio robotico
  4. Adattamento Liscio: Garantire la continuità del percorso, evitando cambiamenti bruschi

Conclusioni e Discussione

Conclusioni Principali

  1. Il framework proposto è in grado di stimare accuratamente la forza di contatto e la posizione dell'intento umano
  2. La pianificazione del movimento basata su informazioni di contatto può realizzare un aggiustamento del percorso liscio in linea
  3. La verifica sperimentale ha dimostrato l'efficacia del metodo nei compiti di smontaggio collaborativo
  4. Rispetto alla guida cinestetica continua, riduce significativamente l'onere dell'operatore umano

Limitazioni

  1. Ipotesi di Contatto Puntiforme: Il metodo attuale assume il contatto come contatto puntiforme, che potrebbe non essere applicabile al contatto su larga area
  2. Regolazione dei Parametri: La sensibilità del sistema richiede una regolazione manuale, che potrebbe non adattarsi alle differenze individuali
  3. Limitazioni Ambientali: Principalmente verificato in ambienti strutturati, l'adattabilità in ambienti complessi non è stata sufficientemente testata
  4. Dipendenza dal Modello Dinamico: Il metodo dipende da un modello dinamico del robot accurato

Direzioni Future

  1. Apprendimento Personalizzato: Adattarsi allo stile di interazione individuale attraverso metodi di apprendimento
  2. Gestione di Contatti Multipli: Estensione a scenari di contatti multipli simultanei
  3. Generalizzazione Ambientale: Verifica in ambienti più complessi e non strutturati
  4. Apprendimento a Lungo Termine: Miglioramento iterativo dei parametri attraverso molteplici prove

Valutazione Approfondita

Punti di Forza

  1. Innovazione Tecnica: Combinazione ingegnosa della modellazione dinamica e dei metodi di ottimizzazione, realizzando la percezione del contatto ad alta precisione e basso costo
  2. Valore Pratico: Risolve importanti problemi in HRC reale, con valore di applicazione diretta
  3. Completezza del Sistema: Forma un sistema di ciclo chiuso completo dal rilevamento del contatto alla pianificazione del movimento
  4. Verifica Sperimentale Completa: La verifica multi-scenario dimostra la robustezza e l'adattabilità del metodo

Insufficienze

  1. Analisi Teorica Insufficiente: Mancanza di garanzie teoriche sulla convergenza e la stabilità
  2. Esperimenti di Confronto Limitati: Confronto quantitativo insufficiente con altri metodi avanzati
  3. Ricerca Utente Mancante: Mancanza di valutazione soggettiva da parte di utenti reali e ricerca sull'uso a lungo termine
  4. Analisi della Complessità Computazionale: L'analisi dell'overhead computazionale della risoluzione dell'ottimizzazione non è sufficientemente dettagliata

Impatto

  1. Contributo Accademico: Fornisce un nuovo percorso tecnico per l'inferenza dell'intento in HRC
  2. Applicazione Industriale: Il metodo ha buone prospettive di applicazione industriale
  3. Riproducibilità: I dettagli tecnici sono sufficienti per facilitare la riproduzione e l'estensione
  4. Significato Ispiratore: Fornisce idee preziose per la ricerca correlata

Scenari Applicabili

  1. Produzione Collaborativa: Compiti di produzione che richiedono collaborazione uomo-robot come assemblaggio, smontaggio, lucidatura
  2. Robot di Servizio: Scenari di servizio domestico e medico che richiedono interazione fisica
  3. Allenamento di Riabilitazione: Applicazioni di robot di riabilitazione che richiedono adattamento all'intento del paziente
  4. Ricerca Educativa: Piattaforma di ricerca per HRC e inferenza dell'intento

Riferimenti Bibliografici

L'articolo cita 38 riferimenti correlati, coprendo importanti lavori in più campi correlati come HRC, pHRI, percezione del contatto e pianificazione del movimento, fornendo una base teorica solida per la ricerca.


Valutazione Complessiva: Questo è un articolo di alta qualità con importanti contributi nel campo della collaborazione uomo-robot. Il framework di pianificazione del movimento adattivo basato su informazioni di contatto proposto dagli autori è tecnicamente avanzato e praticamente forte, con verifica sperimentale completa. Sebbene vi sia spazio per miglioramenti nell'analisi teorica e nella ricerca utente, nel complesso rappresenta un progresso importante nel campo, con buon valore accademico e prospettive di applicazione.