FR2582245A1 - Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l'apprentissage de trajectoire dans l'espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules - Google Patents

Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l'apprentissage de trajectoire dans l'espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules Download PDF

Info

Publication number
FR2582245A1
FR2582245A1 FR8508011A FR8508011A FR2582245A1 FR 2582245 A1 FR2582245 A1 FR 2582245A1 FR 8508011 A FR8508011 A FR 8508011A FR 8508011 A FR8508011 A FR 8508011A FR 2582245 A1 FR2582245 A1 FR 2582245A1
Authority
FR
France
Prior art keywords
sep
handle
freedom
degrees
reference position
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
FR8508011A
Other languages
English (en)
Inventor
Jean Pontnau
Francis Artigue
Remy Manuel
Christian Francois
Habid Balde
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Centre dEtude et de Recherche pour lAutomobile CERA
Original Assignee
Centre dEtude et de Recherche pour lAutomobile CERA
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Centre dEtude et de Recherche pour lAutomobile CERA filed Critical Centre dEtude et de Recherche pour lAutomobile CERA
Priority to FR8508011A priority Critical patent/FR2582245A1/fr
Publication of FR2582245A1 publication Critical patent/FR2582245A1/fr
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/02Hand grip control means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • G05B19/427Teaching successive positions by tracking the position of a joystick or handle to control the positioning servo of the tool head, master-slave control
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05GCONTROL DEVICES OR SYSTEMS INSOFAR AS CHARACTERISED BY MECHANICAL FEATURES ONLY
    • G05G9/00Manually-actuated control mechanisms provided with one single controlling member co-operating with two or more controlled members, e.g. selectively, simultaneously
    • G05G9/02Manually-actuated control mechanisms provided with one single controlling member co-operating with two or more controlled members, e.g. selectively, simultaneously the controlling member being movable in different independent ways, movement in each individual way actuating one controlled member only
    • G05G9/04Manually-actuated control mechanisms provided with one single controlling member co-operating with two or more controlled members, e.g. selectively, simultaneously the controlling member being movable in different independent ways, movement in each individual way actuating one controlled member only in which movement in two or more ways can occur simultaneously
    • G05G9/047Manually-actuated control mechanisms provided with one single controlling member co-operating with two or more controlled members, e.g. selectively, simultaneously the controlling member being movable in different independent ways, movement in each individual way actuating one controlled member only in which movement in two or more ways can occur simultaneously the controlling member being movable by hand about orthogonal axes, e.g. joysticks
    • G05G9/04737Manually-actuated control mechanisms provided with one single controlling member co-operating with two or more controlled members, e.g. selectively, simultaneously the controlling member being movable in different independent ways, movement in each individual way actuating one controlled member only in which movement in two or more ways can occur simultaneously the controlling member being movable by hand about orthogonal axes, e.g. joysticks with six degrees of freedom
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/35Nc in input of data, input till input file format
    • G05B2219/35438Joystick

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

AUXILIAIRE DE COMMANDE A SIX DEGRES DE LIBERTE POUR L'APPRENTISSAGE EN TRAJECTOIRE DES ROBOTS MANIPULATEURS ET DES ENSEMBLES MECANIQUES POLYARTICULES. L'INVENTION CONCERNE UN DISPOSITIF A SIX DEGRES DE LIBERTE AVEC RAPPEL AUTOMATIQUE EN POSITION DE REFERENCE ET ELABORATION D'UNE COMMANDE EN VITESSE A PARTIR DE CAPTEURS DE POSITION ANALOGIQUES, NUMERIQUES ET DE TYPE TOUT OU RIEN. IL EST CONSTITUE D'UNE BOULE, OU D'UNE POIGNEE ERGONOMIQUE MAINTENUE PAR SIX RESSORTS DE RAPPEL JUDICIEUSEMENT DISPOSES. LES INFORMATIONS NECESSAIRES A LA COMMANDE EN VITESSE SELON TROIS COORDONNEES ET TROIS ORIENTATIONS SONT FOURNIES PAR SIX CAPTEURS.

