⚡ electrical engineering

Impedance MPC for Physical Human-Robot Interaction: Predictive Disturbance Rejection with Joint-Limit Safety

Ce document présente un cadre de commande prédictive par modèle d'impédance à deux couches qui combine une linéarisation dynamique analytique avec un problème de programmation quadratique convexe à haute fréquence et un filtre de Kalman augmenté pour atteindre une erreur d'état stationnaire inférieure à 0,05 mm sous des forces humaines soutenues tout en garantissant la sécurité des limites articulaires, surpassant de manière significative le contrôle d'impédance classique sur un robot Franka FR3 à 7 degrés de liberté.

Auteurs originaux : Yongyan Cao, Jinshan Tang

Publié 2026-06-09

📖 6 min de lecture🧠 Analyse approfondie

CC0 1.0

Auteurs originaux : Yongyan Cao, Jinshan Tang

Article original placé dans le domaine public sous CC0 1.0 (http://creativecommons.org/publicdomain/zero/1.0/). ✨ Ceci est une explication générée par l'IA de l'article ci-dessous. Elle n'a pas été rédigée ni approuvée par les auteurs. Pour une précision technique, consultez l'article original. Lire la clause de non-responsabilité complète

Imaginez un bras robotique travaillant aux côtés d'un humain dans un espace partagé, comme un atelier d'usine ou une chambre d'hôpital. Le robot doit être assez précis pour suivre une trajectoire spécifique (comme dessiner un cercle parfait) mais aussi assez souple et docile pour que, si un humain le bouscule accidentellement, le robot cède en toute sécurité au lieu de résister ou de casser quelque chose.

Ce document présente un nouveau « cerveau » pour ces robots, appelé Impedance MPC, qui résout un problème classique : Comment rester sur la bonne voie sans être dévié de sa trajectoire ?

Voici la décomposition de son fonctionnement, en utilisant des analogies de la vie quotidienne.

Le Problème : Le « Ressort Rigide » vs La « Colle Collante »

Le contrôle traditionnel d'un robot agit comme un ressort rigide.

Le Scénario : Vous poussez le bras du robot avec une force constante de 15 livres.
Le Résultat : Le ressort s'étire. Le robot s'éloigne de sa trajectoire cible et y reste. Pour le faire revenir, vous devez le repousser, ou rendre le ressort incroyablement rigide.
Le Piège : Si vous rendez le ressort trop rigide pour empêcher le mouvement, le robot devient dangereux. Si un humain le bouscule, le robot résiste avec force, ce qui va à l'encontre de l'objectif d'un robot « collaboratif ».
L'Ancienne Solution : Les ingénieurs ont tenté d'ajouter une « mémoire » (action intégrale) au ressort pour qu'il se souvienne de la poussée et la corrige. Mais cela revenait à essayer de faire tenir en équilibre un balai sur sa main en courant ; c'était instable et lent.

La Solution : Un « Pilote Intelligent » à Deux Couches

Les auteurs ont construit un système à deux couches qui agit comme un pilote hautement qualifié capable de prédire le vent avant qu'il ne frappe l'avion.

Couche 1 : Le « Annulateur de Gravité » (La Vérification Pré-vol)

Les robots sont lourds et leurs articulations interagissent de manière complexe (comme un gymnaste se balançant à une barre).

L'Analogie : Imaginez essayer de diriger un bateau lourd dans une rivière avec des courants forts. Il est difficile de prédire où vous allez aller.
Ce que fait le Robot : La Couche 1 calcule et annule instantanément le poids propre du robot, la friction de ses articulations et le « balancement » de son mouvement.
Le Résultat : Cela transforme le bras robotique complexe et instable en un objet simple et prévisible — comme un palet sans friction glissant sur de la glace. Cela simplifie tellement les mathématiques que l'ordinateur peut résoudre le problème suivant de manière incroyablement rapide.

Couche 2 : La « Boule de Cristal » (Le Contrôleur Prédictif de Modèle)

Maintenant que le robot est un simple « palet sur glace », la Couche 2 prend le relais. Il s'agit du Contrôleur Prédictif de Modèle (MPC).

L'Analogie : Imaginez conduire une voiture en regardant 10 secondes devant vous. Si vous voyez un nid-de-poule arriver, vous braquez légèrement maintenant pour ne pas le percuter plus tard.
Ce que fait le Robot : Au lieu de simplement réagir à une poussée après qu'elle soit survenue, cette couche résout un casse-tête mathématique complexe 100 fois par seconde. Elle demande : « Si j'applique une force infime maintenant, où serai-je dans 0,1 seconde ? Dans 0,2 seconde ? »
La Magie : Elle trouve la séquence parfaite de micro-mouvements pour rester sur la trajectoire, même si un humain la pousse. Elle respecte les « zones de sécurité » (limites articulaires) tout comme un conducteur respecte les marquages au sol.

La Recette Secrète : Le « Casque à Réduction de Bruit »

Même avec la boule de cristal, une poussée humaine constante (comme une force de 15N) peut encore tromper le système.

L'Innovation : Les auteurs ont ajouté un Filtre de Kalman qui agit comme des casques à réduction de bruit.
Comment ça marche : Le système écoute constamment le « bruit » (la poussée de l'humain). Il estime exactement la force de la poussée de l'humain et ajoute une force égale et opposée pour l'annuler parfaitement.
Le Résultat : Le robot ne se contente pas de « céder » à la poussée ; il combat activement la poussée pour rester exactement sur sa trajectoire d'origine.

Les Résultats : De « Vacillant » à « Laser »

L'équipe a testé cela sur un robot à 7 bras (Franka FR3). Voici ce qui s'est passé lorsqu'un humain l'a poussé avec une force constante de 15 livres :

Les anciens robots (Impedance Classique) : Le robot s'est décalé de 44,8 millimètres (presque 2 pouces) de sa trajectoire et y est resté.
Le nouveau robot (Impedance MPC + Kalman) : Le robot s'est décalé de moins de 0,05 millimètre de sa trajectoire.
- Traduction : C'est une amélioration de 800 fois. Le nouveau robot est si précis qu'on pourrait presque croire que l'humain ne l'a jamais poussé.

Fonctionnalités de Sécurité

Le système possède également un « ange gardien » intégré pour les articulations du robot :

L'Analogie : Imaginez un coureur qui sait qu'il approche d'un mur. À mesure qu'il s'en approche, il ralentit instinctivement et change de direction, même si l'entraîneur (la tâche principale) lui crie : « Cours tout droit ! ».
La Technologie : Le robot utilise un « potentiel de barrière » pour détecter quand une articulation est sur le point d'atteindre sa limite physique. Il redirige automatiquement le mouvement vers une direction sûre sans briser la tâche principale.

Résumé

Ce document présente un système de contrôle de robot qui :

Simplifie la physique du robot pour faciliter les calculs.
Prédit l'avenir pour contourner les perturbations avant qu'elles ne causent de grandes erreurs.
Écoute l'environnement pour annuler parfaitement les poussées constantes.
Garde le robot en sécurité en ne laissant jamais ses articulations atteindre leurs limites.

Le résultat est un robot capable de travailler côte à côte avec des humains, restant parfaitement concentré sur sa tâche même lorsqu'il est poussé, sans devenir dangereux ou rigide.

Résumé Technique : MPC d'Impédance pour l'Interaction Physique Homme-Robot

Énoncé du Problème
L'interaction physique homme-robot (pHRI) exige que les robots maintiennent simultanément une grande précision de trajectoire et assurent une sécurité de compliance lors de contacts imprévus. Le contrôle d'impédance classique, bien qu'efficace pour la sécurité, souffre d'une limitation structurelle fondamentale : sous une force humaine soutenue ( $F_h$ ), il présente une erreur de position en régime permanent non nulle définie par $e_\infty = K_d^{-1}F_h$ . Par exemple, une poussée de 15 N contre une raideur de 300 N/m entraîne un décalage de 50 mm. Bien qu'augmenter la raideur ( $K_d$ ) réduise cette erreur, cela viole les contraintes de sécurité en augmentant les forces de contact. Inversement, l'ajout d'une action intégrale pour éliminer l'erreur en régime permanent est sévèrement limité par les exigences de stabilité, ce qui restreint la vitesse de convergence. Les approches de MPC (Contrôle Prédictif par Modèle) existantes pour la pHRI conservent souvent la dynamique non linéaire complète de l'usine, limitant les taux de contrôle, ou ne parviennent pas à fournir des garanties formelles d'erreur de position nulle sous des perturbations persistantes.

Méthodologie
Les auteurs proposent une architecture de MPC d'impédance à deux couches conçue pour résoudre la tension entre précision de trajectoire et sécurité de compliance.

Couche 1 : Inversion Non Linéaire Analytique
La première couche emploie une stratégie de contrôle par anticipation (feedforward) basée sur la décomposition de l'espace opérationnel. Elle annule analytiquement la gravité, les forces de Coriolis et les termes d'inertie de l'espace de tâche. Cela transforme la dynamique résiduelle de l'usine en un double intégrateur linéaire indépendant de la configuration.
- La dynamique de l'erreur est réduite à $\ddot{e} = -\Lambda^{-1}(q) F_{mpc} + d(t)$ , où $d(t)$ représente les perturbations agrégées (force humaine, friction, erreurs de modèle).
- Crucialement, cette linéarisation résulte en une matrice de transition d'état constante ( $A_d$ ) pour le système en temps discret. Cela permet à la matrice de « réponse libre » d'être précalculée une seule fois, réduisant considérablement la charge de calcul en ligne.
Couche 2 : QP Convexe avec Augmentation de Perturbation
La seconde couche résout un problème d'optimisation à horizon fuyant à 100 Hz (avec une boucle interne de 1 kHz pour les mises à jour de l'anticipation).
- Estimation de la Perturbation : Un filtre de Kalman augmenté estime un état de perturbation persistant ( $\hat{d}$ ) modélisé comme une marche aléatoire. Cet état est intégré dans le modèle de prédiction du MPC, permettant un suivi sans décalage (erreur de régime permanent nulle) pour des perturbations constantes ou asymptotiquement constantes.
- Optimisation : Le contrôleur résout un programme quadratique (QP) convexe de 30 variables soumis à des contraintes de boîte sur la force de commande ( $F_{mpc}$ ). La fonction de coût minimise l'erreur de suivi sur un horizon tout en respectant les limites articulaires.
- Mécanismes de Sécurité : La sécurité des limites articulaires est assurée via une approche à double barrière : un potentiel de barrière d'espace nul et une projection de l'espace de travail. Ces mécanismes empêchent les violations de limites articulaires sans dégrader le suivi de la tâche dans les zones sûres.

Contributions Clés

Architecture à deux couches à $A_d$ constante : En annulant analytiquement les non-linéarités, les auteurs réduisent l'usine à un système linéaire dont la matrice d'état est constante. Cela permet de résoudre un QP de 30 variables en moins de 1 ms, rendant l'implémentation en temps réel réalisable.
Connexion Analytique à l'Impédance Classique : L'article prouve (Théorème 1) que dans la limite non contrainte et sans perturbation, le MPC proposé est mathématiquement équivalent à un contrôleur d'impédance classique de l'espace de tâche. La raideur et l'amortissement réalisés sont déterminés par les gains LQR dérivés des poids de coût. Cela positionne la méthode comme une extension de l'impédance classique qui ajoute la gestion des contraintes et le rejet sans décalage, plutôt qu'un remplacement.
Garantie Formelle d'Erreur de Régime Permanent Nulle : Grâce à l'augmentation de la perturbation par le filtre de Kalman, le système atteint une garantie basée sur le Principe du Modèle Interne d'erreur nulle pour les perturbations persistantes, étendant la théorie du MPC sans décalage aux manipulateurs pilotés par couple.
Sécurité des Limites Articulaires par Double Barrière : L'intégration des potentiels de l'espace nul et des projections de l'espace de travail empêche empiriquement les violations de limites articulaires à travers l'espace de travail testé, incluant les tests de stress de bordure.

Résultats Expérimentaux
Des expériences ont été menées sur un robot Franka FR3 à 7 degrés de liberté via la simulation MuJoCo. La méthode proposée (MPC d'impédance avec augmentation de Kalman) a été comparée à l'impédance classique, au contrôle d'admittance et à l'impédance PI.

Erreur de Régime Permanent : Sous une force soutenue de 15 N, la méthode proposée a atteint une erreur de régime permanent de <0,05 mm, contre 44,8 mm pour l'impédance classique (une réduction de plus de 800 fois).
Performance Transitoire : Dans le suivi de trajectoire circulaire, le MPC seul (sans Kalman) a réduit l'erreur RMS de la fenêtre de contact de 19× par rapport à l'impédance classique. L'ajout du filtre de Kalman a éliminé entièrement l'erreur de régime permanent.
Robustesse : Le système a démontré une robustesse progressive au bruit de mesure (l'erreur de régime permanent est restée <1 mm même avec un bruit de 5 mm) et au désaccord du modèle inertiel (l'erreur RMSE de suivi est restée invariante jusqu'à 30 % d'erreur d'inertie lorsque le filtre de Kalman était actif).
Sécurité : Lors des tests de bordure où l'impédance classique violait les limites articulaires, le MPC a maintenu une marge de sécurité (marge articulaire minimale de 0,084 contre 0,048 pour l'impédance).

Signification et Revendications
L'article affirme que l'architecture proposée réussit à unifier les demandes concurrentes de la pHRI : un suivi de trajectoire de haute précision et une sécurité de compliance. La principale signification réside dans l'intuition structurelle selon laquelle l'annulation par anticipation analytique permet une structure linéaire constante, ce qui permet :

Précalcul : La matrice de réponse libre est calculée une seule fois, découplant la complexité du QP de la configuration du robot.
Garanties Formelles : La structure linéaire permet des preuves rigoureuses d'équivalence d'impédance et de suivi sans décalage.
Faisabilité en Temps Réel : L'approche atteint des taux de contrôle élevés (QP à 100 Hz, anticipation à 1 kHz) sur du matériel standard, surmontant les goulots d'étranglement computationnels des approches de MPC non linéaire précédentes.

Les auteurs concluent que cette méthode fournit une solution robuste et théoriquement fondée pour la pHRI, qui élimine l'erreur de régime permanent inhérente au contrôle d'impédance classique tout en maintenant les contraintes de sécurité, avec des travaux futurs prévus pour la validation sur matériel physique et l'augmentation de passivité par réservoir d'énergie.