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

Planificación de Movimiento Adaptativo mediante Inferencia de Intención Basada en Contacto para Colaboración Humano-Robot

Información Básica

  • ID del Artículo: 2510.08811
  • Título: Adaptive Motion Planning via Contact-Based Intent Inference for Human-Robot Collaboration
  • Autores: Jiurun Song (Texas A&M University), Xiao Liang (Texas A&M University), Minghui Zheng (Texas A&M University)
  • Clasificación: cs.RO (Robótica)
  • Fecha de Publicación: 9 de octubre de 2024 (preimpresión en arXiv)
  • Enlace del Artículo: https://arxiv.org/abs/2510.08811

Resumen

La colaboración humano-robot (HRC) requiere que los robots se adapten a la intención humana para garantizar una cooperación segura y eficiente en espacios compartidos. Aunque los modelos de lenguaje grandes (LLMs) proporcionan capacidades de razonamiento de alto nivel para inferir la intención humana, su aplicación en la planificación de movimiento confiable para HRC sigue siendo desafiante. La interacción física humano-robot (pHRI) es intuitiva pero generalmente depende de una guía cinestésica continua, lo que impone una carga al operador. Para abordar estos desafíos, este artículo presenta un marco de planificación de movimiento adaptativo basado en información de contacto, que infiere directamente la intención humana a partir del contacto físico y la utiliza para correcciones de movimiento en línea en HRC.

Antecedentes de Investigación y Motivación

Problema Central

En la colaboración humano-robot, los robots necesitan adaptarse en tiempo real a la intención humana para garantizar una cooperación segura y eficiente, especialmente en entornos inciertos y dinámicos. Cuando la trayectoria planificada del robot no coincide con la intención humana, es necesario realizar ajustes oportunos.

Importancia del Problema

  1. Requisitos de Seguridad: En espacios de trabajo compartidos, los robots deben poder responder a correcciones de seguridad humanas
  2. Requisitos de Eficiencia: Reducir la carga de guía física continua del operador e incrementar la eficiencia de la colaboración
  3. Consideraciones Prácticas: Los métodos existentes dependen de sensores costosos o requieren intervención humana continua

Limitaciones de Métodos Existentes

  1. Modelos de Lenguaje Grande: Aplicables a planificación de tareas de alto nivel, pero con problemas de latencia e información incompleta en adaptación de movimiento de bajo nivel continuo
  2. Guía Cinestésica: Requiere esfuerzo físico continuo, imponiendo carga al operador
  3. Sensores Táctiles: Despliegue complejo, alto costo, y desafíos en adaptación a superficies curvas y resistencia al impacto

Motivación de la Investigación

Aprovechar la característica de que la magnitud y dirección de la fuerza de contacto codifican naturalmente la intención humana, transmitiendo intención de corrección mediante contacto breve en lugar de guía continua.

Contribuciones Principales

  1. Método de Estimación de Fuerza Impulsado por Optimización: Inferir la fuerza de contacto e intención humana basándose en sensores de torque articular y el modelo dinámico del robot, reduciendo costo y complejidad de instalación, logrando sensibilidad de cuerpo completo
  2. Mecanismo de Detección de Contacto Basado en Torque: Introducir localización a nivel de eslabón para reducir el espacio de búsqueda de optimización, logrando estimación en tiempo real
  3. Planificador de Movimiento Adaptativo Basado en Información de Contacto: Inferir la intención humana a partir de información de contacto y replanificar el movimiento del robot en línea, manteniendo suavidad y adaptándose a correcciones humanas
  4. Verificación Experimental: Validar la precisión del método de estimación de fuerza en un brazo manipulador de 7 grados de libertad y la efectividad del planificador de movimiento adaptativo bajo incertidumbre de percepción

Explicación Detallada del Método

Definición de Tarea

Dado un brazo manipulador en serie de n grados de libertad, estimar la fuerza de contacto e intención humana mediante mediciones de torque articular y el modelo dinámico del robot, y utilizar esta información para ajustes de planificación de movimiento en línea.

Arquitectura del Modelo

1. Modelado Dinámico

La ecuación de dinámica del robot incluye fuerzas de contacto externas:

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

donde τ_ext es el torque articular causado por fuerzas de contacto externas.

2. Detección de Contacto

Estadístico de detección basado en torque residual:

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

Utilizando filtrado de media móvil ponderada exponencial (EWMA) y mecanismo de histéresis para garantizar transiciones de estado confiables.

3. Localización a Nivel de Eslabón

Determinar el eslabón de contacto mediante análisis de distribución de torque residual:

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

4. Estimación de Fuerza de Contacto

