Brevet FR3026856A1 — publié le 20160408

L'invention est relative à un procédé de commande d'un segment de bras robotisé permettant d'en adapter la raideur apparente. ARRIERE-PLAN TECHNOLOGIQUE DE L'INVENTION La manipulation robotique a évolué depuis la mani- pulation en espace libre (applications de soudure, de levage et positionnement.") à la réalisation de tâches au contact (brossage, insertion, télé-manipulation avec retour d'effort). Ainsi, plutôt que d'un pur asservissement en posi- tion, qui nécessite une connaissance précise de la position de destination et de la trajectoire, le besoin a évolué vers un asservissement plus souple permettant au bras manipulateur de composer avec une connaissance im- parfaite de la position de destination. L'exemple classique est la tâche d'insertion d'une pièce dans un orifice au moyen d'un bras manipulateur. Avec un asservissement en position, il serait nécessaire de disposer d'une connaissance précise de la position de l'orifice pour espérer faire entrer la pièce dans l'orifice. Pour pallier à cet inconvénient, il est connu de mettre en oeuvre un asservissement en impédance ou en rai- deur, conférant au bras manipulateur un comportement du type à grande raideur dans la direction d'insertion de la pièce, et un comportement du type à faible raideur dans les directions transverses, permettant au bras manipulateur de réaliser la tâche d'insertion malgré une connaissance imprécise de la position de l'orifice. Ce type de commande est relativement aisé à mettre en oeuvre si le robot est considéré comme rigide structu- rellement et que le contrôleur met en oeuvre un correcteur de type proportionnel dérivé, en position, proportionnel intégral en vitesse, ou proportionnel intégral dérivé en effort. En effet, des expressions mathématiques exactes existent entre la raideur souhaitée, les paramètres du modèle du robot, ainsi que ceux du contrôleur, que celui-ci assure ou non la passivité du robot, qui permettent la mise en oeuvre d'un calcul analytique. Dès lors que l'hypothèse de rigidité du robot n'est plus recevable, ou que l'on voudrait mettre en oeuvre d'autres types de con- trôleurs, un tel calcul analytique n'est plus possible. OBJET DE L'INVENTION L'invention a pour objet de proposer un procédé de commande permettant d'adapter la raideur du bras manipu- lateur à la tâche demandée, sans que celui-ci doive être considéré comme rigide, et pouvant s'adapter à des formes de contrôles variées, non nécessairement réduites à des PID. PRESENTATION DE L'INVENTION Modifier la raideur apparente du segment revient à modifier la forme de la fonction de transfert G(s)=(1F entre une vitesse g (linéaire ou angulaire) du segment et une force externe F subie par le segment de sorte qu'elle soit la plus proche possible d'une fonction de transfert idéale d'un objet de masse (ou d'inertie) M reliée à un bâti par un ressort de raideur K (linéaire ou angulaire), subissant éventuellement un amortissement de taux C. On sait qu'une telle fonction de transfert idéale est de la forme Ms2 + cs + K où s la variable de Laplace. Pour la suite, on note SF(s) la fonction de sensibilité du système segment -I- contrôleur évaluée au niveau de l'effort subi : S(s) = G(s) - J - s où J est la masse (ou l'inertie) du segment à contrôler, à l'exclusion de l'inertie du moteur à contrôler et de tout autre élément intermédiaire, s'ils sont dissociables. On rappelle que la fonction de sensibilité mesure la sensibilité d'une boucle d'asservissement à une perturbation venant s'additionner à un signal donné. En vue de la réalisation de ce but, on propose se- lon l'invention un procédé de commande d'un actionneur d'un segment articulé comportant les étapes de : Estimer une inertie J du segment ; Estimer ou mesurer une vitesse de déplacement i du segment; Synthétiser une loi de commande de type Ho, générant un couple de commande du segment à partir de ces estimations ou mesures et répondant à un objectif de performance portant la fonction de sensibilité en effort : IISF(s) W5(s)11,x, 1 avec W5(s) = j,s2-1-e ) JeK K étant une raideur souhaitée, et c un amortissement souhaité, s étant un artefact mathématique ; Commander l'actionneur du segment articulé selon la loi de commande ainsi synthétisée. Selon un aspect particulier de l'invention, la syn- thèse de la commande est effectuée sous au moins l'une des contraintes suivantes : -1 une contrainte portant sur la sensibilité en position ou en vitesse du système segment + contrôleur évaluée, soit : 11Sx(s) W(s)II c0 5_ 1 ou IlSg(s) Ws(s)Ilw 1 une contrainte portant sur le courant d'alimentation (ou couple de commande) du moteur qui ne doit pas dépasser un seuil donné pour tous les efforts admissibles ; une contrainte portant sur les positions des pôles de la loi de commande qui doivent être tous situés en deçà d'une fréquence seuil inférieure à la fréquence de Nyquist ; une contrainte portant sur les positions des pôles de la loi de commande qui doivent avoir un amortissement minimal une contrainte de passivité selon laquelle la fonction de transfert Force/vitesse doit être réelle positive. BREVE DESCRIPTION DES DESSINS L'invention sera mieux comprise à la lumière de la description qui suit d'un mode particulier non limitatif de mise en oeuvre de l'invention, aux références aux figures des dessins annexés parmi lesquels : La figure 1 est une vue schématique d'un seg- ment de bras de comanipulateur actionné au moyen d'un ac- tionneur à câble ; La figure 2 est un graphique montrant le diagramme de Bode du segment et la fonction de seuil ; La figure 3 est un schéma bloc de l'asservissement mis en oeuvre au moyen de l'invention ; DESCRIPTION DETAILLEE D'UN MODE DE MISE EN OEUVRE DE L'INVENTION En référence aux figures, l'invention est ici appliquée à la commande d'un segment articulé d'un bras de robot utilisable en comanipulation. Le robot comporte un actionneur 1 déplaçant un câble 2 enroulée autour d'une poulie de renvoi 3 et d'une poulie articulaire 4 menant un segment 5 articulé selon un axe d'articulation 6. L'actionneur comporte ici un moteur 7 associé à un réducteur 8 qui entraîne l'écrou d'une transmission à billes 9 dont la vis creuse est attelée au câble 2 qui passe à l'intérieur de la vis. Selon l'invention, on commence par estimer l'inertie J du segment articulé 5 autour de l'axe d'articulation 6. Différentes méthodes sont connues pour estimer une telle inertie. On peut par exemple, à partir de la définition du segment, rapporter les inerties propres de tous les éléments composant le segment à une inertie autour de l'axe d'articulation 6 et sommer toutes ces inerties. Le procédé de l'invention comporte l'étape de syn- thétiser une loi de commande de l'actionneur 1 telle que le segment articulé 5 se comporte comme si le segment possédait une raideur K choisie et subissait un amortissement c. Cet amortissement peut se déduire d'un taux d'amortissement parc . Pour cela, on mesure la fonction de transfert G(s)/F, où ).( est la vitesse du segment articulé 5, et F est l'effort externe agissant sur le segment articulé 5 (par exemple, le poids d'une charge que le segment soulève). La variable s est la variable de Laplace. En utilisant les outils classiques de la synthèse Hco, on détermine une loi de commande dont les entrées sont la vitesse g et la sortie est un couple de commande, ici représenté par un courant (ou couple) de commande I, comme cela est schématisé à la figure 3. La synthèse ré- pond l'objectif suivant : IISF(s) Ws(s)Ilco 5_ 1 , dans lequel le is2+E - seuil est Ws(s) = K étant la raideur souhaitée, js-+cs+K et c l'amortissement souhaité, e étant un artefact mathématique destiné à éviter des gains infinis en basse fréquence. Dans cet objectif, S(s) est la fonction de sensibilité du système segment + contrôleur évaluée au niveau de l'effort subi : SF(s)=G(s)-J-s, où J est la masse (ou l'inertie) du segment. G(s) est la fonction de transfert G(s)=i/F entre la vitesse g (linéaire ou angulaire) du segment et une force externe F subie par le segment. C'est-à-dire que l'on impose que la caractéristique dans un diagramme de Bode de la fonction de transfert SF(s) soit en dessous de la caractéristique de la fonction seuil WsW. Puis une fois la loi de commande synthétisée comme il vient d'être dit, on utilise cette loi de commande pour commander l'actionneur. Par ailleurs, et selon un aspect particulier de l'invention, on impose au moins l'une des contraintes suivantes : une contrainte portant le courant d'alimentation (ou couple de commande) du moteur qui ne doit pas dépasser un seuil donné pour tous les efforts admissibles. Cette contrainte est remplie en imposant que 1//F103 Dans les exemples décrits ci-dessous, la raideur K est fixée à une valeur déterminée. Il peut cependant être utile de faire varier la raideur dans le temps. Pour ce faire, et selon une variante de l'invention, on fait explicitement intervenir cette raideur K comme un paramètre exogène variable à la fois dans la fonction de sensibilité et dans la fonction seuil dans l'objectif de perfor- mance : IISF(K,$) 1. Dans cette formulation du problème à résoudre, K est maintenant considéré comme variable. Pour résoudre ce problème pour tout Kmin K Kmax, il suffit de résoudre simultanément les problèmes : IISF(K )1./V.,(K _rn,n, _s , , max, I oc, 5_ 1 et Ws(Kinin, 1 L'invention n'est pas limitée à ce qui vient d'être décrit, mais englobe au contraire toute variante entrant dans le cadre défini par les revendications. En particulier, les caractéristiques inertielles (position, vitesse accélération) du segment de bras peuvent concerner aussi bien des déplacements linéaires que des déplacements an- gulaires. REVENDICATIONS1. Procédé de commande d'un actionneur (1) d'un segment (5) articulé comportant les étapes de : Estimer une inertie J du segment ; Estimer ou mesurer une vitesse de déplacement g du segment; Synthétiser une loi de commande de type 1-40 gé- nérant un couple de commande du segment à partir de ces estimations ou mesures et répondant à un objectif de per- formance portant la fonction de sensibilité en effort : r 2 IISF(S) W5(s)1(>D 5.. 1 avec Vils(s) = j7s +e jel-cs+K K étant une raideur souhaitée, et c un amortissement souhaité, E un artefact mathématique, SF(s)=G(s)-Ps, où G(s) est la fonction de transfert G(s)/F entre la vitesse f( (linéaire ou angulaire) du segment et une force externe F subie par le segment ; Commander l'actionneur du segment articulé selon la loi de commande ainsi synthétisée. 2. Procédé de commande selon la revendication 1, dans lequel, la synthèse de la commande est effectuée sous au moins l'une des contraintes suivantes : une contrainte portant le courant d'alimentation (ou couple de commande) du moteur qui ne doit pas dépasser un seuil donné pour tous les efforts admissibles. Cette contrainte est remplie en imposant que I//Flm 3. Procédé selon la revendication 1, dans lequel dans la synthèse de la loi de commande, on fait explicitement intervenir la raideur K comme un paramètre exogène variable à la fois dans la fonction de sensibilité et dans la fonction seuil dans l'objectif de performance : s) Ws(K , s)11,, .5_ 1 4. Procédé selon la revendication 3, dans lequel pour résoudre le problème pour tout Kmin K Kmax , on résout simultanément les problèmes : IISF(K s. ) 1/14( 'Kmax, S)II«) 1 et liSF(Kmin, Ws(Kmin, s)ilo, 5 1