Description

La présente invention concerne un dispositif
d'apprentissage de la trajectoire en vue de la commande en
vitesse des robots manipulateurs et des systèmes mécaniques
polyarticulés comportant au maximum six liaisons rotoides ou
prismatiques.
Ce dispositif trouve un champ d'application dans les
domaines de la robotique et dans la commande manuelle assistée
d'ensembles mécaniques multi-liaisons (engins de travaux publics
par exemple).
Dans le domaine de la robotique, les dispositifs actuels se
présentent sous les formes suivantes
- une boite à boutons avec un nombre de touches égal au
nombre d' articulations ou de coordonnées à commander.
L'information de sortie est du type logique (tout ou rien) ce
qui ne permet pas une commande proportionnelle. En outre une
boite à boutons se prête mal à la commande simultanée de
plusieurs coordonnées.
- des manipulateurs de commande à trois degrés de liberté
associés soit à des interrupteurs pour une commande en tout ou rien, soit à des potentiomètres pour élaborer une commande
proportionnelle en position ou en vitesse. Or dans la plupart
des robots, l'organe effecteur doit être commandé en position et
en orientation, donc six coordonnées, ce qui implique
l'utilisation de deux manipulateurs à trois degrés de liberté.
Une telle configuration pose à l'opérateur un problème
complexe de coordination des mouvements puisqu'il doit commander
simultanément deux manipulateurs
L'auxiliaire de commande selon l'invention,se présente sous
forme d'une poignée ergonomique ou d'une boule décrivant dans un
volume donné tous les points de cet espace et toutes les
orientations , soit six degrés de liberté. Cette poignée est
ramenée en position de référence correspondant à une vitesse
nulle selon les six coordonnées généralisées ou opérationnelles
du robot par un rappel isoélastique. Ce rappel est conçu pour
donner à l'opérateur une sensation d'effort proportionnel à la
vitesse du déplacement effectué. On arrive à un tel résultat par
un maintien de la poignée par six liaisons élastiques
judicieusement disposées.Les mesures de position et
d'orientation de la poignée sont effectuées par six capteurs de
positions ou par des proximètres. Les informations issues de ces capteurs fournissent les trois coordonnées de position et les trois angles d'Euler d'orientation de la poignée. Ces six informations fournies à l'armoire de commande du robot permettent à l'opérateur de commander le robot en trajectoire d'apprentissage. Si cette commande s'effectue dans l'espace des coordonnées opérationnelles du robot, l'organe effecteur de celui-ci décrira une trajectoire controlée en vitesse et selon les coordonnées déterminées par la position et l'orientation de la poignée. Les vitesses de déplacement selon les différentes coordonnées sont directement proportionnelles aux amplitudes de déplacement de la poignée.Cette commande en vitesse maintient le robot dans la position atteinte lorsque l'opérateur laisse la poignée revenir automatiquement en position de référence. Si la commande s'effectue dans l'espace des coordonnées généralisées du robot, ou s'il s'agit de la commandede systèmes polyarticulés, il suffit d'attribuer à chaque articulation de liaison du système un degré de liberté de la poignée. Comme précédemment la commande s'effectuera avec des vitesses proportionnelles aux amplitudes de déplacement de la poignée avec arrêt dans la position atteinte lorsque la poignée revient en position de référence.
La disposition des ressorts de rappel qui développent un effort opposé à la direction du déplacement effectué par l'opérateur et d'amplitude proportionnelle à ce déplacement s'obtient à partir d'une modélisation d'un rappel isoélastique tridimensionnel qui est développé ci-après.
- Soit la poignée qui est maintenue par un ensemble de six liaisons élastiques (fig.l) La i ème liaison (fig.2) est accrochée au point M(i).Un déplacement quelconque de la poignée est défi-ni par le torseur (,) de composantes
Tx,Ty,Tz; Rx,Ry,Rz, dans le référentiel orthonormé Oxyz de vecteurs unitaires i,j,k.Ainsi la longueur de la i ème liaison est modifié de la quantité p(i) telle que:
Figure img00020001
<tb> p(i) <SEP> = <SEP> D(i).N(i)
<tb>
Figure img00020002
D(i),
<tb> est le vecteur déplacement du point M(i),soit
Figure img00020003
<tb> D(i) <SEP> = <SEP> T <SEP> + <SEP> R <SEP> OM(i)
<tb>
Figure img00020004
<tb> N(i)
<tb> est la normale à la surface au point M(i)
Si l'on désigne par k la constante d'élasticité des ressorts,le i ème ressort exerce une force d'amplitude f(i) dirigée selon N(i) telle que
f(i) = k p(i)
Le torseur général des efforts dus aux ressorts de rappel,comporte une force F et un moment M tel que:
Figure img00030001

