ADJUSTABLE TOOL SUPPORTING DEVICE FOR A ROBOT

Abstract: 1. Adaptable toolholder which can be used in remote manipulation or robotics, of the type comprising a first initial toolholder (P) capable of moving in space according to three degres of freedom, to control the desired positioning of the tool (T) in relation to its work point (O), this first initial toolholder itself supporting a second terminal toolholder comprising, on the one hand, a first support (S1) carrying a first shaft, the geometrical axis (OA) of which is inclined relative to one of the axes (OZ0 ) of a reference system, the origin of which is the work point and is secant with this axis at this work point (O), first rotary means (R1) being provided to make it possible to rotate this first shaft about the said axis (OZ0 ) of the reference system, and, on the other hand, a second support (S2) carried by the first shaft and carrying a second shaft, the geometrical axis (OB) of which is inclined relative to the geometrical axis (OA) of the said first shaft and is secant with this axis likewise at the said workpoint (O), second rotary means (R2) being provided to make it possible to rotate the second shaft about the axis (OA) of the first, the said second support (S2) carrying a third support (S3) carrying a third shaft, on which the tool is mounted, third rotary means (R3) being provided to make it possible to rotate the said third support (S3) about the axis (OB) of the second, characterized in that the active part (T) of the tool is offset relative to the geometrical axis (OB) of the said second shaft.

