Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
ROBOTIZED MACHINE EQUIPPED WITH ARM WITH SYMMETRICAL PANTOGRAPH, FOR EXAMPLE FOR FRUIT PICKING OR SORTING DIVERSE OBJECTS
Document Type and Number:
WIPO Patent Application WO/1998/053961
Kind Code:
A1
Abstract:
The invention concerns a robotized machine, for example for fruit picking or sorting diverse objects, comprising a manipulator with spherical co-ordinates (two perpendicular and concurrent rotations Theta and Phi, and a translation Rho of its gripper towards the object to be gripped), such that the translation axis (A3) of the prehensile head (20a) of said gripper (20) always intersects the two rotation axes (A1, A2) at a central point (I), said manipulator being provided with an artificial vision system (24) for locating objects to be grasped, system whereof the optical centre is placed exactly at said central point (I). Said manipulator comprises a manipulating arm (1) with symmetrical pantograph consisting of an arm(1A) and a forearm (1B) arranged in two parallel planes so as to be able to be crossed, said arm (1) being fixed to means (21) pivoting it about an axis (A4) and provided with mechanical means ensuring the following kinematics: any arm (1A) rotation of value (+a) is transformed into a forearm (1B) rotation of value (-2a) relative to said arm, and by a gripper (20) rotation mounted at the forearm (1B) distal end, of a value (+a) relative to said forearm, resulting in a simple translation of said gripper distal end (20a) relative to a fixed mark, along an axis (A3) corresponding to the vision system (24) optical axis.