-soit en projection sur les axes Ox,Oy,Oz.
Figure img00030002
Ui,Vi,et Wi sont les composantes de
Figure img00030003
<tb> N(i)
<tb> selon les axes de coordonnées:
Figure img00030004

-soit sous forme matricielle:
Figure img00030005
<tb> <SEP> {F,M} <SEP> = <SEP> {ml} <SEP> x <SEP> {f}
<tb> ou encore:
Figure img00030006
<tb> <SEP> {F,M} <SEP> = <SEP> {ml} <SEP> x <SEP> {k} <SEP> {p(i)}
<tb> avec:<SEP> <SEP> ~ <SEP> r <SEP>
<tb> <SEP> p(i) <SEP> = <SEP> (Txi <SEP> + <SEP> Tyj <SEP> + <SEP> Tzk) <SEP> N(i) <SEP> + <SEP> (R <SEP> OM(i)).N(i))
<tb> -soit sous une autre forme:
Figure img00030007
<tb> <SEP> p(i) <SEP> = <SEP> Txi <SEP> U(i) <SEP> + <SEP> Tyj <SEP> V(i) <SEP> + <SEP> tzk <SEP> W(i)
<tb> + <SEP> R <SEP> x <SEP> (N(i)@ <SEP> OM(i))i <SEP> + <SEP> Ry <SEP> (N(i)@ <SEP> OM(i))j <SEP> <SEP> + <SEP> Rz(N(i)@ <SEP> OM(i))k
<tb>
En écriture matricielle:
Figure img00030008
<tb> p(i) <SEP> = <SEP> {m2} <SEP> {T,R} <SEP> avec{m2} <SEP> = <SEP> {#1}
<tb> d'où:
Figure img00040001
est est une matrice diagonale.
La condition d'isoélasticité tridimensionnelle se résume par la relation:
Figure img00040002
<tb> {F,M} <SEP> {K'} <SEP> {T,R}
<tb>
avec k' matrice diagonale avec {m'} {m} {#} et{k'} = {k} { m} .Il faut que m' soit
une matrice diagonale.
Il y aura donc isoélasticité tridimensionnelle pour toutes les configurations des liaisons qui vérifient cette condition.Ce qui est le cas de la figure (3).
La disposition des éléments (potentiomètres,proximètres)qui mesurent les déplacements et orientations de la poignée se déduit du modèle qui vient d'être décrit.Si ces mesures s'effectuent à l'aide de six proximètres,soit j le proximètre qui mesure le déplacement de la poignée en un point M(j),comme précedemment le vecteur déplacement D(j) au point M(j) s'écrit :
Figure img00040003
<tb> D(j) <SEP> = <SEP> T <SEP> + <SEP> RA <SEP> OM(j)
<tb>
Le proximètre mesure le déplacement
Figure img00040004
<tb> p(j) <SEP> = <SEP> D(j) <SEP> .N(j)
<tb> est est la normale à la surface au point j,soit en écriture matricielle:
{p(j)} = {M} { T,R}
Les coefficients de {M} se déduisent du développement de p(j),soit: p(j) = Tx Uj + Ty Vj + Tz Wj + ARx + BRy + CRz
Uj,Vj,Wj, désignent les composantes du vecteur
Figure img00040005
<tb> N(j);
<tb>
A,B,C, les composantes du vecteur
Figure img00040006
<tb> OM(j)^n(j) <SEP>
<tb>
Les composantes du torseur,sont données par la relation:
ssTRt 1 M-1} p(j)t
Une implantation possible des proximètres est celle qui est donnée sur la figure (4).
Dans cette configuration:
Le-proximètre N 1 donne le déplacement selon la coordonnée X
Le proximètre N02 donne le déplacement selon la coordonnée Y
Le proximètre N03 donne le déplacement selon la coordonnée Z
Tandis que l'écart entre 4 et 2 donne la rotation selon OX
l'écart entre 5 et 3 donne la rotation selon OY
l'écart entre 6 et 1 donne la rotation selon OZ
Le système peut être équipé
- soit de capteurs analogiques (potentiomètres linéaires, capteurs de proximité inductifs ou capacitifs),dans ce cas, l'élaboration des signaux correspondant aux rotations s'effectuera par des soustracteurs à base d'amplificateurs opérationnels.
- soit de capteurs numériques incrémentaux,dans ce cas le système comportera un système comptage décomptage d' impul sions,associé à une unité arithmétique logique pour effectuer la soustraction des signaux.
- soit encore de capteurs logiques de type switch dans le cas d'une commande tout ou rien.

Claims (4)

REVENDICATIONS
1) Auxiliaire de commande à six degrés de liberté et rappel isoélastique en position de référence caractérisé en ce qu'il comporte une poignée ergonomique maintenue par six liaisons élastiques qui permettent à la poignée de décrire dans un volume donné tous les points et toutes les orientations de cet espace le retour en position de reférence s'effectue par un rappel isoélastique dès que la poignée n'est plus sollicitée.Les valeurs numériques des coordonnées de position et d'orientation de la poignée sont déduites a partir des mesures effectuées sur six proximètres (1),(2),(3),(4),(5),(6),qui sont disposés selon le schéma de la figure 4.
2) Auxiliaire de commande selon la revendication 1 caractérisé par une suspension élastique par six ressorts et rabsence de toute articulation.
3) Auxiliaire de commande selon les revendications 1 et 2 caractérisé par une force de rappel dirigée en sens inverse du mouvement imposé par l'opérateur (isoélasticité tridimensionnelle)
4) Auxiliaire de commande selon l'une quelconque des revendications précédentes caractérisé par la possibilité de l'équiper d'une poignée de commande ergonomique ou d'une boule.
FR8508011A 1985-05-24 1985-05-24 Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l'apprentissage de trajectoire dans l'espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules Pending FR2582245A1 (fr)