Description: Porte-organe adaptatif utilisable en télémanipulation ou robotique et procédé d'adaptation de la position d'un organe. La présente invention est généralement relative aux porte-organe utilisables en télémanipulation ou robotique, que ces organes soient indifféremment des organes accomplissant à un certain instant et en un certain point une certaine opération, tels des outils de travail comme des torches de soudage, ou des organes de détection ou de mesure, et est plus précisément relative à ce type de porte-organe dans lesquels les deux opérations, d'une part de mise en position de organe par rapport à son point de travail selon un système de coordonnées de référence à trois degrés de liberté, et d'autre part, d'orientation de l'organe par rapport à ce point de travail, sont commandées par deux dispositifs distincts permettant de découpler ces deux opérations. Selon une réalisation antérieurement connue d'un porte-organe de ce genre, un premier porte-organe initial est susceptible de se mouvoir dans l'espace selon trois degrés de liberté pour commander la mise en position désirée de l'organe par rapport à son point de travail, et ce dispositif porte-organe initial supporte lui-même un second porte-organe terminal comprenant, d'une part, un premier support portant un premier arbre dont l'axe géométrique est incliné par rapport à l'un des axes d'un système de référence dont l'origine est le point de travail et sécant avec cet axe en ce point de travail, des premiers moyens rotatifs étant prévus pour pouvoir faire tourner ce premier arbre autour dudit axe du système de référence et, d'autre part, un second support porté par le premier arbre portant un second arbre dont l'axe géomé trique est confondu avec l'axe géométrique de l'organe et incliné par rapport à l'axe géométrique dudit premier arbre en étant sécant avec cet axe également audit point de travail, des seconds moyens rotatifs étant prévus pour pouvoir faire tourner ce second arbre autour de l'axe du premier, l'action combinée desdits premier et second moyens de rotation permettant d'obtenir l'orientation angulaire désirée de l'axe d'organe terminal par rapport au point de travail. Il serait par ailleurs intéressant d'associer des porte-organe de ce genre à des moyens de détection de la position relative de l'organe par rapport au point de travail, et à des moyens de commande automatique de séquences d'opérations de l'organe selon des logiciels correspondant à des programmes opérationnels et contrôlés par les informations fournies par les moyens de détection de position. La présente invention a pour but de perfectionner ce genre de porte-organe pour que le second porte-organe terminal permette de commander non seulement l'orientation angulaire de l'organe terminal par rapport au point de travail, mais également en outre une adaptation fine et précise de la position de l'organe terminal par rapport à son point de travail sans qu'il z il soit nécessaire d'avoir à actionner alors le porte-organe initial. Comme les masses mises en mouvement du porte-organe initial sont plus importantes que pour le porte-organe terminal, plus léger par construction même, on comprend que l'objectif de l'invention vise à doter les porte-organe du genre précité de performances améliorées en ce sens que l'adaptation en temps réel de la position et de l'orientation de l'organe par rapport à son point de travail, en fonction de l'opération à effectuer et des conditions réelles dans lesquelles cette opération est effectuée, est obtenue avec un temps de réponse minimal et une précision maximale. Le document JP-A-55 097 831 concerne un dispositif de soudage automatique qui permet le soudage horizontal de toutes les faces intérieures et extérieures d'une pièce par une inclinaison convenable de l'extrémité de l'un des trois bras d'un porte-torche. L'appareil comporte un premier porte-organe initial susceptible de se mouvoir dans l'espace selon trois degrés de liberté et en outre un bras 9b entrat- né en rotation par un moteur 9a, un bras 9d entraîné en rotation par un moteur 9c et un bras 9f entraîné en rotation par un moteur 9e. Toutefois, l'axe de la partie utile de la torche de soudage 10 n'est pas décalé par rapport à l'axe de rotation du moteur 9a. En effet, on observe que la torche de soudage 10 est coudée. Cette forme a été rendue nécessaire par la forme de la pièce à réaliser, qui présente une section en forme de U. On comprend que pour réaliser un cordon de soudure à l'intérieur de cette pièce, comme c'est le cas sur les figures 3, 4 et 5, la seule possibilité est d'introduire l'organe par la partie ouverte de la section en U. L'orientation générale de l'organe de soudage est ainsi déterminée par l'orientation de l'axe du U. Ainsi, cette orientation est horizontale sur les figures 3 et 5 et verticale sur la figure 4. En revanche, l'orientation de la partie active de la torche est déterminée par les conditions de soudage. Cette partie active doit être dirigée vers le cordon de soudure à réaliser. C'est ainsi que l'on a été conduit à utiliser l'organe coudé. Pour que cet organe puisse être convenablement orienté par rapport au cordon de soudure, on a été conduit à munir le porte-organe d'un bras 9f qui permet de ramener la torche de soudage dans une position telle que l'axe de sa partie active soit dirigé vers le point de travail, c'est-à-dire le point d'intersection des axes de rotation des bras 9b et 9d. Au contraire, le porte-organe de l'invention réalise une adaptation de position et non pas une adaptation d'orientation. Dans l'invention, l'axe de l'organe de soudage est décalé par rapport à l'axe géométrique OB du second arbre. Lorsqu'on fait subir une rotation de faible amplitude au troisième support, ou trois rotations combinées aux trois supports, on fait varier la position du point de travail de façon quasiment linéaire. On obtient une quasi translation transversale au joint dans le premier cas, une translation de direction quelconque dans le deuxième cas. Ainsi, on superpose à l'adaptation de position donnée par le premier porte-organe un déplacement de faible amplitude de la position de l'organe terminal pour réaliser une adaptation fine et précise de position ou pour générer un mouvement de balayage, par exemple. Etant donné que cette rotation présente une faible amplitude, l'orientation de l'organe de soudage varie de manière négligeable. Grâce à cette caractéristique, il est possible de faire varier la position de l'organe de soudage, pour de petits déplacements, sans qu'il soit nécessaire de commander le premier porte-organe. Ceci permet un réglage fin de sa position de manière beaucoup plus souple. L'invention a donc pour objet un porte-organe comportant un premier porte-organe initial susceptible de se mouvoir dans l'espace selon trois degrés de liberté pour commander la mise en position désirée de l'organe par rapport à son point de travail, ce premier porte-organe initial supportant lui-même un second porte-organe terminal comprenant, d'une part, un premier support portant un premier arbre dont l'axe géométrique est incliné par rapport à l'un des axes d'un système de référence dont l'origine est le point de travail, et sécant avec cet axe en ce point de travail, des premiers moyens rotatifs étant prévus pour pouvoir faire tourner ce premier arbre autour dudit axe du système de référence et, d'autre part, un second support porté par le premier arbre portant un second arbre dont l'axe géométrique est incliné par rapport à l'axe géométrique dudit premier arbre en étant sécant avec cet axe également audit point de travail, des seconds moyens rotatifs étant prévus pour pouvoir faire tourner ce second arbre autour de l'axe du premier. Le second support porte un troisième support portant un troisième arbre sur lequel est monté l'organe. Des troisièmes moyens rotatifs sont prévus pour pouvoir faire tourner ledit troisième arbre autour de l'axe du second. La partie active de l'organe est décalée par rapport à l'axe géométrique dudit second arbre. Lorsque l'on actionne de façon combinée les premiers, seconds et troisièmes moyens rotatifs avec de faibles angles de rotation, on obtient une quasi translation de la partie active de l'organe selon une direction parallèle à l'un des axes de référence du plan perpendiculaire au premier axe précité et passant par le point de travail. Lorsque l'on actionne seulement les troisièmes moyens rotatifs avec de faibles angles de rotation, on obtient une quasi translation de la partie active de l'organe selon une direction parallèle à l'autre axe de référence, perpendiculaire au premier, du plan précité. Ainsi, on peut obtenir, avec de faibles rotations seules ou combinées, des premiers, seconds et troisièmes moyens rotatifs, une adaptation fine et précise selon deux degrés de liberté de la partie active de l'organe par rapport à son point de travail. Par ailleurs, l'invention concerne un procédé d'adaptation fine et précise de la position d'un organe par rapport à son point de travail, ledit organe étant porté par un porte-organe adaptatif caractérisé en ce qu'on fait subit au porte-organe T une combinaison de rotations des trois moyens-rotatifs R1, R2, R3 aboutissant à un déplacement de faible amplitude de l'organe T. Ceci permet de superposer au positionnement du porte organe initial, un déplacement de faible amplitude de la position de l'organe terminal pour réaliser une adaptation fine et précise de sa position ou pour générer un mouvement de balayage, tout en détériorant de manière négligeable le réglage de l'orientation. La position de l'organe peut ainsi être modifiée de manière beaucoup plus souple qu'en commandant le porte organe initial. Ces résultats, obtenus par la mise en oeuvre de l'invention, seront mieux appréciés au cours de la description ci-après des principes et d'un mode de mise en oeuvre de l'invention. Cette description sera faite en référence au dessin annexé, sur lequel - la figure 1 est un schéma géométrique rappelant l'art antérieur de la technique que la présente invention perfectionne, - la figure 2 est le schéma géométrique d'un porte-organe perfectionné selon l'invention utilisable en télémanipulation ou robotique, - la figure 3 est une vue en perspective d'un mode de réalisation d'un porte-organe terminal selon l'invention, et - les figures 4 et 5 illustrent l'utilisation de ce porte-organe terminal en association avec deux types différents de porte-organe initiaux. On se reportera d'abord au schéma géométrique de la figure 1 représentant l'art antérieur. Ce schéma correspond à un porte-organe comprenant un premier porte-organe initial, schématisé par le point P, susceptible d'être mis en une position quelconque de l'espace dans un système de coordonnées à trois degrés de liberté x0, y0, z0. Le point de travail O est le point origine de ce système de coordonnées. Ce premier porte-organe initial supporte lui-même un second porte-organe terminal comprenant un premier support, schématisé par un bras S1, portant un premier arbre dont l'axe géométrique OA est incliné par rapport à l'axe Oz0 du système de référence lié au point de travail O. Des premiers moyens rotatifs R1, constitués d'un moteur électrique par exemple, permettent de faire tourner l'axe OA autour de l'axe Oz0 selon des angles el. Le premier support S1 supporte à son tour un second support, schématisé par un bras S2, portant un second arbre dont l'axe géométrique OB est incliné par rapport à l'axe OA et des seconds moyens rotatifs R2 permettent de faire tourner l'axe OB autour de l'axe OA selon des angles 92. L'axe géométrique OB est confondu avec l'axe de l'organe, par exemple une torche de soudage, dont l'extrémité active est représentée en T à proximité du point de travail O. On conçoit que, en actionnant le porte-organe initial P, on peut mettre en position l'extrémité T de l'organe à proximité du point de travail O choisi par rapport au système de références x0, y0, z0. Ensuite, en agissant de façon combinée appropriée sur les moyens rotatifs R1 et R2, et donc en combinant des rotations el et 92, on peut orienter au choix l'axe OB par rapport au plan x0, Oy0. Il y a bien découplage à l'aide des deux dispositifs porte-organe, des fonctions de mise en position, d'une part, et orientation d'autre part, de l'organe T par rapport à son point de travail. Mais, lorsqu'il y a lieu d'affiner la position de l'organe T par rapport au point de travail O, on doit le faire par action sur le porte-organe initial de construction plus lourde et de maniement plus lent que dans le cas du porte-organe terminal. On se reportera maintenant au schéma géométrique de la figure 2 d'un porte-organe perfectionné selon l'invention. Les mêmes repères de référence que ceux utilisés pour la figure 1 correspondent à des éléments identiques. Selon l'invention, le support S2 supporte lui-même un troisième support S3 comportant un troisième arbre sur lequel est monté l'organe terminal de manière que l'extrémité active T de cet organe est en position décalée par rapport à l'axe OB du deuxième arbre. Des troisièmes moyens rotatifs R3 sont prévus pour pouvoir faire tourner le support S3 autour de l'axe OB selon des angles 83. Le porte-organe décrit ci-dessus dans son principe, fonctionne en trois temps. Dans un premier temps, le porte-organe initial, par déplacement du point P par rapport au système de référence x0, y0, z0, permet de conduire la partie active T de l'organe à proximité du point de travail O. Dans un second temps, des rotations il, 82 et 93 permettent de régler l'orientation de l'outil TT' par rapport au point de travail O. Sur la figure 2, on a schématisé, à titre d'exemple, un joint J de soudure à effectuer à l'aide de l'extrémité T d'une torche de soudage positionnée à proximité du point de travail ou soudure O. On suppose que, après les premier et second temps de mise en oeuvre, la torche TT' est approximativement en bonne position par rapport au point de soudure O, et en bonne orientation dans le plan et que, en raison par exemple d'irrégularité du joint J ou de déformations thermiques des tôles en cours de soudage, tous évènements aléatoires détectés par un détecteur non représenté, il y ait lieu d'adapter finement la position de la partie active T de la torche par rapport au point de soudure O, selon deux degrés de liberté, à savoir transversalement par rapport au joint J et en hauteur par rapport à ce joint. Dans ce cas, une faible rotation 93 du support S3 permettra d'obtenir une quasi translation de T parallèlement au plan ZJOxj, c'est-à-dire transversalement au joint. De 33 meme, une faible rotation combinée el, 02, et e3 permettra de maintenir T dans le plan zjOy; tout en modifiant très légèrement l'orientation de TT' dans ce plan, ce qui équivaut à une quasi translation de la partie active T parallèlement à l'axe TT' et donc à une légère adaptation en hauteur de l'organe T par rapport au point de soudure O. La figure 3 représente en perspective un porte-organe terminal selon l'invention. Les mêmes repères que sur les schémas des figures 1 et 2 correspondent à des éléments identiques. On retrouve le support P, monté sur un porte-organe initial. Un moteur Rl, dont l'axe traverse un second moteur R2, fait tourner le premier support S1. L'axe OA est incliné par rapport à Oz0 et sécant avec cet axe au point O. Quand le support S1 tourne, OA décrit un cône de sommet O et d'axe Oz0. Le support S1 porte à son tour un second support S2. Le moteur R2, par l'intermédiaire de roues dentées D1 et D2, peut faire tourner le support 82 autour de l'axe OA de sorte que l'axe OB du support Si décrit un cône de sommet O et d'axe OA. Le support S2 porte enfin un support 83 sur lequel est montée la torche de soudure TT' de sorte que la partie active T de cette torche est décalée par rapport à l'axe géométrique OB du troisième support S3. Un moteur R3 permet de faire tourner T autour de l'axe OB. La figure 4 montre l'association d'un porteorgane terminal, tel que celui de la figure 3, en association avec un porte-organe initial classique du type cartésien à trois degrés de liberté X, Y et Z. La figure 5 montre l'association du porteorgane terminal avec un porte-organe initial classique du type polyarticulé. Ce porte-organe possède trois degrés de liberté actifs par les rotations a, ss et y qui en font l'équivalent d'un porteur cartésien, et un degré de liberté passif par rotation T pour maintenir vertical le porteur terminal P. Cette description se terminera par quelques commentaires sur l'utilisation des moyens décrits cidessus en association, nécessaire en pratique sinon en théorie, avec des moyens de commande automatique de séquences d'opérations de l'organe. L'ensemble des moyens décrits ci-dessus amène à considérer, pour sa mise en oeuvre, trois repères qui sont les suivants - un repère Ro de base, qui est lié au porte-organe initial et permet de prendre en compte les coordon nées x0, y0 et z0 du point P - un repère Ri, lié à la trajectoire que doit suivre j l'organe pour effectuer séquentiellement ses opéra tions ; par exemple ce repère Rj, lié au joint de soudure J et défini par le plan longitudinal (ZjOyj), transversal (zjOxj), et tangent (xjOyj) au j j joint J, est un repère cartésien (Xj, Yj, z;, 0) ; et - un repère Rt, lié à la torche (ou à tout autre ou til) ; ce repère R t aura pour origine le point T, extrémité active de la torche, et pour axes l'axe Tz t confondu avec l'axe de l'outil, et les axes Txt et Tyt complètant le trièdre cartésien (Txt, Tyt, Tzt, T). Les relations entre ces différents repères sont les suivantes - les repères R t et R. sont liés par des conditions 3 prédéterminées du processus opérationnel mis en oeu vre définissant la position et l'orientation de l'organe par rapport à sonpoint de travail, par exemple de la torche de soudure par rapport au joint. On a donc une première relation de la forme Rt=Fp(Rj),Fp indiquant qu'il s'agit d'une fonction définie selon un procédé - les repères Rt et Ro sont liés par une fonction d'apprentissage Fa selon une relation de la forme Rt=Fa(R0) La trajectoire généralisée modèle de l'organe en position et orientation (X, Y, Z) figure 4, ou (a, B, y, ) figure 5 et el, 92, e3 dans le repère Ro sera définie par le calcul à partir des relations F et Fa liées au procédé et à l'apprentis p sage. Par rapport à cette trajectoire modèle, on effectuera des corrections à partir d'informations provenant d'un détecteur de point de travail. Conformément à l'une des caractéristiques propres de l'in vention, ces corrections ne s'exerceront pas sur le porte-organe initial, mais seulement sur le porte-organe terminal. Ces corrections ne concernant par exemple que deux degrés de liberté, porteront sur Y et Z et seront obtenues, par le calcul, par des variations faibles til, Ae2 et Ai3 des angles el, 62 et 93. Bien que l'on ait décrit ci-dessus des modes particuliers de réalisation de l'invention, par référence aux figures 3 à 5, on précise que l'invention s'étend à toutes les réalisations mettant en oeuvre le principe géométrique et cinématique faisant l'objet de la figure 2.