Inventors:
PELLENC ROGER
Application Number:
PCT/FR1998/001076
Publication Date:
December 03, 1998
Filing Date:
May 28, 1998
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
PELLENC SA (FR)
International Classes:
A01D46/24; A01D46/30; B25J9/04; B25J9/06; B25J9/10; B25J13/08; B25J19/04; (IPC1-7): B25J9/10; B25J9/04; A01D46/24
Foreign References:
EP0270469A11988-06-08
GB2022046A1979-12-12
FR2638599A11990-05-11
US5151008A1992-09-29
FR2610859A11988-08-19
GB2114534A1983-08-24
US4733576A1988-03-29
US4897015A1990-01-30
US5046992A1991-09-10
EP0629475A11994-12-21
Attorney, Agent or Firm:
Marek, Pierre (rue de la Loge, Marseille, FR)
Download PDF:
Claims:
REVENDICATIONS
1. Machine robotisée, par exemple pour La récolte de fruits ou Le tri d'objets divers, comprenant un manipulateur à coordonnées sphériques et à au moins trois degrés de Liberté (deux rotations perpendiculaires et concourantes Thta et Phi, et une translation Rho de son préhenseur vers L'objet à saisir), de sorte que L'axe de translation (A3) de La tte de préhension (20a) de ce préhenseur (20) intersecte toujours Les deux axes (A1, A2) des rotations en un point central (I), ce manipulateur à coordonnées sphériques étant muni d'un système de vision artificieLLe (24) pour Le repérage des objets à saisir, système dont Le centre optique est pLacé exactement audit point central (I), ledit manipulateur à coordonnées sphériques comportant un bras de manipulation (1) du type à pantographe symétrique constitué d'une première branche ou bras (1A) et d'une deuxième branche ou avantbras (1B) disposées dans deux plans parallèles de façon à pouvoir se croiser, Ledit bras (1) étant assujetti à des moyens (21) assurant son pivotement autour d'un axe (A4) et doté de moyens mécaniques assurant La cinématique suivante : toute rotation du bras (1A) de valeur (+a) se traduit par une rotation de l'avantbras (1B) d'une valeur (2a) par rapport audit bras, et par une rotation du préhenseur (20) monté à l'extrémité distale de l'avantbras (1B), d'une valeur (+a) par rapport audit avantbras, Le résultat étant une simple translation de L'extrémité distale (20a) dudit préhenseur par rapport à un repère fixe, Le Long d'un axe (A3) correspondant à l'axe optique du système de vision (24).
2. Machine robotisée selon La revendication 1, caractérisée en ce que Le bras de manipulation (1) est configuré de manière teLLe que, L'extrémité distale (20a) du préhenseur (20) se déplaçant sur l'axe optique (A3) du système de vision, L'extrémité arrière dudit préhenseur (20) liée à l'avantbras (1B) se déplace sur un axe (A5) parallèle audit axe optique (A3) et peut se déplacer en arrière du système de vision (24).
3. Machine robotisée selon l'une quelconque des revendications 1 ou 2, caractérisée en ce que Le préhenseur (20) a une longueur au moins égale ou supérieure à La longueur de l'avantbras (1B).
4. Machine robotisée suivant l'une quelconque des revendications 1 à 3, caractérisée en ce que Le dispositif assurant Les mouvements de l'ensemble du bras de manipulation (1) comprend : un axe (2) monté avec une aptitude de rotation à l'extré mité distale du bras (lA) et sur LequeL sont caLés un pre mier pignon (4) et L'extrémité proximale de L'avantbras (1B) ; un deuxième pignon (6) calé sur un axe fixe (7) autour duquel est monté Le bras (lA), par L'intermédiaire de son extrémité proximale, avec une aptitude de basculement, ce deuxième pignon (6) étant reLié au premier pignon (4), par un Lien souple ou rigide de transmission (5) et son diamètre étant Le double de celui dudit premier pignon (4) ; un renvoi (10) monté, par L'intermédiaire de sa portion centrale délimitant une branche proximale (10A) et une branche distale (10B), autour de L'axe de Liaison (2) du bras (1A) et de L'avantbras (lB).. et dans LequeL ledit axe (2) est Logé avec une aptitude de rotation ; un premier tirant rigide (13A) fixé, par L'intermédiaire de ses extrémités opposées et au moyen d'articulations (12, 14), d'une part, à La branche proximale (10A) du renvoi (10) et, d'autre part, sur l'une des extrémités d'une bielle fixe (15) dont L'autre extrémité est montée fixement, autour de l'axe (7) soutenant L'ensembLe du bras de manipulation ; de sorte que l'ensemble : bras t1A)branche proximale t10A) du renvoi (10tirant (13A)bieLLe (15), forme un premier parallélogramme déformable dont La bielle (15) constitue un côté fixe ; un deuxième tirant rigide (13B) fixé, par L'intermédiaire de ses extrémités opposées et au moyen d'articulations (16,17), d'une part à La branche distale (10B) du renvoi (10) et, d'autre part, à une bieLLe (18) dont L'autre extrémité est rigidement solidaire de l'axe (19) du préhenseur (20) Logé, avec une aptitude de rotation, dans l'extrémité distale de l'avantbras (1B), de sorte que l'ensemble : avantbras (1B)branche distale (10B) du renvoi (10)tirant (13B)bieLLe (18), forme un deuxième parallélogramme déformable ; le bras (1) ainsi agencé étant assujetti à des moyens (21) assurant son basculement autour de son axe fixe (7), ce basculement engendrant, suivant sa direction, un mouvement d'avance ou de recul de La tte de préhension (20a) du préhenseur (20) Le Long d'une trajectoire rectiligne (Rho).
5. Machine robotisée selon La revendication 4, caractérisée en ce que L'orientation de La bielle fixe (15) reliant Les extrémités proximales du bras (1A) et du premier tirant (13B), est réglable.
6. Machine robotisée selon l'une des revendications 4 ou 5, caractérisée en ce que Les tirants (13A, 13B) sont disposés entre Les plans dans LesqueLs pivotent, respectivement, Le bras (1A) et L'avantbras (1B).
7. Machine robotisée suivant L'une quelconque des revendications 4 à 6, caractérisée en ce que Les tirants (13A, 13B) sont montés avec une aptitude de pivotement dans deux plans parallèles, de manière à pouvoir se croiser.
8. Machine robotisée selon l'une quelconque des revendications 4 à 7, caractérisée en ce que Les différents mouvements du manipulateur (120) sont assurés par des moteurs électriques à vis à biLLes (21,27,28).
9. Machine robotisée suivant l'une quelconque des revendications 1 à 8, caractérisée en ce que La branche proximale (1A) du bras de manipulation (1A1B) comprend une portion (1A') s'étendant audessous ou audelà de l'axe de pivotement (A4) de Ladite branche proximale (1A), et en ce que Le moteur (21) assurant Le pivotement de cette dernière est fixé à Ladite portion (1A') de teLLe sorte que La quasi totalité de sa masse soit disposée audessous ou audelà dudit axe et contrebalance Le poids de L'ensembLe du bras de manipulation.
Description:
Machine robotisée pourvue d'au moins un bras à pantographe symétrique, par exemple pour La récolte de fruits ou Le tri d'objets divers.

La présente invention concerne une machine robotisée pourvue d'au moins un bras à pantographe symétrique, cette machine pouvant tre agencée et programmée pour l'accomplissement de taches diverses impliquant La reconnaissance d'un objet prédéterminé dans son environnement et une intervention sur cet objet, après sa détection.

La machine selon L'invention peut, par exemple, tre conformée, agencée et programmée pour effectuer La récolte robotisée de fruits tels que pommes, poires, pches, oranges et autres agrumes, etc. Dans cette application très intéressante, La machine robotisée permet de repérer et de cueiLLir individueLLement Les fruits avec leur pédoncule et de Les déposer sans chocs dans un réceptacle de grande contenance ou dans un dispositif de réception assurant leur acheminement jusqu'à un tel réceptacle.

La machine selon L'invention peut également tre agencée, conformée et programmée, pour remplir d'autres tâches teLLes que, par exemple, Le tri de déchets (déchets ménagers, déchets industriels, etc.) ou d'objets divers, ou, encore, La prise d'un objet à poste fixe.

On a décrit, dans Le document EP 0.270.469 A, une machine robotisée comprenant : -d'une part, un bras de manipulation ou manipulateur monté avec une aptitude de rotation autour de deux axes perpendiculaires et concourants, et dont l'extrémité Libre est munie d'un organe de préhension et, -d'autre part, un système de vision installé fixement au point d'intersection de ces axes de rotation, ce système de vision comprenant, par exemple, une unique caméra ou plusieurs micro-caméras convergentes ; ledit bras de manipulation étant conformé de manière à permettre audit organe de préhension une translation dans L'aLigement du

faisceau optique dudit système de vision, Le Long d'une trajectoire rectiligne qui croise l'intersection desdits axes de rotation, au cent-re optique du système de vision.

Ce manipulateur dit"à coordonnées sphériques" (deux rotations concourantes et une translation vers L'objet à saisir) possédant un système de vision en son centre, comprend un bras repLiabLe monté en compas. Ce bras comporte deux branches disposées dans Le mme plan et constituées par deux parallélogrammes articuLés de forme allongée et assemblés, à leur point de rencontre, au moyen d'une chape constituant, à La fois, Les deux petits côtés voisins de ces deux parallélogrammes articuLés, Ledit bras repLiabLe étant pourvu d'un dispositif communiquant un mouvement symétrique à ses deux branches, Lors de son dépLoiement ou lors de son repliage, cet agencement et ce mouvement symétrique permettant un déplacement rectiligne de L'organe de préhension de La machine. Le dispositif permettant d'obtenir un mouvement symétrique des deux branches du bras repLiabLe, comprend deux roues dentées engrenant l'une avec L'autre et calées fixement, sur Les extrémités adjacentes des bieLLettes internes constituant l'un des grands côtés des parallélogrammes articulés, Les différents mouvements dudit bras repLiabLe étant obtenus au moyen d'actionneurs constitués par des vérins hydrauliques.

Grâce à cette construction, iL est possible de faire coincider parfaitement Le centre de L'organe de préhension avec l'axe du faisceau optique du système de vision, Lorsque ledit organe se déplace en direction de L'objet à saisir. De La sorte, L'organe ou outil de préhension se présente toujours dans une position correcte par rapport à L'objet à atteindre qui peut tre ainsi saisi efficacement.

Toutefois, l'architecture des bras robotisés décrits dans Le document EP-A-0.270.469 conduit à La réalisation d'ensembles Lourds incorporant des actionneurs hydrauliques avec servo-valves, ce qui constitue un handicap important dans La mise en oeuvre des techniques de robotique. D'autre part, cette architecture n'autorise qu'une course Limitée de L'organe ou outil de préhension pour un encombrement

déterminé, de sorte que pour obtenir une course importante dudit organe de préhension, iL est nécessaire de prévoir des bras robotisés de grandes dimensions dont L'encombrement est incompatible avec certaines applications, notamment pour Les machines mufti-robots comportant au moins deux ensembles robotisés pLacés dos à dos.

L'invention a plus particulièrement pour but de remédier aux inconvénients ci-dessus.

On connait, par ailleurs, des bras robotisés (US 4.897.015 A, US 5.046.992 A, EP A, GB 2.022.046 A) à double pantographe, comprenant une première partie ou bras et une deuxième partie ou avant-bras, disposées dans deux plans parallèles de façon à pouvoir se croiser, ces deux parties étant assemblées à L'une de Leurs extrémités au moyen d'une articulation comprenant un axe commun sur LequeL est calé un premier pignon reLié, au moyen d'un Lien souple de transmission (chaine, courroie crantée ou autre), à un deuxième pignon fixe disposé à L'extrémité opposée du bras LequeL est monté avec une aptitude de pivotement autour de L'axe portant ledit deuxième pignon dont Le diamètre est Le double de celui du pignon auquel iL est relié, l'axe d'articulation des deux parties du bras étant rigidement fixé à l'avant-bras et solidaire en rotation de ce dernier, Le bras portant, à sa partie supérieure, un troisième pignon fixe relié, au moyen d'un Lien souple de transmission (chaîne, courroie crantée ou autre), à un quatrième pignon disposé à L'extrémité opposée dudit avant-bras et dont Le diamètre est également Le double de celui dudit troisième pignon, ce quatrième pignon étant calé sur un axe fixé à La partie postérieure du préhenseur et solidaire en rotation de ce dernier, ledit bras étant assujetti à des moyens assurant son basculement autour de son axe fixe, engendrant, suivant Le sens de ce basculement, un mouvement d'avance ou de recul de La tte de préhension du préhenseur Le Long d'une trajectoire rectiligne.

En vertu de cette conception, Les bras robotisés à double pantographe ou pantographe symétrique décrits dans

Les documents précités ont une cinématique de transmission permettant que toute rotation du bras de valeur (+ a) par rapport à une base fixe, se traduit par un déplacement angulaire de L'avant-bras d'une valeur (-2a) par rapport au bras, et une rotation du préhenseur d'une valeur (+ a) par rapport à l'avant-bras, La résultante étant une simple translation du préhenseur par rapport à un repère fixe.

En outre : -le document US-A-4.897.015 décrit sommairement un robot cylindrique (une rotation : Thta, une élongation : R, et une translation Z) ; -le document US-A-5.046.992 décrit avec plus de détails un autre robot cylindrique (une rotation : Thta, une élongation R, et une translation Z) ; -le document EP-A-0.629.475 décrit un robot cartésien (une élongation : X, 2 translations Y et Z).

-Le document GB-2 022 046 A décrit un manipulateur à un seul degré de Liberté, volontairement très simple et destiné à transférer un objet d'une position à une autre, par exemple sur une chaine d'assemblage.

Une conséquence de ces structures est que Le plan dans LequeL s'effectue L'éLongation du bras est toujours un plan horizontal, ce qui Limite leur souplesse d'utilisation à des taches dans Le plan horizontal, par exemple transporter ou manipuler une pièce entrant dans un processus de fabrication ou de traitement, d'un poste fixe à un autre poste fixe.

En outre, Les bras de manipulation robotisés à pantographe symétrique décrits dans Les documents susmentionnés sont dépourvus de système de vision, ce qui limite grandement Le champ de Leurs applications.

L'invention a notamment pour but de s'affranchir des contraintes imposées par Les robots décrits dans Les documents susmentionnés et de remédier à leurs insuffisances.

Selon une première disposition caractéristique de L'invention, cet objectif est atteint grâce à une machine robotisée comprenant un manipulateur à coordonnées sphériques et à au moins trois degrés de liberté : deux

rotations perpendiculaires et concourantes Thta et Phi, et une translation Rho de son préhenseur vers L'objet à saisir, de sorte que L'axe de La translation de ce préhenseur intersecte ou croise toujours Les deux axes des rotations en un point central I, ce manipulateur à coordonnées sphériques étant muni d'un système de vision artificieLLe pour Le repérage des objets à saisir, système dont Le centre optique est pLacé exactement audit point central I, ledit manipulateur comportant un bras de manipulation du type à pantographe symétrique constitué d'une première branche ou bras et d'une deuxième branche ou avant-bras disposées dans deux plans parallèles de façon à pouvoir se croiser, ce bras de manipulation étant assujetti à des moyens assurant son pivotement autour d'un axe et doté de moyens mécaniques assurant La cinématique suivante : toute rotation du bras de valeur (+a) se traduit par une rotation de L'avant-bras d'une valeur (-2a) par rapport audit bras, et par une rotation du préhenseur monté à L'extrémité distale de l'avant-bras d'une valeur (+a) par rapport audit avant-bras, Le résultat étant une simple translation de L'extrémité distale du préhenseur par rapport à un repère fixe, Le Long d'un axe correspondant à L'axe optique du système de vision.

Grâce à cette construction, iL est non seulement possible de réduire L'encombrement du bras tout en augmentant La longueur de La course du préhenseur pour un encombrement détermine (La partie postérieure du préhenseur pouvant reculer en arrière de l'emplacement où se trouve installé Le système de vision), mais L'éLongation du bras peut s'effectuer dans des plans quelconques, ce qui donne une grande souplesse d'utilisation et permet l'affectation du robot à géométrie sphérique à des taches nécessitant une grande variété de mouvements, teLLes que, par exemple, La récolte de fruits ou Le tri des déchets.

En résumé, une première disposition caractéristique importante de L'invention réside dans La combinaison originale d'un manipulateur robotisé à coordonnées sphériques et à système de vision artificieLLe et un bras de manipulation à double pantographe ou pantographe symétrique.

Une teLLe combinaison n'est pas évidente, essentiellement à cause du système de vision pLacé au centre du robot sphérique.

En effet, celui-ci impose des contraintes délicates : -implanter Le système de vision au centre géométrique du robot, ce qui interdit d'y mettre de La matière ; -s'assurer que durant L'éLongation du bras, L'extrémité de préhension du préhenseur se déplace toujours selon une droite passant par l'axe optique du système de vision ; -permettre à La partie postérieure du préhenseur de s'effacer derrière Le système de vision lors de son recul.

Un autre inconvénient des robots décrits dans Les documents US 4.897.015 A, US 5.046.992 A et EP 0.629.475 A et GB 2 022 046 A, réside dans Le fait que Les mouvements d'élongation et de repliement de leur bras robotisé à pantographe symétrique, sont obtenus au moyen de systèmes de transmission comprenant notamment : deux chaines, quatre pignons et plusieurs tendeurs de chaines. Ces systèmes nécessitent des opérations de maintenance pour Le régLage de La tension des chaines, des opérations d'entretien (graissage) desdites chaînes et La prévision de carters de chaines pour Les préserver de La poussière.

Un autre objectif de L'invention est de limiter grandement l'importance de cet inconvénient.

Selon une autre disposition caractéristique de l'invention, Le dispositif assurant Les mouvements de L'ensembLe du bras de manipulation comprend : -un axe monté avec une aptitude de rotation à l'extrémité distale du bras et sur LequeL sont respectivement cales un premier pignon et l'extrémité proximale de l'avant-bras ; -un deuxième pignon cale sur un axe fixe autour duquel est monté Le bras, par l'intermédiaire de son extrémité proximale, avec une aptitude de basculement, ce deuxième pignon étant reLié au premier pignon, par un Lien souple ou rigide de transmission, et son diamètre étant Le double de celui dudit premier pignon ; -un renvoi monté, par L'intermédiaire de sa portion centrale dé Limitant une branche proximale et une branche

distale, autour de l'axe de Liaison du bras et de l'avant-bras, et dans LequeL Ledit axe est logé avec une aptitude de rotation ; -un premier tirant fixé, par L'intermédiaire de ses extrémités opposées et au moyen d'articulations, d'une part, à La branche proximale du renvoi et, d'autre part, sur l'une des extrémités d'une bielle fixe dont L'autre extrémité est montée fixement, de préférence de manière réglable, autour de l'axe soutenant l'ensemble du bras de manipulation ; -un deuxième tirant fixé, par l'intermédiaire de ses extrémités opposées et au moyen d'articulations, d'une part à La branche distale du renvoi et, d'autre part, à une bieLLe dont L'autre extrémité est rigidement solidaire de l'axe du préhenseur logé, avec une aptitude de rotation, dans l'extrémité distale de l'avant-bras ; -le bras étant assujetti à des moyens assurant son basculement autour de son axe fixe, ce basculement engendrant, suivant sa direction, un mouvement d'avance ou de recul de La tte de préhension Le Long d'une trajectoire rectiligne correspondant à l'axe optique du système de vision, dans l'application aux robots de récolte de fruits ou de tri d'objets divers.

Grâce à cette construction du bras de manipulation, on obtient notamment Les avantages suivants : -simplification des opérations de maintenance de réglage de La tension des Liens de transmission, due à La suppression de l'une des chaînes et de ses tendeurs ; -simplification des opérations d'entretien (graissage) des Liens de transmission, découlant de l'utilisation d'une seule chaîne ; -facilité et rapidité accrues des opérations de réglage (calage) du préhenseur dans l'espace caméra ; -fiabilité et précision du régLage améliorées.

Les buts, caractéristiques et avantages ci-dessus, et d'autres encore, ressortiront mieux de La description qui suit et des dessins annexés dans LesqueLs : La figure 1 est une vue en perspective de L'ensembLe du manipulateur à pantographe symétrique d'une machine

robotisée selon L'invention.

La figure 2 est une vue de face, avec coupes verticales, de cette machine.

La figure 3 est une vue de côté de La figure 2, montrant Le bras dans une configuration correspondant à La position de recul extrme du préhenseur.

La figure 4 est une vue de face, à plus grande écheLLe et avec coupes verticales du bras de manipulation à pantographe symétrique, montré sans Le préhenseur.

La figure 5 est une vue de face, à échelle encore agrandie et en coupe, de La partie supérieure de ce bras de manipulation.

La figure 6 est une vue à caractère schématique de La cinématique de transmission du bras à pantographe symétrique représenté dans une position de déploiement.

La figure 7 est une vue de côté illustrant deux positions extrmes de La tte de préhension du préhenseur et Le déplacement de celle-ci Le Long de l'axe optique du système de vision.

Les figures 8 à 10 sont des vues de détail illustrant Le réglage de La bielle de référence régLabLe de La transmission à pantographe symétrique.

On décrit ci-après un mode d'exécution intéressant du robot à géométrie genérale sphérique (deux rotations concourantes : Thta, Phi, et une translation : Rho du préhenseur vers L'objet à saisir) avantageusement appLicabLe à La récolte robotisée de fruits ou au tri robotisé de déchets ou autres objets. Dans ces applications, très intéressantes, bien que nullement limitatives, un système de vision est installé fixement par rapport au bras de manipulation, et Le foyer optique de ce système de vision se trouve pLacé fixement, exactement à l'intersection des axes des rotations Thta, Phi, et de La translation Rho.