Priority Applications (1)

Application Number Priority Date Filing Date Title
FR8508011A FR2582245A1 (fr) 1985-05-24 1985-05-24 Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l'apprentissage de trajectoire dans l'espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
FR8508011A FR2582245A1 (fr) 1985-05-24 1985-05-24 Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l'apprentissage de trajectoire dans l'espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules

Publications (1)

Publication Number Publication Date
FR2582245A1 true FR2582245A1 (fr) 1986-11-28

Family

ID=9319622

Family Applications (1)

Application Number Title Priority Date Filing Date
FR8508011A Pending FR2582245A1 (fr) 1985-05-24 1985-05-24 Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l'apprentissage de trajectoire dans l'espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules

Country Status (1)

Country Link
FR (1) FR2582245A1 (fr)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4804897A (en) * 1987-08-19 1989-02-14 Hewlett-Packard Company Orientation-dependant robot controller
EP0518303A2 (fr) * 1991-06-14 1992-12-16 Honeywell Inc. Système de commande manuelle à mode proportionnel avec retour d'efforts
US6278907B1 (en) * 1999-11-24 2001-08-21 Xerox Corporation Apparatus and method of distributing object handling

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2504127A1 (de) * 1974-02-01 1975-09-04 Hitachi Ltd Geraet fuer automatische montage
US4216467A (en) * 1977-12-22 1980-08-05 Westinghouse Electric Corp. Hand controller
DE3211992A1 (de) * 1982-03-31 1983-10-06 Wagner Gmbh J Verfahren und vorrichtung zum programmieren eines roboters, insbesondere farbspritzroboters

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2504127A1 (de) * 1974-02-01 1975-09-04 Hitachi Ltd Geraet fuer automatische montage
US4216467A (en) * 1977-12-22 1980-08-05 Westinghouse Electric Corp. Hand controller
DE3211992A1 (de) * 1982-03-31 1983-10-06 Wagner Gmbh J Verfahren und vorrichtung zum programmieren eines roboters, insbesondere farbspritzroboters

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4804897A (en) * 1987-08-19 1989-02-14 Hewlett-Packard Company Orientation-dependant robot controller
EP0304306A2 (fr) * 1987-08-19 1989-02-22 Hewlett-Packard Company Dispositif de commande
EP0304306A3 (en) * 1987-08-19 1989-05-10 Hewlett-Packard Company Controller device
EP0518303A2 (fr) * 1991-06-14 1992-12-16 Honeywell Inc. Système de commande manuelle à mode proportionnel avec retour d'efforts
EP0518303A3 (fr) * 1991-06-14 1994-08-31 Honeywell Inc
US6278907B1 (en) * 1999-11-24 2001-08-21 Xerox Corporation Apparatus and method of distributing object handling

