FR2630957A1 - Dispositif d'asservissement pour robot manipulateur - Google Patents
Dispositif d'asservissement pour robot manipulateur Download PDFInfo
- Publication number
- FR2630957A1 FR2630957A1 FR8806438A FR8806438A FR2630957A1 FR 2630957 A1 FR2630957 A1 FR 2630957A1 FR 8806438 A FR8806438 A FR 8806438A FR 8806438 A FR8806438 A FR 8806438A FR 2630957 A1 FR2630957 A1 FR 2630957A1
- Authority
- FR
- France
- Prior art keywords
- reference plane
- arm
- servo
- sensor
- optical
- 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.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
- B25J19/021—Optical sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Abstract
La présente invention a pour objet un dispositif d'asservissement pour robot manipulateur comportant un capteur optique de position 1 monté sur le bras 2 du robot pour localiser une pièce mécanique 22 participant à un assemblage et coopérant avec des moyens propres à émettre un signal d'erreur agissant sur l'asservissement et à modifier la position relative du bras et de la pièce pour atteindre une position de consigne. Ce dispositif d'asservissement comporte une caméra matricielle 4 propre à analyser une image, des moyens pour comparer cette image à une image de consigne et émettre un signal d'erreur agissant sur l'asservissement, ainsi que des moyens pour faire fonctionner cette caméra selon un premier mode d'approche en large bande lumineuse et selon un deuxième mode de précision en lumière structurée.
Description
La présente invention concerne un dispositif d'asservis
sement pour robot manipulateur comportant un capteur
optique de position destiné à être monté sur le bras du
robot afin de localiser une pièce mécanique participant å a un assemblage.
sement pour robot manipulateur comportant un capteur
optique de position destiné à être monté sur le bras du
robot afin de localiser une pièce mécanique participant å a un assemblage.
On sait que généralement, pour réaliser un assemblage
robotisé, il est nécessaire d'introduire en mémoire dans
l'ordinateur qui commande le robot les coordonnées des
différentes pièces avant et après montage. Les possibi
lités des montages robotisés sont ainsi limitées par la
précision possible des robots.
robotisé, il est nécessaire d'introduire en mémoire dans
l'ordinateur qui commande le robot les coordonnées des
différentes pièces avant et après montage. Les possibi
lités des montages robotisés sont ainsi limitées par la
précision possible des robots.
On a dé3 proposé des asservissements propres à modi
fier la position relative du bras du robot et de la piè
ce, selon les indications d'un capteur de position, dé
livrant un signal d'erreur par rapport à une consigne, ce signal étant interprété par le calculateur pour agir sur les moyens de commande du robot.
fier la position relative du bras du robot et de la piè
ce, selon les indications d'un capteur de position, dé
livrant un signal d'erreur par rapport à une consigne, ce signal étant interprété par le calculateur pour agir sur les moyens de commande du robot.
La présente invention a pour objet un dispositif d'asservissement comportant un capteur optique de position du type mentionné ci-dessus, pilotant l'asservissement et qui comporte un calculateur ainsi. que des moyens de commande du robot et du capteur; il est caractérisé par le fait qu'il comporte une caméra matricielle, et des moyens pour comparer une image fournie par cette caméra a une image de consigne et a émettre un signal d'erreur, ainsi que des moyens pour faire fonctionner cette caméra selon un premier mode d'approche en large bande lumineuse et selon un deuxième mode en lumière cohérente.
Le capteur peut comporter un objectif mis au point sur un plan de consigne et des moyens agissant sur l'asservissement pour modifier la position relative du bras du robot et de la pièce de manière à faire coincider un plan de référence de la pièce et le plan de consigne et à placer un point de référence de la pièce sur l'axe optique de l'objectif.
En général, la pièce comporte un alésage dont la trace sur le plan de référence est un cercle. L'orientation relative du bras du robot et de la pièce est modifié tant que l'image est une ellipse; la distance relative est ensuite modifiée afin que le diamètre de l'image atteigne la valeur de consigne ; enfin un déplacement parallèle au plan référencé, amène le centre du cercle sur l'axe optique.
Ce capteur optique peut comporter des moyens pour émettre deux plans laser inclinés à 450 sur l'axe optique de l'objectif dans le plan de consigne et intersectant le plan de consigne selon deux traces perpendiculaires entre elles.
Le dispositif peut comporter des moyens pour émettre des signaux agissant sur l'asservissement de manière à modifier la position relative du bras manipulateur et de la pièce, de telle sorte que les traces des deux plans laser sur le plan de référence de la pièce s'identifient avec une configuration de consigne.
On a décrit ci-après a titre d'exemple non limitatif, un mode de réalisation de l'installation selon l'invention avec référence aux dessins annexés dans lesquels
La Figure 1 est un schéma de l'installation;
La Figure 2 montre le capteur en élévation, avec
coupe partielle;
La Figure 3 est un schéma montrant le fonctionne
ment du capteur en mode d'approche;
La Figure 4 est un schéma montrant le fonctionne
ment du capteur en mode de précision.
La Figure 1 est un schéma de l'installation;
La Figure 2 montre le capteur en élévation, avec
coupe partielle;
La Figure 3 est un schéma montrant le fonctionne
ment du capteur en mode d'approche;
La Figure 4 est un schéma montrant le fonctionne
ment du capteur en mode de précision.
Tel qu'il est représenté au dessin, le dispositif d'asservissement de robot selon l'invention cqmprend un capteur de position qui est désigné au dessin d'une façon générale par la référence 1 et qui est monté sur le bras 2 d'un robot 3 (Figure 1).
Le capteur 1 comprend une caméra matricielle 4 de type
C.C.D. (Charged Coupled Device) qui est munie d'un objectif s a iris commandable dont on voit en 6 l'axe optique et qui est mis au point sur un plan P se trouvant a une distance D. Le capteur porte trois lampes a incandescence 7, donc a large bande, qui peuvent a volonté être mises en ou hors service donc ajuster la luminosité de la zone entourant la zone du-plan P situé sur l'axe optique 6.
C.C.D. (Charged Coupled Device) qui est munie d'un objectif s a iris commandable dont on voit en 6 l'axe optique et qui est mis au point sur un plan P se trouvant a une distance D. Le capteur porte trois lampes a incandescence 7, donc a large bande, qui peuvent a volonté être mises en ou hors service donc ajuster la luminosité de la zone entourant la zone du-plan P situé sur l'axe optique 6.
Le capteur 1 porte également deux projecteurs laser 8 qui sont reliés par des fibres optiques 9 à un séparateur 10 lui-même relié par une fibre optique 11 a une source laser 12 (voir Figure 1). Les projecteurs 8 comprennent chacun une lentille cylindrique et un miroir et sont placés de manière à former deux faisceaux laser inclinés à 450 par rapport a l'axe optique 6 de la caméra 4 et dont les traces Plet P2 dans le plan 3 sont perpendiculaires entre elles.
Un filtre 13 centré sur la fréquence de la source laser 12 est monté pivotant sur le capteur 1 autour d'un axé 14 de façon 9 pouvoir être interposé devant la caméra 4 ou écarté de celle-ci. Un électro-aimant 15 porté par le capteurl permet d'actionner, contre l'action d'un ressort antagoniste 16, une tringlerie 17 de commande du filtre 13.
Les signaux fournis par le capteur 1 sont envoyés à l'armoire de commande 18 du robot 3, par l'intermédiaire d'un dispositif de commande 19 et d'un calculateur 20.
Le calculateur 20 est programmé de manière que, lorsque la caméra est disposée en regard d'un alésage 21 d'une pièce 22 - il déplace le bras 5 jusqu'à ce que le centre de l'alé-
sage 21 soit sur l'axe optique 6 de la caméra. 4 et
que l'image reçue par celle-ci soit une ellipse; - il modifie l'orientation du bras 2 jusqu'à ce que
l'image reçue par la caméra 4 soit un cercle; - il déplace le bras 3 parallèlement a lui-même jusqu'3
ce que le diamètre de l'image ait une valeur donnée,
le plan de référence coïncidant alors avec le plan P;; - il modifie l'orientation du bras 3 jusqu'a ce que les
intersectionsdesplans laser avec un plan de référence
de la pièce .22 soient orthogonales entre elles, - et il modifie l'orientation du bras 3 jusqu! ce que l'intersection des plans laser avec le plan de référence de la pièce soit sur l'axe optique.
sage 21 soit sur l'axe optique 6 de la caméra. 4 et
que l'image reçue par celle-ci soit une ellipse; - il modifie l'orientation du bras 2 jusqu'à ce que
l'image reçue par la caméra 4 soit un cercle; - il déplace le bras 3 parallèlement a lui-même jusqu'3
ce que le diamètre de l'image ait une valeur donnée,
le plan de référence coïncidant alors avec le plan P;; - il modifie l'orientation du bras 3 jusqu'a ce que les
intersectionsdesplans laser avec un plan de référence
de la pièce .22 soient orthogonales entre elles, - et il modifie l'orientation du bras 3 jusqu! ce que l'intersection des plans laser avec le plan de référence de la pièce soit sur l'axe optique.
Le dispositif d'asservissement qui vient d'être décrit fonctionne de la maniera suivante. Le capteur 1 est amené par le bras 2 à une position de référence de la zone de travail. I1 inspecte l'objet d'abord en lumière a large bande, puis en lumière structurée.
Dans la première étape (voir Figure 3), le filtre 13 est escamoté, les sources lumineuses 7 et l'iris de l'objectif 5 sont ajustés de façon à obtenir une scène analysable. Le bras 2, commandé par le capteur 1, se déplace alors jusqu'à ce que l'image du trou 21 soit un cercle de diamètre donné. Puis le filtre 13 est placé devant la caméra 4 et les sources lumineuses 7 sont éteintes; l'iris de l'objectif 5 est ajusté en fonction de la brillance des plans laser (absorption de la lumie- re laser selon la nature de l'objet 22). Le bras 2, toujours commandé par le capteur 1, se déplace alors jusqu'a ce que les intersections des traces P1 et P2 soient orthogonales entre elles.
Le mode de fonctionnement en lumière a large bande permet au capteur de travailler dans un champ relativement important, zizis non d'obtenir une grande précision, notamment dans la direction de l'axe optique 6, Le mode de fonctionnement en lumière structurée ne peut être utilisé que lorsque, le capteur est proche de sa position finale recherchée, mais est d'une très grande précision. L'utilisation des deux modes de fonctionnement permet d'optimiser le travail du, capteur en temps de traitement et en précision.
On peut ajouter que le dispositif selon l'invention est facile à implanter sur son organe porteur grâce à son faible poids et à ses faibles dimensions.
I1 va de soi que la présente invention ne doit pas être considérée comme limitée au mode de réalisation décrit et représenté mais en couvre, au contraire, toutes les variantes.
Claims (10)
1. Dispositif d'asservissement pour robot manipulateur comportant un capteur optique de position (1) monté sur le bras (2) du robot pour localiser une pièce mécanique (22) participant a un assemblage et coopérant avec des moyens aptes à émettre un signal d'erreur agissant sur l'asservissement et à modifier la position relative du bras et de la pièce pour atteindre une position de consigne, caractérisé en ce qu'il comporte une caméra matricielle (4) propre à- analyser une image, des moyens pour comparer cette image à une image.de consigne et émettre un signal d'erreur agissant sur l'asservissement, ainsi que des moyens pour faire fonctionner cette caméra selon un premier mode d'approche en large bande lumineuse et selon un deuxième mode de précision en lumière structurée.
2. Dispositif selon la revendication 1, caractérisé en ce que le capteur optique (I) comporte, coopérant avec la caméra (4), un objectif (5) a iris commandable mis au point sur un plan de consigne P et des sources lumineuses sélectionnables (7) a large bande.
3. Dispositif selon la revendication 2, caractérisé en ce que la caméra matricielle (4) est propre a agir sur l'asservissement pour modifier la distan ce relative et l'orientation relative du bras manipulateur (2) et de la pièce (22) de manière à faire coincider un plan de référence de la pièce et le plan de consigne et a placer un point de référence sur l'axe optique (6) de l'objectif (5).
4. Dispositif selon la revendication 1 ou 3, caractérisé en ce qu'il comporte des moyens pour passer automatiquement du mode en large bande au mode en lumière structurée quand la consigne en mode large bande est atteinte.
5. Dispositif selon la revendication 1 ou 4, caractérisé en ce que le capteur optique (1) comporte des moyens (11) de liaison optique a une source laser (12), un séparateur (13) propre a transformer un signal laser en deux signaux identiques, et des moyens optiques (8) pour engendrer deux plans laser inclines a 450 sur l'axe optique (6) de la caméra (4), coupant l'axe optique dans un plan de consigne P et dont les traces Pl et P2 sur le plan de consigne P sont perpendiculaires entre elles.
6. Dispositif selon la revendication 5, caractérisé en ce que le capteur optique (1) comporte un filtre (13) centré sur la fréquence laser et des moyens (15-16-17) pour l'introduire dans le circuit optique quand le capteur (1) fonctionne selon son deuxième mode et pour l'éclipser quand le capteur fonctionne selon son premier mode.
7. Dispositif selon la revendication 5 ou 6, caractérisé en ce qu'il comporte des moyens pour commander l'asservissement de manière a modifier la position relative du bras (2) et de la piece (22) de telle sorte que les intersections des plans laser avec le plan de référence de la pièce s'identifient avec la configuration de consigne.
8. Dispositif selon la revendication 7, caractérisé en ce qu'il comporte des moyens pour commander l'asservissement de manière à modifier la distance relative du bras (2) et du plan de référence de la pièce quand le point d'intersection des traces sur le plan de référence est situé en dehors de l'axe optique (6) de l'objectif (5).
9. Dispositif selon la revendication 8, caractérisé en ce qu' il comporte des moyens pour commander l'asservissement de manière a modifier l'orientation relative du bras (2) et du plan de référence de la pièce (22) quand les traces sur le plan de référence font entre elles un angle aigu ou obtus.
10. Capteur optique inclus dans un dispositif selon l'une quelconque des revendications précédentes, caractérisé en ce qu'il comporte une caméra matricielle (4), un objectif (5) à iris commandable, des sources lumineuses sélectionnables (7) à large bande, une source laser (12), un séparateur (13) des lentilles cylindriques associées à des miroirs pour engendrer des plans laser, un filtre (13) ajusté sur la fréquence laser, et des moyens (15-16-17) pour mettre en circuit ou hors circuit le filtre (13) selon que le capteur fonctionne en large bande ou en lumière structurée.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| FR8806438A FR2630957A1 (fr) | 1988-05-05 | 1988-05-05 | Dispositif d'asservissement pour robot manipulateur |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| FR8806438A FR2630957A1 (fr) | 1988-05-05 | 1988-05-05 | Dispositif d'asservissement pour robot manipulateur |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| FR2630957A1 true FR2630957A1 (fr) | 1989-11-10 |
| FR2630957B1 FR2630957B1 (fr) | 1994-08-19 |
Family
ID=9366268
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| FR8806438A Granted FR2630957A1 (fr) | 1988-05-05 | 1988-05-05 | Dispositif d'asservissement pour robot manipulateur |
Country Status (1)
| Country | Link |
|---|---|
| FR (1) | FR2630957A1 (fr) |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0581188A1 (fr) * | 1992-07-28 | 1994-02-02 | G.D Societa' Per Azioni | Méthode pour saisir des flans empilés |
| EP0812662A1 (fr) * | 1995-12-27 | 1997-12-17 | Fanuc Ltd | Systeme robotique composite de detection |
| WO1998030121A1 (fr) * | 1997-01-08 | 1998-07-16 | Intelligent Machines Corporation | Appareil de traitement de pieces a travailler et procede de traitement prevu a cet effet |
| US6259519B1 (en) | 1999-08-31 | 2001-07-10 | Intelligent Machine Concepts, L.L.C. | Method of determining the planar inclination of a surface |
| US6327520B1 (en) | 1999-08-31 | 2001-12-04 | Intelligent Machine Concepts, L.L.C. | Planar normality sensor |
| WO2009128104A1 (fr) * | 2008-04-18 | 2009-10-22 | Sea Vision S.R.L. | Manipulateur et opération associée |
| CN114654482A (zh) * | 2022-04-26 | 2022-06-24 | 北京市商汤科技开发有限公司 | 移动机器人的控制方法、机器人、装置、设备及存储介质 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0134045A1 (fr) * | 1981-09-30 | 1985-03-13 | Unimation Inc. | Dispositif de perception et de soudage pour manipulateurs à souder |
| US4673795A (en) * | 1984-10-15 | 1987-06-16 | General Electric Company | Integrated robotic laser material processing and imaging system |
-
1988
- 1988-05-05 FR FR8806438A patent/FR2630957A1/fr active Granted
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0134045A1 (fr) * | 1981-09-30 | 1985-03-13 | Unimation Inc. | Dispositif de perception et de soudage pour manipulateurs à souder |
| US4673795A (en) * | 1984-10-15 | 1987-06-16 | General Electric Company | Integrated robotic laser material processing and imaging system |
Non-Patent Citations (2)
| Title |
|---|
| COMPUTER vol. 15, no. 6, juin 1982, page 8 - 22; JARVIS R.A.: "A COMPUTER VISION AND ROBOTICS LABORATORY" * |
| IEEE INT. CONF. ON ROBOTICS & AUTOMATION vol. 3, avril 1986, USA & DIETRICH: "MULTISENSORY ROBOTS AND SEMSORBASED PATH GENERATION" * |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0581188A1 (fr) * | 1992-07-28 | 1994-02-02 | G.D Societa' Per Azioni | Méthode pour saisir des flans empilés |
| US5411362A (en) * | 1992-07-28 | 1995-05-02 | G. D. Societa' Per Azioni | Method of picking up stacked blanks |
| EP0812662A1 (fr) * | 1995-12-27 | 1997-12-17 | Fanuc Ltd | Systeme robotique composite de detection |
| EP0812662A4 (fr) * | 1995-12-27 | 2000-11-15 | Fanuc Ltd | Systeme robotique composite de detection |
| WO1998030121A1 (fr) * | 1997-01-08 | 1998-07-16 | Intelligent Machines Corporation | Appareil de traitement de pieces a travailler et procede de traitement prevu a cet effet |
| US5968297A (en) * | 1997-01-08 | 1999-10-19 | Intelligent Machine Concepts, Llc | Workpiece treating apparatus and method of treating same |
| US6259519B1 (en) | 1999-08-31 | 2001-07-10 | Intelligent Machine Concepts, L.L.C. | Method of determining the planar inclination of a surface |
| US6327520B1 (en) | 1999-08-31 | 2001-12-04 | Intelligent Machine Concepts, L.L.C. | Planar normality sensor |
| WO2009128104A1 (fr) * | 2008-04-18 | 2009-10-22 | Sea Vision S.R.L. | Manipulateur et opération associée |
| CN114654482A (zh) * | 2022-04-26 | 2022-06-24 | 北京市商汤科技开发有限公司 | 移动机器人的控制方法、机器人、装置、设备及存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| FR2630957B1 (fr) | 1994-08-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2657487B2 (ja) | レーザの波長制御装置および方法 | |
| EP0033679B1 (fr) | Système de désignation d'objectif par laser | |
| EP1209441B1 (fr) | Dispositif de relèvement tridimensionnel d'une scène à émission laser | |
| EP0119883B1 (fr) | Procédé et dispositif d'alignement d'un faisceau laser par l'intermédiaire de moyens optiques de visée, et procédé de mise en oeuvre du dispositif, pour contrôler l'alignement | |
| US6049059A (en) | Vision processing method and device for welding line auto-tracking | |
| US6198580B1 (en) | Gimballed optical mount | |
| US8743360B2 (en) | Detection method for birefringence measurement | |
| GB2189330A (en) | Optical axial alignment aid for remote control operations | |
| CN108627141B (zh) | 与成像系统一起使用的调制监控系统 | |
| FR2630957A1 (fr) | Dispositif d'asservissement pour robot manipulateur | |
| EP0277444A1 (fr) | Machine à micro faisceau laser d'intervention sur des objets à couches minces de matériau | |
| US6504611B2 (en) | Two stage optical alignment device and method of aligning optical components | |
| FR2627874A1 (fr) | Systeme d'alignement d'un faisceau de puissance | |
| EP1072858B1 (fr) | Procédé et dispositif de guidage à balayage laser d'un missile vers une cible | |
| US6757063B2 (en) | Method and apparatus for precision alignment and assembly of opto-electronic components for fiber-optic networks | |
| KR100660112B1 (ko) | 레이저빔의 광폭이 제어되는 레이저와 비전의 동축가공장치 | |
| US4934799A (en) | Multi-lens focussing arrangement for laser graphics imaging apparatus | |
| JPH06208990A (ja) | 反射面へのレーザービームを垂直化する方法及び装置 | |
| FR2620537A1 (fr) | Dispositif optique a mise au point automatique et appareil optique comportant un tel dispositif | |
| JPH08334668A (ja) | 自動合焦点装置を備えた光学顕微鏡 | |
| JPH07175021A (ja) | 光空間通信装置 | |
| KR100845712B1 (ko) | 원뿔 렌즈를 이용한 빔 확대기 | |
| JP2004522936A5 (fr) | ||
| JP2002196259A (ja) | 視野位置表示装置 | |
| JPH04168776A (ja) | 光軸アライメント装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| ST | Notification of lapse |