Afin de ne pas allonger inutilement La description, on décrit uniquement ci-après La partie de La machine robotisée, comportant application de L'invention revendiquée, La partie décrite pouvant tre installée sur un ensemble porteur conformé et agencé en fonction de La

destination de La machine, cet ensemble pouvant tre un véhicule automoteur dans Le cas d'une application à La récolte robotisée de fruits, ou un portique fixe ou mobile surmontant une zone de travail mobile (par exemple tapis transporteur) ou fixe, dans Le cas d'une application au tri robotisé de déchets ou autres objets.

Seton L'exempLe illustré, La machine robotisée comprend un manipulateur à coordonnées sphériques comportant un bras de manipulation à géométrie variable 1 constitué par un bras à pantographe symétrique comprenant une première branche ou bras 1A et une deuxième branche ou avant-bras 1B assemblés, à leur sommet, par une articulation. Cette Liaison articulée est réalisée au moyen d'un arbre 2 monté tournant dans des paliers 3 équipant l'extrémité distale du bras 1A. Le bras 1A et L'avant-bras 1B sont disposés dans deux plans parallèles, de façon à pouvoir se croiser.

Sur L'arbre 2, sont calés : -un premier pignon 4 relié, au moyen d'une chaîne 5 ou autre Lien souple ou rigide de transmission, tel que courroie crantée par exemple, à un deuxième pignon fixe 6 calé sur un axe fixe 7 autour duquel est monté, avec une aptitude de pivotement, Le bras 1A, par l'intermédiaire de son extrémité proximale et de paliers 8 ; -l'extrémité proximale de l'avant-bras 1B qui est ainsi i solidaire en rotation dudit axe 2 et dudit pignon 4.