Modelar el contacto como contacto puntual en el eslabón, resolviendo mediante optimización no lineal restringida:

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. Planificación de Movimiento Adaptativo

Ajustar la trayectoria de referencia basándose en la fuerza de contacto estimada:

  • Calcular la fuerza de contacto promedio y dirección
  • Generar desviación cartesiana: Δx_c^(r) = α sat(||F̄_c^(r)||, F_max_c) f̂^(r)
  • Utilizar funciones de protuberancia polinomial C¹ para garantizar suavidad de trayectoria
  • Acumular deformación para garantizar que el objetivo final permanezca sin cambios

Puntos de Innovación Técnica

  1. Sensibilidad de Cuerpo Completo: Utilizar sensores de torque articular existentes para lograr percepción de contacto en todo el brazo manipulador
  2. Rendimiento en Tiempo Real: Reducir el espacio de búsqueda mediante localización gruesa a nivel de eslabón, logrando estimación de fuerza en tiempo real
  3. Adaptación Suave: Utilizar funciones de protuberancia para garantizar continuidad C¹ en correcciones de trayectoria
  4. Inferencia de Intención: Mapear directamente la magnitud y dirección de la fuerza de contacto a intención de corrección de movimiento

Configuración Experimental

Plataforma Experimental

  • Robot: Brazo manipulador Franka Research 3 de 7 grados de libertad
  • Sensores: Sensores de torque articular
  • Entorno: Escenario de colaboración en desmantelamiento de computadoras

Métricas de Evaluación

  • Precisión de Estimación de Fuerza: Evaluada comparando torque articular predicho con valores medidos
  • Adaptabilidad de Movimiento: Evaluada mediante tasa de éxito de evitación de obstáculos y suavidad de trayectoria
  • Tiempo de Respuesta: Latencia desde detección de contacto hasta ajuste de movimiento

Diseño Experimental

  1. Verificación de Estimación de Fuerza: Robot ejecuta trayectoria circular, humano aplica empuje, tracción y golpeteo en diferentes eslabones
  2. Corrección de Contacto Único: Escenario de evitación de obstáculos en trayectoria recta
  3. Corrección de Contacto Múltiple: Evitación de obstáculos complejos requiriendo múltiples intervenciones humanas

Resultados Experimentales

Resultados Principales

1. Precisión de Estimación de Fuerza

  • Error Absoluto Promedio: 0.665 N·m (estimación de torque articular)
  • Consistencia Temporal: Las fuerzas estimadas y medidas muestran tendencias consistentes en los 7 articulaciones
  • Detección de Contacto: Los 5 eventos de contacto fueron detectados oportunamente

2. Rendimiento de Adaptación de Movimiento

  • Corrección de Contacto Único: Evitación exitosa de obstáculos colocados vertical y horizontalmente
  • Corrección de Contacto Múltiple: 4 contactos consecutivos guiaron exitosamente al robot alrededor de obstáculos complejos
  • Suavidad de Trayectoria: Todas las trayectorias corregidas mantienen continuidad C¹

Análisis de Casos

Experimento Uno: Evitación de Obstáculo Vertical

  • Humano aplica fuerza de contacto horizontal en dirección negativa x
  • Robot evita exitosamente el obstáculo con desplazamiento lateral
  • Trayectoria converge suavemente al punto objetivo original

Experimento Dos: Evitación de Obstáculo Horizontal

  • Humano aplica fuerza de contacto hacia arriba
  • Robot rodea el obstáculo desde arriba
  • Demuestra comprensión correcta de intención en diferentes direcciones

Experimento Tres: Correcciones Múltiples

  • 4 contactos consecutivos: 2 laterales, 1 desplazamiento forzado, 1 corrección hacia abajo
  • Demuestra capacidad de procesamiento de secuencias de intención complejas
  • Valida efectividad del mecanismo de corrección incremental

Hallazgos Experimentales

  1. Consistencia de Dirección de Fuerza: La dirección de fuerza estimada permanece consistente dentro de un evento de contacto, indicando una única intención dominante
  2. Variación de Magnitud de Fuerza: Fuerzas menores al inicio y final del contacto, con pico en el medio, conforme a patrones de contacto natural
  3. Rendimiento en Tiempo Real: El sistema detecta contacto y ajusta movimiento en tiempo real, satisfaciendo requisitos de colaboración

Trabajo Relacionado

Direcciones Principales de Investigación

  1. Aplicación de Modelos de Lenguaje Grande en HRC: Planificación de tareas de alto nivel y razonamiento semántico
  2. Interacción Física Humano-Robot: Guía cinestésica, control de impedancia, control compartido
  3. Tecnologías de Percepción de Contacto: Sensores táctiles, estimación de fuerza basada en modelos
  4. Métodos de Inferencia de Intención: Aprendizaje automático, métodos de optimización, modelos probabilísticos

