Résumé technique : Planification de mouvement Follow-the-Leader basée sur l'échantillonnage pour robots continus montés sur manipulateurs

1. Formulation du problème

L'article aborde le problème de planification de mouvement pour le mouvement Follow-the-Leader (FTL) chez les robots continus (CR) montés sur des manipulateurs robotiques disposant de poses de base 6-DOF entièrement actionnées ($SE(3)$).

• Contexte : Le FTL est un primitif de mouvement critique où le corps du robot retrace le trajet de son extrémité, minimisant ainsi les forces latérales sur les tissus ou structures environnants. Bien que largement étudié pour les robots de type serpent, les aiguilles steerables et les robots à tubes concentriques, les méthodes existantes pour les CR à entraînement par câbles (TDCR) supposent généralement une base fixe ou une insertion linéaire à un seul degré de liberté (1-DOF).
• Le vide : Les déploiements pratiques impliquent de plus en plus le montage de CR sur des manipulateurs sériels (par exemple, bras chirurgicaux, robots d'inspection industrielle). Cela introduit une pose de base 6-DOF qui doit être coordonnée avec la configuration interne du robot ($Q$).
• Le défi : L'espace de configuration combiné ($K = SE(3) \times Q$) est de haute dimension et non linéaire. Les approches existantes reposent souvent sur des modèles cinématiques simplifiés (par exemple, Courbure Constante par Morceaux, PCC) et sur une optimisation itérative (par exemple, solveurs de cinématique inverse). Ces méthodes souffrent de :
  • Une sensibilité à l'initialisation et une convergence vers des minima locaux.
  • Une incapacité à exploiter des modèles directs complexes et précis (par exemple, tige de Cosserat, éléments finis, réseaux de neurones) en raison du coût computationnel.
  • Un manque de garanties formelles concernant l'exhaustivité de la solution ou la précision du suivi de l'extrémité.

Objectif : Étant donné un ensemble ordonné de points de passage 3D $W$, générer un plan de mouvement continu où l'extrémité du robot suit le trajet exactement, et où le corps inséré minimise l'écart par rapport au trajet, tout en optimisant conjointement la configuration du CR et la pose de base 6-DOF.

2. Méthodologie

Les auteurs proposent un cadre basé sur l'échantillonnage qui découple la recherche de forme globale de l'interpolation locale et de la détermination de la pose de base. L'innovation centrale est une construction géométrique sous forme fermée qui détermine de manière unique la pose de base 6-DOF pour toute forme candidate, éliminant ainsi le besoin d'optimisation itérative lors de la planification en ligne.

A. Génération de bibliothèque hors ligne

• Une bibliothèque de formes est précalculée hors ligne en échantillonnant uniformément l'espace de configuration du CR $Q$.
• Pour chaque échantillon, un modèle direct général (FM) calcule les points discrétisés de l'arête.
• Cela déplace la charge computationnelle des modèles cinématiques complexes vers la phase hors ligne, permettant l'utilisation de modèles impraticables pour l'optimisation en ligne.
• Clustering : Pour réduire la complexité de la recherche en ligne de $O(N_{lib})$ à $O(\sqrt{N_{lib}})$, les formes sont regroupées en clusters basés sur leur similarité par paires. Lors de l'exécution, le planificateur évalue d'abord les centres de clusters, puis recherche exhaustivement le cluster le mieux correspondant.

B. Alignement de la pose de base en ligne (Construction géométrique)

Pour chaque point de passage $w_i$ et une forme candidate $S$ issue de la bibliothèque, la pose de base $T_b \in SE(3)$ est déterminée via trois transformations séquentielles pour aligner la forme sur le trajet actif :

1. Translation : Déplacer la forme de sorte que l'extrémité ($p_D$) coïncide exactement avec le point de passage actuel $w_i$.
2. Rotation autour de l'extrémité : Faire tourner la forme autour de $w_i$ pour aligner le vecteur allant du point actif de la forme vers l'extrémité avec la direction du trajet.
3. Rotation axiale : Résoudre le degré de liberté rotationnel restant (torsion) en alignant un troisième point de correspondance (basé sur le rapport de la longueur d'arc) avec le trajet.

Propriété clé : Cette construction garantit un placement exact de l'extrémité ($p_D = w_i$) par conception, quelle que soit la forme sélectionnée, sans résolution itérative.

C. Évaluation et sélection de la forme

• L'écart entre la forme transformée et le trajet actif est calculé à l'aide d'une distance de Chamfer symétrique.
• La forme minimisant cet écart est sélectionnée. Le processus est parallélisable sur toute la bibliothèque.
• La configuration sélectionnée $(q, T_b)$ forme un plan de mouvement épars.

D. Interpolation locale

Pour générer une trajectoire continue en vue du déploiement :

• Pré-alignement par symétrie radiale : Les configurations consécutives sont pré-alignées en les faisant tourner vers une direction de référence commune, exploitant la symétrie radiale du CR pour minimiser les discontinuités d'orientation.
• Interpolation lisse : Des configurations intermédiaires sont générées en interpolant linéairement les états des articulations et en utilisant la SLERP pour l'orientation de l'extrémité.
• Reconstruction de la pose de base : Pour chaque étape d'interpolation, la pose de base est construite en utilisant l'inverse de la pose de l'extrémité du modèle direct par rapport à la pose d'extrémité interpolée désirée. Cela garantit que le suivi exact de l'extrémité est maintenu tout au long des étapes d'interpolation.

3. Garanties théoriques

L'article établit des garanties formelles généralement absentes dans les approches basées sur l'optimisation :

1. Exhaustivité de résolution : À mesure que la taille de la bibliothèque $N_{lib} \to \infty$, la probabilité de trouver un plan valide (s'il en existe un) tend vers 1. Cela repose sur la continuité de Lipschitz de la métrique d'écart de forme.
2. Suivi exact de l'extrémité par construction : L'alignement géométrique garantit que l'extrémité se trouve exactement au point de passage à chaque étape discrète.
3. Convergence asymptotique du suivi de l'extrémité : À mesure que le nombre d'étapes d'interpolation augmente, l'écart maximal de l'extrémité par rapport au trajet linéaire entre les points de passage tend vers zéro ($O(1/h^2)$).

4. Résultats expérimentaux

La méthode a été évaluée dans trois configurations :

A. Modèle PCC vs Baseline d'optimisation

• Configuration : 120 trajets répartis sur trois classes (courbes en C, courbes en S, courbes robotiques). Comparaison avec une baseline d'optimisation L-BFGS-B.
• Résultats :
  • Erreur d'extrémité : 0 % pour la méthode proposée (contre ~1,2 % pour l'optimisation).
  • Écart de forme : La variante de recherche linéaire a surpassé la baseline d'optimisation (par exemple, 1,25 % contre 1,74 % pour les courbes en C).
  • Efficacité : La variante avec clustering a réduit le temps de calcul d'un ordre de grandeur (par exemple, ~1,8 s contre ~40 s) avec une perte minime de précision de forme.

B. Simulation MuJoCo (Modèle à corps pseudo-rigide)

• Configuration : Utilisation d'un modèle PRB identifié système avec 30 maillons rigides et des articulations élastiques pour simuler une déformation réaliste et un couplage de segments.
• Résultats : Erreur d'extrémité de 0 %. L'écart de forme était légèrement plus élevé (~2,5–3,2 %) en raison de la complexité du modèle, mais est resté compétitif, démontrant l'évolutivité vers des modèles directs complexes.

C. Démonstration matérielle

• Configuration : Un CR à entraînement par câbles à 3 segments monté sur un manipulateur Franka 7-DOF.
• Résultats : Le robot a exécuté avec succès des mouvements FTL coordonnés.
  • Erreur d'extrémité : Les erreurs matérielles observées (moyenne de 5,5 %–9,1 %) ont été attribuées à l'écart entre le modèle identifié système et la réalité physique (étirement des câbles, frottement, hystérésis) plutôt qu'à un échec du planificateur.
  • Validation : Les résultats matériels ont confirmé que le planificateur génère des trajectoires lisses et exécutables qui réalisent un mouvement FTL qualitativement correct.

5. Importance et revendications

L'article revendique présenter la première méthode de planification de mouvement FTL pour les robots continus avec une base entièrement actionnée $SE(3)$ fournissant des garanties formelles de planification.

• Découplage : La contribution principale est le découplage de la recherche de forme et de la détermination de la pose de base. En résolvant la pose de base géométriquement, la méthode évite les minima locaux et les goulots d'étranglement computationnels de l'optimisation itérative dans les espaces de haute dimension.
• Agnosticisme du modèle : Le cadre prend en charge tout modèle direct (PCC, Cosserat, FEM, réseaux de neurones) en déplaçant les calculs lourds hors ligne.
• Praticité : Il comble le fossé entre la planification théorique et le déploiement pratique sur des systèmes montés sur manipulateurs, offrant un compromis raisonné entre vitesse (via le clustering) et précision.
• Sécurité et prévisibilité : Les garanties théoriques (exhaustivité de résolution et suivi exact de l'extrémité) répondent aux exigences critiques de sécurité où un comportement imprévisible du planificateur est inacceptable.

Les auteurs notent des limitations, notamment l'hypothèse d'un modèle direct indépendant de la pose de base (ignorant les effets de gravité) et l'absence d'optimisation de forme à l'échelle de la trajectoire, suggérant ces aspects comme des pistes pour des travaux futurs.