Le pignon 6 a un diamètre (D6) qui est Le double du diamètre (D4) du pignon 4. Autrement dit, D6 = 2 D4 ou D4 = D6.

2 D'autre part, l'axe fixe 7 est rigidement solidaire d'un basculeur 9 supportant L'ensembLe du bras de manipulation 1 proprement dit.

Sur L'arbre 2, est encore monté un renvoi 10 dont La portion centrale présente un orifice muni d'un palier 11 pour Le passage dudit axe qui peut ainsi tourner dans ledit renvoi. Le renvoi 10 présente, de part et d'autre de sa portion centrale, une branche proximale 10A et une branche distale 10B. Le renvoi 10 peut tre avantageusement

constitué par une robuste pièce métallique ayant, vue de face, une forme générale triangulaire et dont Les points d'articulation sont disposés aux sommets d'un triangle.

La branche proximale 10A du renvoi 10 est reliée, par l'intermédiaire d'une articulation 12, à L'une des extrémités d'un premier tirant rigide 13A dont l'extrémité opposée est reliée, également au moyen d'une articulation 14, à L'une des extrémités d'une bielle fixe 15 dont L'autre extrémité est montée fixement autour de l'axe 7 soutenant L'ensembLe du bras de manipulation 1.

L'ensemble : bras 1A-branche proximale 10A du renvoi 10-tirant 13A-bielle 15, forme un premier parallélogramme déformable dont La bielle 15 constitue un côté fixe (tracé en trait fort de La figure 6).

