Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

Résumé Technique : Gouverneur de Référence Explicite Conforme pour Manipulateurs Robotiques Compatibles avec le Contact

Énoncé du Problème
La planification de mouvement robotique traditionnelle privilégie l'évitement des collisions pour assurer la sécurité, traitant souvent le contact avec l'environnement comme un obstacle. Cependant, la robotique moderne exige de plus en plus des capacités « riches en contact » où l'interaction physique constitue une ressource. Le défi central réside dans la gestion de la transition entre le mouvement libre et le contact tout en satisfaisant deux types de contraintes distincts :

1. Contraintes Rigides : Limites non négociables telles que les plages articulaires, les bornes de couple et les surfaces interdites.
2. Contraintes Souples : Conditions où le contact est permis mais doit être géré en toute sécurité. Ces contraintes créent des conditions « OU » hautement non convexes : le robot doit soit éviter tout contact, soit opérer sous des restrictions spécifiques de sécurité en contact.

Les stratégies existantes basées sur l'optimisation (par exemple, la Commande Prédictive de Modèle) nécessitent souvent une refonte complète des lois de commande et des approximations complexes et variant dans le temps de la dynamique de contact, ce qui est peu attrayant pour les praticiens disposant de contrôleurs hérités. À l'inverse, les approches hiérarchiques telles que les Fonctions de Barrière de Contrôle ou la conformité basée sur l'énergie manquent souvent de garanties strictes de contrainte ou de stabilité asymptotique. Le Gouverneur de Référence Explicite (ERG) offre un filtre de sécurité hiérarchique qui modifie les références sans altérer le contrôleur sous-jacent, mais les implémentations antérieures considéraient le contact comme indésirable, arrêtant le mouvement dès le contact. Cet article répond au besoin d'un cadre permettant une opération continue et sûre pendant le contact sans modifier le contrôleur de bas niveau.

Méthodologie : Le Gouverneur de Référence Explicite Conforme (CERG)
Les auteurs proposent le Gouverneur de Référence Explicite Conforme (CERG), un système de gestion de référence modulaire placé entre un planificateur de haut niveau et un contrôleur de bas niveau. Le CERG impose des contraintes opérationnelles et permet des transitions fluides entre les opérations en mouvement libre et en contact en manipulant le signal de référence $v(t)$ envoyé à un contrôleur pré-stabilisé.

La méthodologie repose sur trois composants clés :

1. Couche de Pré-stabilisation : Un contrôleur PD standard avec compensation de la gravité guide le robot vers une configuration de référence $v$. L'énergie totale du système (cinétique + potentielle virtuelle) est définie par une fonction de Lyapunov $V(x, v)$, qui décroît de manière monotone lorsque $v$ est constant.
2. Marge de Sécurité Dynamique Conforme (DSM) : L'innovation centrale est une DSM, $\Delta(x, v)$, conçue pour gérer la nature disjonctive (OU) des contraintes de contact. La condition de sécurité est formulée comme suit :
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   où $s(q) < 0$ représente le mouvement libre et $V \le E_{\max}$ représente un contact sûr avec une énergie bornée. Le CERG construit une DSM composite :
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$ : Impose les contraintes rigides (limites articulaires, etc.).
   • $\Delta_s$ : Une marge basée sur la trajectoire pour la surface de contrainte souple $s(q)$.
   • $\Delta_E$ : Une marge basée sur l'énergie définie comme $\kappa_E(E_{\max} - V(x, v))$.
     Cette structure garantit que si le robot est en mouvement libre, la contrainte d'énergie est assouplie ; si un contact se produit, l'énergie totale du système est strictement bornée par $E_{\max}$.
3. Champ de Navigation Souple (NF) : Contrairement aux contraintes rigides qui repoussent la référence, le CERG emploie un champ de répulsion « souple » $\rho_s(v)$ qui permet à la référence $v$ de pénétrer la frontière de contrainte jusqu'à une limite $\delta_s$. Cette pénétration est nécessaire pour générer la force requise pour un contact conforme. Le champ de navigation total combine l'attraction vers la cible, la répulsion des contraintes rigides et cette répulsion souple.

Contributions Clés
L'article revendique trois contributions principales :

• Filtrage Modulaire de Référence : Un cadre qui assure une transition fluide entre le mouvement sans contact et le mouvement riche en contact tout en respectant les contraintes d'angle, de vitesse et de couple articulaires, sans nécessiter de refonte du contrôleur.
• Gestion de Contraintes Disjonctives : Un mécanisme de sécurité spécifiquement conçu pour les contraintes de type « OU », garantissant une satisfaction prouvable soit de l'évitement du contact, soit du maintien d'une énergie bornée pendant le contact.
• Ligne Directrice de Sécurité Basée sur l'Énergie : Une métrique de sécurité basée sur l'énergie mécanique totale (potentielle + cinétique) du système en boucle fermée. Cette métrique est invariante par rapport au repère, liée directement aux garanties de stabilité et facilement interprétable.

Résultats et Validation
Le CERG a été validé numériquement et expérimentalement sur des systèmes de complexité croissante :

• Bras Planaire à Deux Liens (Simulation) : Le CERG a été testé avec des contrôleurs en espace articulaire et en espace de l'effecteur terminal. Les résultats ont montré que le CERG a réduit avec succès les forces d'interaction par rapport à une opération sans lui et a respecté les bornes d'énergie. L'étude a noté que si la formulation en espace de l'effecteur terminal minimise l'erreur cartésienne, la formulation en espace articulaire est préférable pour les architectures hiérarchiques.
• Simulation Franka Emika Panda (Drake) : En utilisant un modèle de contact conforme avec frottement et dissipation, le CERG a été testé sur une tâche nécessitant au bras de glisser le long d'un mur. La simulation a confirmé que le CERG respectait la limite $E_{\max}$ pendant le contact, tandis qu'un ERG standard (qui s'arrête au contact) et un système non modifié ont échoué à gérer efficacement la transition d'énergie.
• Expériences Réelles (Franka Emika Panda) : Deux tâches ont été réalisées :
  1. Essuyage de Tableau Blanc : Une tâche peu sensible à l'énergie. Le CERG, l'ERG et le contrôle d'impédance ont tous accompli la tâche, mais seul le CERG a imposé les contraintes rigides (empêchant les violations de vitesse articulaire) et les limites d'énergie pendant le contact.
  2. Poussée de Tour Jenga : Une tâche hautement sensible à l'énergie. Le contrôleur d'impédance a échoué en raison soit de violations de limites articulaires, soit du renversement de la tour. L'ERG standard a échoué à empêcher le renversement en raison d'une énergie de contact excessive. Seul le CERG a réussi à pousser la tour sans la renverser en imposant strictement $E_{\max}$ pendant le contact tout en permettant une énergie plus élevée en mouvement libre.

Signification et Revendications
L'article affirme que le CERG fournit une solution pratique pour la manipulation riche en contact en agissant comme un filtre de sécurité « plug-and-play ». Sa signification réside dans la capacité à permettre aux robots de traiter le contact comme une ressource plutôt que comme un danger, sans la charge computationnelle de refontes complètes de MPC ni les risques d'instabilité des contrôleurs non modifiés. Le cadre garantit la sécurité grâce à des contraintes prouvées sur l'énergie totale du système, permettant des transitions de phase fluides entre le mouvement libre et le contact. Les auteurs concluent que l'approche est réalisable et efficace, avec un travail futur prévu pour interfacier le CERG avec des planificateurs orientés tâches.