Una nueva arquitectura de control de tres niveles otorga a los robots de base flotante —humanoides y cuadrúpedos— la capacidad de rechazar empujes físicos humanos y fuerzas de contacto sostenidas con error en estado estacionario nulo, sin sacrificar el equilibrio. Al combinar un control predictivo de modelo (MPC) centroidal para la locomoción con un MPC de impedancia separado que predice y cancela las fuerzas de interacción humana a 1 kHz, el sistema ocupa un nicho estructural que trabajos previos habían dejado vacío.
Tabla de contenidos
- Lo que construyeron los investigadores
- Resultados clave
- Cómo funciona
- Por qué esto es importante para la robótica
- Limitaciones y preguntas abiertas
- Preguntas frecuentes
- Conclusión
Lo que construyeron los investigadores
Yongyan Cao desarrolló una pila de control que ejecuta tres bucles anidados en un robot de base flotante (humanoide o cuadrúpedo). El bucle más externo —MPC centroidal— funciona a 40–100 Hz y planifica la trayectoria del centro de masas y las fuerzas de reacción del suelo en un horizonte de 500 milisegundos. El bucle intermedio —una jerarquía de control de cuerpo completo (WBC)— funciona a 500 Hz y resuelve esas fuerzas de suelo en pares articulares para el mantenimiento del contacto y el equilibrio. Crucialmente, la jerarquía WBC deja abierta la ranura de tarea del efector final del brazo.
Esa ranura abierta es ocupada por el bucle más interno: un MPC de impedancia que funciona aproximadamente a 1 kHz. Esta capa predice y rechaza las fuerzas de interacción física humano-robot (pHRI) utilizando un modelo dinámico consistente con los contactos de la dinámica residual del brazo. En lugar de una ley de impedancia PD estándar, el MPC de impedancia utiliza un programa cuadrático (QP) de horizonte deslizante que considera tanto la perturbación predicha como los límites de par del robot. Un filtro de Kalman estima la perturbación de fuerza externa, y un protocolo de conmutación de modo de contacto asegura que el filtro reconverja rápidamente cuando el robot transiciona entre fases de apoyo (por ejemplo, apoyo doble a apoyo simple).
Resultados clave
El artículo reporta experimentos de simulación en dos plataformas: un modelo humanoide genérico y el modelo oficial Unitree G1 MJCF (29 GDL, 33.3 kg). Se prueban tres escenarios principales:
- Escenario A (empuje sostenido): Se aplica una fuerza constante de 8 N al efector final del brazo mientras el robot está en apoyo doble. El MPC de impedancia logra error de seguimiento nulo en estado estacionario, mientras que una ley de impedancia PD convencional deriva 2–3 cm y no puede rechazar completamente la perturbación.
- Escenario B (empuje + picos periódicos): Se combina una fuerza sostenida de 8 N con picos de 6 N a 1 Hz (duración 0.1 s). El MPC de impedancia mantiene el error de posición del efector final por debajo de 0.5 cm durante los picos y vuelve a cero después; la ley PD sufre errores pico que superan 4 cm.
- Escenario C (modelo real Unitree G1): El mismo protocolo del Escenario A ejecutado en el modelo oficial G1 confirma la transferibilidad de la arquitectura, con error en estado estacionario nulo comparable y una reducción del 80% en el error transitorio pico en comparación con PD.
Un límite de convergencia a través de transiciones de contacto muestra que el filtro de Kalman reconverge en aproximadamente 10 muestras (10 ms a 1 kHz) después de la inflación de covarianza, asegurando que la estimación de fuerza permanezca precisa incluso cuando los pies se levantan o aterrizan.
Cómo funciona
El estado del robot se describe mediante coordenadas generalizadas: una base flotante de 6 GDL más los ángulos articulares. La jerarquía de control aprovecha la inversa de masa consistente con los contactos, que proyecta las fuerzas de tarea en el espacio nulo de las restricciones de contacto rígidas. Esto asegura que los comandos generados por el MPC de impedancia no violen las restricciones cinemáticas de contacto ni interfieran con el equilibrio.
Desglose de la arquitectura:
| Nivel | Componente | Frecuencia | Objetivo |
|---|---|---|---|
| 1 | MPC centroidal | 40–100 Hz | Planificar la trayectoria del CoM y las fuerzas de reacción del suelo (horizonte de 500 ms) usando el modelo de dinámica de cuerpo rígido simple (SRBD) |
| 2 | Jerarquía WBC | 500 Hz | Resolver las fuerzas del Nivel 1 en pares articulares para las tareas de contacto y equilibrio, dejando abierta la ranura de tarea del efector final del brazo |
| 3 | MPC de impedancia | ~1 kHz | Llenar la ranura del brazo con un QP de horizonte deslizante que predice y rechaza perturbaciones pHRI |
El MPC de impedancia utiliza un modelo de planta residual: después de que el Nivel 2 compromete los pares de equilibrio, la dinámica restante del efector final del brazo se linealiza y se aumenta con un estado de perturbación de fuerza externa. Un filtro de Kalman estima la perturbación en línea. En cada paso de tiempo, el MPC resuelve un QP que minimiza el error de seguimiento y el esfuerzo de par respetando los límites de par articular. La estimación de la perturbación se introduce en el modelo para cancelar la fuerza humana.
Para las transiciones de contacto (por ejemplo, levantar un pie), un protocolo infla la covarianza del filtro de Kalman y mantiene constante la estimación actual de la perturbación hasta que el filtro reconverge (aproximadamente 10 muestras). Esto evita grandes picos transitorios cuando cambia el conjunto de contactos.
Por qué esto es importante para la robótica
Los robots de base flotante —humanoides y cuadrúpedos— se están trasladando cada vez más de los laboratorios de investigación a almacenes, fábricas y hogares. Necesitan trabajar de forma segura junto a las personas, no solo caminar y mantener el equilibrio. Un humano podría golpear accidentalmente un brazo, empujar un hombro o agarrar un miembro durante tareas colaborativas. Las pilas de control previas optimizadas para la locomoción tratan los brazos como masas pasivas o utilizan control de posición de alta ganancia que resiste las fuerzas de interacción, haciendo que el robot sea rígido y peligroso.
Esta arquitectura aborda directamente esa brecha. Al reservar una "ranura" computacional para el MPC de impedancia, el robot puede cumplir activamente con las fuerzas humanas mientras mantiene el equilibrio —e incluso rechazar empujes sostenidos para mantenerse en la tarea. La tasa de actualización de 1 kHz coincide con la velocidad de los bucles típicos de sensores de fuerza-par, por lo que el sistema está listo para su implementación en el mundo real en plataformas como Unitree G1 o R1.
Para aplicaciones de almacén y fabricación, esto significa que los robots humanoides pueden ayudar con el manejo de piezas, ensamblaje u operación de herramientas sin requerir jaulas de seguridad. Para explorar robots humanoides en Robot Overflow que admitan brazos controlados por par, este esquema de control podría integrarse para permitir la colaboración física segura.
Limitaciones y preguntas abiertas
Actualmente, los resultados solo están validados en simulación (en modelos humanoide genérico y Unitree G1). La validación en hardware en un robot real se menciona como trabajo futuro. La arquitectura asume que la fuerza de perturbación se aplica solo al efector final del brazo; aún no maneja múltiples puntos de contacto simultáneos en el torso o las piernas. Además, el protocolo de conmutación de modo de contacto actualmente maneja solo transiciones entre un conjunto fijo de estados de contacto predefinidos; caminar dinámicamente con secuencias de zancada variables requeriría extender el MPC centroidal para generar ubicaciones de apoyo en línea. Finalmente, el filtro de Kalman depende de mediciones precisas de par articular, que pueden ser ruidosas en servos de bajo costo.
Preguntas frecuentes
¿Qué problema resuelve el MPC de impedancia para todo el cuerpo? Resuelve el problema de un robot de base flotante que mantiene tanto el equilibrio como el posicionamiento preciso del brazo cuando un humano aplica fuerzas sostenidas o impulsivas al brazo.
¿En qué se diferencia esto del control de impedancia estándar? El control de impedancia PD estándar no puede lograr error en estado estacionario nulo bajo una perturbación constante; el MPC de impedancia utiliza un modelo predictivo y estimación de perturbaciones para cancelar completamente la fuerza humana.
¿Funciona esto para cuadrúpedos con brazos además de humanoides? Sí: el marco de control es consistente con los contactos y funciona para cualquier robot de base flotante con articulaciones actuadas y un efector final de brazo, incluidos los manipuladores con patas.
¿Qué sensores se requieren? El sistema necesita codificadores articulares, sensores de par (o estimaciones de par a partir de la detección de corriente) y opcionalmente un sensor de fuerza-par en la muñeca para mejorar la convergencia del Kalman. No se requiere captura de movimiento externa.
Conclusión
La arquitectura de tres niveles propuesta por Yongyan Cao llena un vacío crítico en el control de robots de base flotante: añade una capa de cumplimiento predictivo rápida para la interacción física humana sin comprometer el equilibrio. Los resultados de simulación en un humanoide genérico y el Unitree G1 muestran error en estado estacionario nulo y errores pico significativamente menores en comparación con la impedancia PD convencional. El camino hacia la implementación en hardware es claro, y el enfoque podría hacer que los robots humanoides sean más seguros y prácticos en entornos habitados por humanos.
¿Qué tan cerca estamos de ver robots humanoides que puedan trabajar de forma segura junto a personas sin sensores de fuerza-par en cada articulación?
Traducido y adaptado del artículo original: 'Whole-Body Impedance MPC Lets Legged Robots Safely Handle Human Pushes'