La distance comprise entre Les points d'articulation du tirant 13A est égale à La distance séparant Les points d'articulation du bras 1A, tandis que La distance comprise entre Les points d'articulation de La bielle 15 est égale à La distance séparant Les points d'articulation de La branche proximale 10A du renvoi 10.

L'orientation de La branche proximale 10A du renvoi 10 est donc identique à L'orientation de La bieLLe 15 qui, selon une autre disposition caractéristique de L'invention décrite dans La suite du présent exposé, est réglable.

La branche distale 10B du renvoi 10 est reliée, par l'intermédiaire d'une articulation 16, à l'une des extrémités d'un deuxième tirant rigide 13B dont l'extrémité opposée est reliée, également au moyen d'une articulation 17, à une bielle 18 dont L'autre extrémité est rigidement solidaire de L'arbre 19 du préhenseur 20. L'arbre 19 est également rigidement solidaire de l'extrémité proximale du préhenseur 20 et iL est Logé avec une aptitude de rotation, par l'intermédiaire de paliers 19a, dans L'extrémité distale de l'avant-bras 1B.

L'ensembLe : avant-bras 1B-branche distale 10B du renvoi 10-tirant 13B-bielle 18, forme un deuxième parallélo- gramme déformable (tracé en trait fort de La figure 6).