Claims: REVENDICATIONS 1. Porte-organe adaptatif utilisable en télémanipulation ou robotique, du genre comportant un premier porte-organe initial (P) susceptible de se mouvoir dans l'espace selon trois degrés de liberté pour commander la mise en position désirée de l'organe (T) par rapport à son point de travail (O), ce premier porte-organe initial supportant lui-même un second porte-organe terminal comprenant, d'une part, un premier support (S1) portant un premier arbre dont l'axe géométrique (OA) est incliné par rapport à l'un des axes (Oz0) d'un système de référence dont l'origine est le point de travail et sécant avec cet axe en ce point de travail (O), des premiers moyens rotatifs (R1) étant prévus pour pouvoir faire tourner ce premier arbre autour dudit axe (Oz0) du système de référence et, d'autre part, un second support (S2) porté par le premier arbre portant unsecond arbre dont l'axe géométrique (OB) est incliné par rapport à l'axe géométrique (OA) dudit premier arbre en étant sécant avec cet axe également audit point de travail (O), des seconds moyens rotatifs (R2) étant prévus pour pouvoir faire tourner ce second arbre autour de l'axe (OA) du premier, ledit second support (S2) portant un troisième support (S3) portant un troisième arbre sur lequel est monté l'organe de troisièmes moyens rotatifs (R3) étant prévus pour pouvoir faire tourner ledit troisième support (S3) autour de l'axe (OB) du second, caractérisé en ce que la partie active (T) de l'organe est décalée par rapport à 1 l'axe géométrique (OB) dudit second arbre. 2. Procédé d'adaptation fine et précise de la position d'un organe (T) par rapport à son point de travail, ledit organe étant-porté par un porte-organe adaptatif selon la revendication 1, caractérisé en ce qu'on fait subir au porte-organe (T) une combinaison de rotations des trois moyens rotatifs (R1, R2, R3) aboutissant à un déplacement de faible amplitude de l'organe (T).

Inventors: DETRICHE, JEAN-MARIE, FRAIZE, GERARD, ROUGET, JEAN-PAUL, Fraize, Gérard
Applicants: COMMISSARIAT A L'ENERGIE ATOMIQUE ETABLISSEMENT DE CARACTERE SCIENTIFIQUE TECHNIQUE ET INDUSTRIEL
Application year: 1983
Main classification: B25J17
IPC codes: B23K9, B25J18, B25J9, B25J17