Ventajas de Este Artículo

  1. Rentabilidad: Utiliza sensores articulares existentes, sin necesidad de sensores táctiles adicionales
  2. Rendimiento en Tiempo Real: Logra estimación en tiempo real mediante estrategia de localización jerárquica
  3. Percepción de Cuerpo Completo: Logra sensibilidad de brazo manipulador completo en comparación con métodos limitados al efector final
  4. Adaptación Suave: Garantiza continuidad de trayectoria, evitando cambios abruptos

Conclusiones y Discusión

Conclusiones Principales

  1. El marco propuesto puede estimar con precisión la fuerza de contacto e intención humana
  2. La planificación de movimiento basada en información de contacto logra ajustes suave de trayectoria en línea
  3. Los experimentos validan la efectividad del método en tareas de desmantelamiento colaborativo
  4. Comparado con guía cinestésica continua, reduce significativamente la carga del operador humano

Limitaciones

  1. Suposición de Contacto Puntual: El método actual asume contacto puntual, posiblemente inaplicable a contacto de área grande
  2. Ajuste de Parámetros: La sensibilidad del sistema requiere ajuste manual, posiblemente inadecuado para diferencias individuales
  3. Limitaciones Ambientales: Principalmente verificado en entornos estructurados, adaptabilidad en entornos complejos no suficientemente probada
  4. Dependencia del Modelo Dinámico: El método depende de un modelo dinámico de robot preciso

Direcciones Futuras

  1. Aprendizaje Personalizado: Adaptar estilos de interacción individual mediante métodos de aprendizaje
  2. Procesamiento de Contacto Múltiple: Extender a escenarios de contacto simultáneo en múltiples puntos
  3. Generalización Ambiental: Verificar en entornos más complejos y no estructurados
  4. Aprendizaje a Largo Plazo: Mejorar iterativamente parámetros mediante múltiples ensayos

Evaluación Profunda

Fortalezas

  1. Innovación Técnica: Combinación ingeniosa de modelado dinámico y métodos de optimización, logrando percepción de contacto de alta precisión y bajo costo
  2. Valor Práctico: Resuelve problemas importantes en HRC real, con valor de aplicación directa
  3. Integridad del Sistema: Forma un sistema de bucle cerrado completo desde detección de contacto hasta planificación de movimiento
  4. Verificación Experimental Suficiente: Validación en múltiples escenarios demuestra robustez y adaptabilidad del método

Insuficiencias

  1. Análisis Teórico Limitado: Carencia de garantías teóricas de convergencia y estabilidad
  2. Experimentos Comparativos Limitados: Comparación cuantitativa insuficiente con otros métodos avanzados
  3. Investigación de Usuario Ausente: Carencia de evaluación subjetiva de usuarios reales e investigación de uso a largo plazo
  4. Análisis de Complejidad Computacional: Análisis insuficiente del costo computacional de resolución de optimización

Impacto

  1. Contribución Académica: Proporciona nueva ruta técnica para inferencia de intención en HRC
  2. Aplicación Industrial: El método tiene buenas perspectivas de aplicación industrial
  3. Reproducibilidad: Detalles técnicos suficientes, facilitando reproducción y extensión
  4. Significado Inspirador: Proporciona ideas valiosas para investigación relacionada

Escenarios Aplicables

  1. Manufactura Colaborativa: Tareas de manufactura requiriendo colaboración humano-robot como ensamblaje, desmantelamiento, pulido
  2. Robots de Servicio: Escenarios de servicio doméstico y médico requiriendo interacción física
  3. Entrenamiento de Rehabilitación: Aplicaciones de robots de rehabilitación requiriendo adaptación a intención del paciente
  4. Investigación Educativa: Plataforma de investigación para HRC e inferencia de intención

Referencias

El artículo cita 38 referencias relacionadas, cubriendo múltiples campos relevantes incluyendo HRC, pHRI, percepción de contacto, planificación de movimiento, proporcionando base teórica sólida para la investigación.


Evaluación General: Este es un artículo de alta calidad con contribuciones importantes en el campo de la colaboración humano-robot. El marco de planificación de movimiento adaptativo basado en información de contacto propuesto por los autores es técnicamente avanzado, prácticamente fuerte, y suficientemente verificado experimentalmente. Aunque hay espacio para mejora en análisis teórico e investigación de usuario, en general representa un progreso importante en el campo, con buen valor académico y perspectivas de aplicación.