La distance comprise entre Les points d'articulation du

tirant 13B est égale à La distance séparant Les points d'articulation de l'avant-bras 1B, tandis que La distance comprise entre Les points d'articulation de La bielle 18 solidaire du préhenseur 20, est égale à La distance séparant Les points d'articulation de La branche distale 10B du renvoi 10.

L'orientation de La bielle 18 solidaire du préhenseur 20 est donc identique à L'orientation de La branche distale 10B du renvoi 10.

Le préhenseur 20 peut avantageusement avoir une longueur relativement importante, c'est-à-dire, selon une disposition caractéristique de l'invention, une longueur au moins égale ou supérieure à La longueur de l'avant-bras 1B, et iL est muni d'une tte de préhension 20a constituant son extrémité Libre.

Plus généralement, selon l'invention, Le bras de manipulation à pantographe symétrique 1 a une configuration teLLe que l'extrémité distale 20a du préhenseur 20 se déplace sur L'axe optique A3 du système de vision 24 décrit ci-après, tandis que L'extrémité arrière dudit préhenseur liée à L'extrémité distale de L'avant-bras 1B se déplace sur un axe A5 parallèle audit axe A3, de sorte à pouvoir se déplacer en arrière de ce système de vision (figure 3).

Dans une application très intéressante de L'invention à La récolte des fruits, Le préhenseur 20 est constitue, au moins en partie, par un tube rigide raccordé, par L'intermédiaire d'un tuyau souple, à La bouche d'aspiration d'un aspirateur installé sur Le châssis de La machine. Dans ce cas, La tte de préhension 20a du préhenseur 20 est constituée par une tte d'aspiration.