Similar Documents

Publication Publication Date Title
Furuta et al. Master-slave manipulator based on virtual internal model following control concept
Fontana et al. Mechanical design of a novel hand exoskeleton for accurate force displaying
Xi et al. Intelligent planning and control for multirobot coordination: An event-based approach
Corke et al. Real-time vision, tracking and control
Eom et al. Disturbance observer based force control of robot manipulator without force sensor
Borst et al. DLR hand II: Experiments and experience with an anthropomorphic hand
Caccavale et al. Integration for the next generation: embedding force control into industrial robots
Kosuge et al. Tele-manipulation system based on task-oriented virtual tool
De Schutter A study of active compliant motion control methods for rigid manipulators based on a generic scheme
Jau Dexterous telemanipulation with four fingered hand system
Li et al. Indirect adaptive robot control
Sharma et al. On the observability of robot motion under active camera control
FR2582245A1 (fr) Auxiliaire de commande a six degres de liberte avec rappel automatique en position de reference destine a l&#39;apprentissage de trajectoire dans l&#39;espace des coordonnees generalisees ou operationnelles des robots manipulateurs et des ensembles mecaniques polyarticules
Zheng et al. Two robot arms in assembly
Kaneko et al. A design method for manipulator control based on disturbance observer
JPH06218682A (ja) 組立用ロボット
Kugelmann Autonomous robotic handling applying sensor systems and 3D simulation
Tsumaki et al. Singularity-consistent inverse kinematics of a 6-DOF manipulator with a non-spherical wrist
Liao et al. Generalized impedance control of a redundant manipulator for handling tasks with position uncertainty while avoiding obstacles
Venture et al. Force-feedback micromanipulation with unconditionally stable coupling
JPH0239802B2 (ja) Robotsutonoseigyohoho
Fujita et al. Assembly of blocks by autonomous assembly robot with intelligence (ARI)
Lefeber et al. Adaptive and filtered visual servoing of planar robots
Ghosh et al. Computation of driving efforts for mechanisms and robots using bond graphs
Zhu Master-slave force-reflecting resolved motion control of hydraulic mobile machines