Les mouvements d'allongement et de repliement du bras de manipulation 1 entrainant des mouvements d'avance et de recul de La tte de préhension 20a sont obtenus au moyen d'un vérin électrique constitué par un moteur à vis à biLLes 21.

Le bras ou branche proximale 1A du bras de manipulation présente une portion 1A'qui s'étend au-dessous ou au-delà de L'axe A4 de pivotement de Ladite branche proximale,

matérialise par l'axe fixe 7 (figure 4). Suivant une autre disposition caractéristique de L'invention, l'extrémité postérieure du corps 21a du moteur 21 est fixée, avec une possibilité de pivotement, à un axe 22 disposé dans Ladite portion 1A'du bras 1A, tandis que L'écrou 21c coopérant avec La vis 21b dudit moteur est disposé à distance de L'axe fixe 7 et porté, avec une aptitude de pivotement, autour d'un axe perpendiculaire à L'axe de rotation de Ladite vis, par une chape fixe 23 rigidement solidaire de L'axe 7 et du basculeur 9 (figures 2 et 3).

De La sorte, La quasi totalité de La masse du moteur 21 se trouve disposée au-dessous ou au-deLà de L'axe de pivotement A4 de La branche proximale 1A et contrebalance Le poids de l'ensemble du bras de manipulation 1A-1B-20. Cette disposition permet donc un meilleur équilibrage des masses mobiles autour de l'axe 7.

L'ensemble du bras de manipulation 1-20 à pantographe symétrique ainsi configuré est monté sur Le châssis de La machine avec une aptitude de pivotement autour de deux axes perpendiculaires et concourants A1, A2.

Le basculeur 9 portant Le bras, est montée avec une aptitude de basculement autour d'un axe A2, à La partie supérieure d'une toureLLe 25, elle-mme supportée, avec une Latitude de pivotement autour d'un axe A1, par une embase fixe 26, Les axes A2 et A1 étant, de préférence, orientes perpendiculairement.

Le basculeur 9 est, par exemple, monté avec une lati- tude de pivotement et par l'intermédiaire de paliers, autour d'un axe horizontal fixe 30 porté par Le sommet de La toureLLe 25, tandis que La toureLLe est, par exemple, monté avec une aptitude de pivotement et par L'intermédiaire de paliers, autour d'un axe vertical fixe 31 porté par L'embase 26.

Les mouvements de basculement du basculeur 9 portant Le bras 1, autour de l'axe A2, et de La toureLLe 25 supportant ledit basculeur autour de L'axe A1, sont obtenus par des actionneurs électriques, respectivement 27,28, de préférence identiques à l'actionneur électrique 21

précédemment décrit.

Le vérin électrique à vis à biLLe 27 assurant Le basculement du basculeur 9 autour de l'axe horizontal 30 correspondant à L'axe géométrique A2, est fixé, au moyen d'articulations, d'une part, à La toureLLe 25 et, d'autre part, au basculeur 9.

Le vérin électrique à vis à biLLe 28 assurant Le pivotement de La toureLLe 25 autour de L'axe vertical 31 correspondant à l'axe géométrique A1, est fixé, au moyen d'articulations, d'une part, à La toureLLe 25 et, d'autre part, à l'embase fixe 26.

On observe que Les différents actionneurs électriques 21,27,28, du bras robotisé, sont logés dans des carters constitués par : -une enveloppe de forme allongée 29 formée par une partie constitutive du bras 1A, en ce qui concerne l'actionneur 21 ; -la partie verticale 25a de La toureLLe 25, pour l'actionneur 27 ; et -par La partie horizontale 25b de Ladite toureLLe 25, pour L'actionneur 28.

Après La description qui précède, on comprend que grâce à l'agencement du bras robotisé à pantographe symétrique 1-20, selon L'invention, La mise en rotation de La vis 21a du vérin électrique 21 entraîne Le basculement du bras 1A, autour d'un axe A4 (matérialisé par l'axe fixe 7), dans un sens ou dans L'autre, suivant Le sens de rotation de Ladite vis. D'autre part, grâce à La cinématique de transmission précédemment décrite, toute rotation du bras 1A de valeur (+ a), par rapport à sa base, se traduit par un dépLacement angulaire de sens contraire de L'avant-bras 1B d'une valeur (-2a) par rapport audit bras, et par une rotation du préhenseur 20 de sens contraire par rapport audit avant-bras d'une valeur (+ a), le résultat étant une simple translation du préhenseur par rapport à un repère fixe, de sorte que La tte de préhension 20a reste positionnée sur un axe A3, notamment lors de ses déplacements en direction de L'objet à saisir.

En effet, pendant Les phases d'allongement ou de repliement du bras 1, La bielle 15 est immobile. Le renvoi 10 conserve donc son orientation grâce au parallélogramme déformable 15-13A-10A-1A construit autour du tirant 13A ; Le parallélogramme déformable 10B-13B-18-1B construit autour du tirant 13B recopie L'orientation du renvoi 10 sur La bielle 18 solidaire du préhenseur 20. L'orientation du renvoi étant conservée, Le préhenseur conserve donc son orientation et se déplace en conservant cette orientation.

Le robot précédemment décrit est donc du genre à géométrie générale sphérique (deux rotations concourantes : Thta (autour de l'axe Al), Phi (autour de l'axe A2) et une translation Rho (Le Long de l'axe A3) du préhenseur 20 vers L'objet à saisir).

Selon L'invention, Le système de vision artificieLLe 24 de ce robot à coordonnées sphériques et à pantographe symétrique, est installé fixement sur un éLément fixe du châssis de La machine, à L'intersection I des axes A1, A2, A3 des rotations Thta, Phi et de La translation Rho de La tte de préhension 20a du préhenseur 20.

Ce système de vision 24, Le module de traitement des images enregistrées par ce dernier et l'ordinateur de commande des mouvements du manipulateur, n'entrent pas dans Le cadre du présent brevet et ne sont donc pas décrits.

Suivant l'agencement décrit précédemment. l'extrémité distale de L'avant-bras 1B liée au préhenseur 20 peut se déplacer au-dessus du système de vision 24, suivant un axe A5 parallèle à l'axe optique A3 de ce dernier. De La sorte, dans La position de recul (figure 3), une importante partie de La Longueur du préhenseur 20 peut tre amenée en arrière du système de vision 24, comme indiqué précédemment, ce qui permet d'avoir une course importante dudit préhenseur, avec un encombrement réduit de l'ensemble du bras de manipulation en position de recul ou en position de repos. D'autre part, malgré Le décalage des axes A3 et A5, La tte de préhension 20a est disposée sur l'axe optique A3 du système de vision 24 et se déplace Le Long de cet axe sur La totalité de sa course de translation possible en direction de L'objet

détecté par Ledit système de vision et identifié par L'inteLLigence artificieLLe de La machine (figure 7).

SeLon une autre disposition caractéristique de L'invention, La bielle 15 constituant Le côté fixe du parallélogramme déformable 1A-10A-13A-15, a une position réglable par rapport au basculeur 9.

Dans ce but, l'extrémité de Ladite bielle reliée à L'extrémité proximale du tirant 13A est disposée entre deux butées régLabLes dont sont munies, respectivement, Les deux branches 32A, 32B d'une fourchette que présente une chape 32 rigidement liée au basculeur 9. Ces butées réglables sont constituées par des vis de pression 33A, 33B se vissant dans Les branches fixes 32A-32B (figures 8 à 10).

La figure 8 iLLustre La position"centrale"de La bieLLe réglable 15.

En dévissant La ou Les vis 33A et en vissant La ou Les vis 33B, on provoque un dépLacement angulaire de La bielle 15 (figure 9), ce déplacement est transmis, par Le tirant 13A au renvoi 10 qui tourne autour de son axe principal (arbre 2) d'une valeur correspondante ; ce déplacement angulaire du renvoi 10 est transmis, par L'intermédiaire du tirant 13B, à La bielle 18 du préhenseur qui tourne autour de son axe principal (arbre 19) d'une valeur angulaire correspondante. Finalement, Le préhenseur 20 qui est liée rigidement à La bielle 18, tourne d'une valeur angulaire correspondant exactement au déplacement angulaire de La bielle 15.

Le réglage de La bielle 15 en sens opposé est obtenu en dévissant La ou Les vis 33B et en vissant La ou Les vis 33A (figure 10).




 
Previous Patent: LOCKING PLIERS

Next Patent: ROBOT CONTROL METHOD AND DEVICE