Upload
joaquinmdz
View
84
Download
0
Embed Size (px)
Citation preview
5/27/2018 Guide Etudiant
1/56
Guide de ltudiant
Robot Fanuc LR Mate 200iC
ROBOGUIDE
Langage KAREL
5/27/2018 Guide Etudiant
2/56
ii
5/27/2018 Guide Etudiant
3/56
iii
TABLE DES MATIRESCHAPITRE 1 : Introduction ........................................................................................................................... 1
CHAPITRE 2 : Mesure scurit .................................................................................................................... 22.1. Prcautions gnrales ........................................................................................................................... 22.2. Prcaution lors de lutilisation du robot en mode manuel ..................................................... 22.3. Prcaution lors de lutilisation du robot en mode automatique .......................................... 2
CHAPITRE 3 : Robot rel LR Mate 200iC ............................................................................................. 33.1. Schma du LR MATE 200IC ................................................................................................................. 33.2. Paramtres de Dnavit-Hartenberg ................................................................................................ 6
3.2.1. Cas particulier du LR-Mate 200IC ............................................................................................ 7CHAPITRE 4 : Logiciel de simulation ROBOGUIDE ........................................................................... 9
4.1. Introduction ROBOGUIDE ................................................................................................................ 9
4.1.1. Organisation des fentres du programme ......................................................................... 104.2. Tableau synthse des boutons ........................................................................................................ 114.2.1. Structure de la cellule de travail ............................................................................................ 12
4.3. Instruction des commandes ............................................................................................................. 134.3.1. Outil de cration ........................................................................................................................... 134.3.2. Dplacer le robot .......................................................................................................................... 164.3.3. Utilisation de loutil de mesure .............................................................................................. 214.3.4. Comment exporter le programme au robot...................................................................... 22
CHAPITRE 5 : Langage KAREL .................................................................................................................. 245.1. Cration et utilisation dun programme Karel dans ROBOGUIDE ................................... 245.2. Structure de programmation .......................................................................................................... 25
5.2.1. Structure de base du programme ......................................................................................... 255.2.2. Type de variable prdfinie ..................................................................................................... 295.2.3. Structure de la commande de condition IF ....................................................................... 305.2.4. Structure des boucles ................................................................................................................. 31
5.3. Langage de programmation ............................................................................................................. 325.3.1. Commande de programmation .............................................................................................. 325.3.2. Variables du systme ................................................................................................................. 35
5.4. Exemple de programmes .................................................................................................................. 36CHAPITRE 6 : ANNEXE ................................................................................................................................ 38
6.1. Tutoriel pour ROBOGUIDE ............................................................................................................... 38
6.1.1. Pick and Place ........................................................................................................................... 38CHAPITRE 7 : Erreurs frquentes ........................................................................................................... 45
7.1. Problmes de configuration de lordinateur ............................................................................. 457.1.1. Changer le type de diviseur de dcimale ........................................................................... 457.1.2. Changer lemplacement du fichier de sauvegarde ......................................................... 467.1.3. Appliquer les valeurs DCS ........................................................................................................ 47
7.2. Dboguer le boitier de commande virtuel ................................................................................. 50
5/27/2018 Guide Etudiant
4/56
iv
LISTE DES TABLEAUX
TABLEAU No. 1: Dtails du robot FANUC LR Mate 200iC ................................................................... 6TABLEAU No. 2: Paramtres de Dnavit-Hartenberg du LR-Mate 200IC ..................................... 7TABLEAU No. 3: Lgende des diffrentes fentres du programme ROBOGUIDE ................... 11TABLEAU No. 4: Description des diffrents boutons de ROBOGUIDE ........................................ 11TABLEAU No. 5: Liste des directives du compilateur ........................................................................ 27TABLEAU No. 6: Type de variables possible pour le langage KAREL .......................................... 29TABLEAU No. 7: Liste de quelques commandes du langage KAREL ............................................ 32TABLEAU No. 8: Liste des variables de quelque variable du systme ........................................ 35
5/27/2018 Guide Etudiant
5/56
v
LISTE DES FIGURES
FIGURE No. 1: Dimension du robot FANUC LR Mate 200iC ................................................................ 3
FIGURE No. 2: Vue isomtrique du robot FANUC LR MATE 200iC .................................................. 4FIGURE No. 3: Dimension de la base du robot FANUC LR MATE 200iC ......................................... 4FIGURE No. 4: Dimension du poignet du robot FANUC LR MATE 200iC ....................................... 5FIGURE No. 5: Dimension du contrleur du R-30iC ............................................................................... 5FIGURE No. 6: Axes de rfrence des joints du robot la position initiale .................................. 7FIGURE No. 7: Indpendance du joint 2 ...................................................................................................... 8FIGURE No. 8: Prsentation des diffrentes fentre du programme ROBOGUIDE ................. 10FIGURE No. 9: Navigateur de procd ....................................................................................................... 14FIGURE No. 10: Arborescence .................................................................................................................... 15FIGURE No. 11: Boitier de commande .................................................................................................... 16
FIGURE No. 12: Boutons de dplacement sur le boitier de commande .................................... 17FIGURE No. 13: Option avance pour le dplacement du robot sur ROBOGUIDE ................ 18FIGURE No. 14: Contrle avanc de la manipulation du robot sur ROBODUIDE .................. 19FIGURE No. 15: Barre doutils de coordonnes sur ROBOGUIDE ................................................ 20FIGURE No. 16: Manipulation des joints du robot sur ROBOGUIDE........................................... 20FIGURE No. 17: Barredoutil Move to ................................................................................................. 21FIGURE No. 18: Fentre de loutil de mesure ....................................................................................... 22FIGURE No. 19: Export dun fichier de lordinateur vers le robot tape 1 ............................... 23FIGURE No. 20: Export dun fichier de lordinateur vers le robot etape 2 ............................... 23FIGURE No. 21: Chemin pour ouvrir un nouveau fichier KAREL ................................................. 24FIGURE No. 22: Fentre de lditeur de programme KAREL ......................................................... 25FIGURE No. 23: Outil de manipulation du point fixe du robot ...................................................... 41FIGURE No. 24: Bouton pour rouler un programme ......................................................................... 43FIGURE No. 25: Fentre de region et langue du panneau de configuration ....................... 45FIGURE No. 26: Fentre des options avancs du format des nombres ..................................... 46FIGURE No. 27: Fentre pour changer la trajectoire de sauvegarde des documents sur
ROBOGUIDE ....................................................................................................................... 47FIGURE No. 28: Trajet pour appliquer un DCS tape 1................................................................. 48FIGURE No. 29: Trajet pour appliquer un DCS - tape 2 ................................................................. 48FIGURE No. 30: Appliquer un DCS ............................................................................................................ 49FIGURE No. 31: Confirmation de lapplication du DCS ..................................................................... 50
FIGURE No. 32: Procdure pour le dboguage du boitier de commande virtuel .................. 50
5/27/2018 Guide Etudiant
6/56
vi
LISTES DES EXEMPLES
EXEMPLE No. 1: Structure de base du programme ............................................................................. 26
EXEMPLE No. 2: Structure de la dclaration de constantes ............................................................ 28EXEMPLE No. 3: Structure de la dclaration de type ......................................................................... 28EXEMPLE No. 4: Structure de la rcupration des donnes dune variable situe
lintrieur dune structure ........................................................................................... 28EXEMPLE No. 5: Structure de la dclaration de variables ................................................................ 29EXEMPLE No. 6: Structure de la commande IF ..................................................................................... 31EXEMPLE No. 7: Premire syntaxe dune boucle FOR ....................................................................... 31EXEMPLE No. 8: Deuxime syntaxe dune bouche FOR ..................................................................... 31EXEMPLE No. 9: Syntaxe dune boucle WHILE ..................................................................................... 32EXEMPLE No. 10: Dplacer le robot vers une position prdfinie .................................................. 36
EXEMPLE No. 11: Ajout de nuds dans une variable de type PATH ............................................. 37
5/27/2018 Guide Etudiant
7/56
Introduction | p. 1
CHAPITRE 1 : INTRODUCTION
Les robots sont de plus en plus prsents dans les industries afin daugmenter leur
production et parfois pour augmenter la prcision de certaines manipulations. Ce qui fait durobot un outil trs puissant et utile. Pour assurer une bonne rptabilit et une bonneprcision des manipulations du robot, celui-ci doit tre programm par lutilisateur.
Dans ce guide vous trouverez les informations ncessaires pour faire fonctionner unrobot Fanuc LR Mate 200iC. Plus prcisment, le guide est divis en quatre parties. Il y auratout dabord une prsentation des diffrentes mesures de scurit. Ensuite, il y aura unedescription du robot ainsi que les indications ncessaires pour le dmarrer et le manipuler.Par la suite, il y aura une brve description du logiciel de simulation ROBOGUIDE. Enfin, il yaura une explication des notions de base du langage de programmation KAREL.
De plus, en annexe se trouvent des notions supplmentaires sur le robot rel,
ROBOGUIDE et le langage Karel. Lannexe contient aussi des tutoriels et un rpertoire deserreurs frquentes ainsi que leurs rsolutions.
5/27/2018 Guide Etudiant
8/56
Mesure scurit | p. 2
CHAPITRE 2 : MESURE SCURIT
Avant dutiliser le robot, il est bien important de connatre les mesures de scurit afin
dviter les blessures qui peuvent tre mortelles.
2.1.Prcautions gnrales
Sassurer que tous les dispositifs de scurit sont prsents et actifs
Connatre o sont les arrts durgence
Ne jamais porter de cravate, de collier et dautres bijoux ou vtements pouvantse prendre dans le robot en mouvement, lorsque vous tes dans lenveloppe detravail du robot
Vrifier que lenvironnement de travail soit propre et sans dbris indsirable. Sicest le cas, contactez le technicien ou le professeur pour lui en aviser.
Personne ne doit entrer dans lenveloppe de travail du robot lorsquil est enmarche, sauf pour enseigner des positions de travail. Dans ce cas, seule lapersonne avec le boitier de commande a le droit dentrer dans lenveloppe detravail du robot.
Ne jamais dsactiver un dispositif de scurit
2.2.Prcaution lors de lutilisation du robot en mode manuel
Dplacer le robot vitesse rduite lors des manipulations en mode manuel
Sassurer dtre lextrieur de la cage de suret avant de dplacer le robot.
2.3.Prcaution lors de lutilisation du robot en mode automatique
Pour utiliser le robot en mode automatique, vous devez obligatoirement fermer lesportes de la cage du robot, sinon le robot restera immobile.
Lors de la premire excution dun programme sur le robot rel, veuillez :1. Effectuer la trajectoire tape par tape vitesse rduite.
2.
Effectuer la trajectoire au complet vitesse rduite3. Effectuer la trajectoire au complet vitesse normale
5/27/2018 Guide Etudiant
9/56
Robot rel LR Mate 200iC | p. 3
CHAPITRE 3 : ROBOT REL LR MATE 200IC
3.1.Schma du LR MATE 200IC
FIGURE No. 1: Dimension du robot FANUC LR Mate 200iC
5/27/2018 Guide Etudiant
10/56
Robot rel LR Mate 200iC | p. 4
FIGURE No. 2: Vue isomtrique du robot FANUC LR MATE 200iC
FIGURE No. 3: Dimension de la base du robot FANUC LR MATE 200iC
5/27/2018 Guide Etudiant
11/56
Robot rel LR Mate 200iC | p. 5
FIGURE No. 4: Dimension du poignet du robot FANUC LR MATE 200iC
FIGURE No. 5: Dimension du contrleur du R-30iC
5/27/2018 Guide Etudiant
12/56
Robot rel LR Mate 200iC | p. 6
TABLEAU No. 1: Dtails du robot FANUC LR Mate 200iC
Axes 6
Poids maximal de la charge (kg) 5Rayon de lenveloppe de travailsans outil (mm)
704
Rptabilit (mm) 0.02Rayon dinterfrence (mm) 181
Degr de mallabilit desjoints (degrs)
J1 340
J2 200
J3 388
J4 380
J5 240
J6 720
Vitesse des joints(degrs/sec) J1 350J2 350
J3 400
J4 450
J5 450
J6 720
Moment du poignet (N*m) J4 11.9
J5 11.9
J6 6.7
Inertie de la charge du
poignet (kg*m2)
J4 0.3
J5 0.3J6 0.1
Poids du robot sans charge (kg) 27
3.2.Paramtres de Dnavit-Hartenberg
5/27/2018 Guide Etudiant
13/56
Robot rel LR Mate 200iC | p. 7
FIGURE No. 6: Axes de rfrence des joints du robot la position initiale
TABLEAU No. 2: Paramtres de Dnavit-Hartenberg du LR-Mate 200IC
i ai bi i1 75 0 -90
2 300 0 180
3 75 0 -90
4 0 -320 90
5 0 0 -90
6 0 -80 180
3.2.1.Cas particulier du LR-Mate 200ICLe LR-MATE 200IC ne respecte pas compltement les conventions de Dnavit-
Hartenberg. En effet, la figure ci-dessus montre la position initiale o tous les jointssont mis zro. Pourtant, langle 2, soi langle entre x2 et x3 est de -90. Parconsquent, il y aura toujours un dcalage de -90 entre la valeur conventionnelle de2 et la valeur apparente sur le boitier de commande du robot relle.
5/27/2018 Guide Etudiant
14/56
Robot rel LR Mate 200iC | p. 8
De plus, le joint 2 du robot est indpendant des autres joints. Cest--dire que sile joint 2 change dorientation, le joint 3, 4, 5, 6 vont rester parallles leur positionde dpart, comme le montre la figure ci-dessous
FIGURE No. 7: Indpendance du joint 2
5/27/2018 Guide Etudiant
15/56
Robot rel LR Mate 200iC | p. 9
CHAPITRE 4 : LOGICIEL DE SIMULATION ROBOGUIDE
4.1.Introduction ROBOGUIDE
Le logiciel ROBOGUIDE est spcialement conu pour contrler des robots de marqueFANUC. lintrieur de ce logiciel, il est possible de simuler une cellule de travail et deprogrammer la trajectoire dun robot. Les donnes compiles par le logiciel de simulationpeuvent ensuite tre transfres au robot rel afin deffectuer une tche relle.
Avant de prsenter les notions pour la conception dune cellule de travail et les notionsde la programmation, lenvironnement et la structure de travail du logiciel ROBOGUIDEseront prsents.
De plus, pour approfondir la comprhension au logiciel, un tutoriel est disponible lafin du document, ainsi quune rubrique Erreurs frquentes pour vous dpanner lorsque
certaines erreurs apparaissent lors de lutilisation du programme.
5/27/2018 Guide Etudiant
16/56
4.1.1.Organisation des fentres du programme
FIGURE No. 8: Prsentation des diffrentes fentre du programme ROBOGUIDE
1
23
4
56
7
5/27/2018 Guide Etudiant
17/56
Robot rel LR Mate 200iC | p. 11
TABLEAU No. 3: Lgende des diffrentes fentres du programme ROBOGUIDE
4.2.Tableau synthse des boutons
TABLEAU No. 4: Description des diffrents boutons de ROBOGUIDE
Icne DescriptionCrer un nouveau fichier
Ouvrir un fichier dj existant
Retour larrire (Undo)
Retour lavant (Redo)
Afficher / Masquer la fentre Cell Browser
Afficher / Masquer la fentre Process Navigator
Sauver les informations du systme de ROBOGUIDE
Afficher laide pour la fentre utilise
Excuter le programme MotionPRO
Verrouiller ou dverrouiller loutil UTOOL, ceci permet de bouger le point fixedu robot.
Activer ou dsactiver la rptition de la fonction Move to
Afficher / Masquer la barre doutils rapide pour modifier les coordonns derfrence du robot.
Modifier la vitesse de la trajectoire du robot
Afficher / Masquer la barre doutils rapide pour enregistrer des coordonns dansun programme de simulation.
Ouvrir / Fermer loutil au bout du bras du robot
Afficher / Masquer la barre doutils rapide pour la fonction Move to
Afficher / Masquer la barre doutils rapide pour les TargetsDessiner des nouvelles formes aux pices
Afficher / Masquer lenveloppe de travail du robot
Afficher / Masquer le Teach Panel
Afficher / Masquer les alarmes du robot
Afficher la page ayant les informations du robot
Numro Description1 Barre du menu principal2 Boutons des diffrentes fonctions du programme3 Progress Navigator, le navigateur de progrs
4 Cell Browser, arborescence5 Teach Panel, simulation de la tlcommande du robot.6 Barre dtat, montrant les diffrents programmes et le contrleur slectionn
7workcell, cellule de travail, l o la reprsentation de lenvironnement relest prsente.
5/27/2018 Guide Etudiant
18/56
Robot rel LR Mate 200iC | p. 12
Afficher linvite de commande KAREL
Enregistrer un fichier AVI de lanimation du robot.
Rouler le programme slectionn
Mettre sur pause le programme
Arrter le programme
Rinitialiser un programmeForcer quitter le programme
Manipuler les diffrents joints du robot
Afficher / Masquer la fentre Run Panel
Afficher / Masquer lditeur de position
Afficher / Masquer la fentre doption pour bouger et copier un objet
Afficher les programmes qui sont appels par le programme principale
Zoom +
Zoom -
Zoom de la slectionCentrer la vue sur lobjet slectionn
Changer la direction de la camra
Vue de haut
Vue du ctdroit
Vue de ct gauche
Vue de face
Vue de derrire
Installer un point de vue
Enregistrer le point de vueAfficher les objets en mode filaire
Outil de mesure
Afficher / masquer les options de la souris
4.2.1.Structure de la cellule de travail
Le logiciel ROBOGUIDE organise les lments selon diffrentes catgories :
Le robot
Loutil au bout du bras du robot (End of Arm Tooling) Les pices (Part)
Les fixations (Fixture)
Les obstacles (Obstacle)
4.2.1.1.Le robot
5/27/2018 Guide Etudiant
19/56
Robot rel LR Mate 200iC | p. 13
Llment central de la cellule de travail (WorkCell) est le robot, car lebut ultime du logiciel est de pouvoir contrler un robot. lintrieur de labibliothque du logiciel, il est possible de choisir tous les robots FANUC missur le march. Gnralement, les robots sont fixe la base et sont munis debras pivotant afin deffectuer des manipulations.
4.2.1.2.Loutil au bout du bras du robot (End of Arm Tooling)Un autre lment essentiel est loutil qui se trouve au bout du bras du
robot (End of Arm Tooling), aussi appel EoAT. Loutil fait le lien entre lerobot et les pices (Part), il permet de prendre ou de relcher une pice.
Il y a plusieurs types doutil, en voici quelques exemples : Pince (Grippers) Aspirateur (Vacuum) Torche soudure (weldtorch)
4.2.1.3.Les pices (Part)Les pices sont les lments que lon dsire manipuler avec le robot. Les
pices peuvent tre modlises sur un logiciel 3D comme CATIA et treimportes lintrieur de ROBOGUIDE.
4.2.1.4.Les fixations (Fixture)Pour tre en mesure de prendre ou de dposer une pice dans le logiciel
ROBOGUIDE, la pice doit toujours tre lie avec une fixation. Une fixation,aussi appele fixture en anglais, est un objet sur lequel les pices reposent.
4.2.1.5.Les obstacles (Obstacle)Les obstacles sont les lments qui reprsentent les diffrents objets qui
pourraient interfrer avec la trajectoire du robot. Il est importantdincorporer les obstacles qui sont prsents dans lenvironnement de travailrel lintrieur du logiciel de simulations pour sassurer que le robotnentre pas en collision avec des objets.
4.3.Instruction des commandes
4.3.1.Outil de cration
4.3.1.1.Navigateur de procds (Process navigator)Le navigateur de procds intitul en anglai Process navigator est un
menu o lon retrouve les diffrentes tapes de conception dune cellule detravail. Les tapes sont disposes dans lordre logique de cration.
5/27/2018 Guide Etudiant
20/56
Robot rel LR Mate 200iC | p. 14
FIGURE No. 9: Navigateur de procd
Pour accder au navigateur de procds, vous devez aller dans longletView du menu principal et cliquez sur Navigator. Vous pouvez aussiaccder au navigateur de procds en cliquant directement sur le
bouton .Le navigateur de procds est spar en trois parties :
Define the Cell,
1. Cration dlments pour garnir la cellule de travail, parexemple :
2. Pices3. Outils de robot4. Fixations
Teach TP Programs1. Cration dun programme
Run Production1. Rouler le programme2. Analyser son profil
4.3.1.2.Larborescence (CellBrowser)Larborescence, appele Cell browser en anglais est une fentre o
lon retrouve les diffrents lments et les diffrents programmes de lacellule de travail. Larborescence regroupe les lments comme limage ci-dessous.
5/27/2018 Guide Etudiant
21/56
Robot rel LR Mate 200iC | p. 15
FIGURE No. 10: Arborescence
Pour accder au navigateur de procds, vous devez aller dans longletView du menu principal et cliquez sur Cell Browser. Vous pouvez aussi
accder au navigateur de procds en cliquant directement sur le bouton .De plus, vous pouvez ajouter ou supprimer un lment en choisissant
une des options possibles lorsque vous cliquez droit sur un lment.
4.3.1.3.Boitier de commande (Teach Pendant)
Le boitier de commande appele Teach Pendant en anglais est lareproduction quelques dtails prs de la tlcommande relle du robot.Avec la tlcommande, il est possible de dplacer le robot et de programmerune trajectoire.
5/27/2018 Guide Etudiant
22/56
Robot rel LR Mate 200iC | p. 16
FIGURE No. 11: Boitier de commande
Pour accder la fentre de la tlcommande virtuelle, vous devez
cliquer sur le bouton .Lutilisation de Teach Pendant sera explique plus loin dans le
document.
4.3.2.Dplacer le robot
4.3.2.1.Dplacer le robot avec le botier de commande (TeachPendant)
Pour dplacer le robot laide du botier de commande, vous devezpremirement lactiver en cliquant sur le bouton ON. Deuximement, vousdevez cliquer sur un des boutons encadrs ci-dessous tout en maintenant latouche shift enfonce. Lorsque vous dplacez le robot laide de ces
commandes vous vous apercevrez que vous faites une rotation des diffrentsjoints du robot.
Pour changer le systme de coordonnes, il faut cliquer sur COORD.Les choix de systme de coordonn sont : JOINT, S/JGFRM, S/WORLD,S/TOOL, S/USER.
5/27/2018 Guide Etudiant
23/56
Robot rel LR Mate 200iC | p. 17
FIGURE No. 12: Boutons de dplacement sur le boitier de commande
Pour viter de toujours appuyer la touche shift pour changer laposition du robot, il est possible de changer les options pour que la toucheshift soit active automatiquement si on clique sur un des boutonsencadrs ci-dessus. Pour activer cette option, vous devez aller dans Toolsdans le menu principal et cliquez sur option. Une fentre apparaitra etvous devez cocher loption Jog keys automatically apply the SHIFT keycomme montre ci-dessous.
5/27/2018 Guide Etudiant
24/56
Robot rel LR Mate 200iC | p. 18
FIGURE No. 13: Option avance pour le dplacement du robot sur ROBOGUIDE
Vous pouvez connatre lorientation des diffrents joints lorsque vouscliquez sur longlet Current Position situ au bas de la tlcommande. Sivous slectionnez X,Y,Z au lieu de Joint vous obtiendrez les coordonnescartsiennes du TeachTool par rapport lorigine du robot. Si vousslectionnez USER vous obtenez les coordonnes du TeachTool parrapport un UFrame slectionn, comme le montre la figure ci-dessous.
5/27/2018 Guide Etudiant
25/56
Robot rel LR Mate 200iC | p. 19
FIGURE No. 14: Contrle avanc de la manipulation du robot sur ROBODUIDE
Vous pouvez aussi dplacer le robot relativement de la position actuelleen cliquant le bouton Relative. Si vous choisissez loption Tool, vousmodifiez lemplacement du TeachTool relativement au positionnementactuel de loutil. Si vous choisissez loption Joint, vous pouvez diminuer ouaugmenter langle des joints. Si vous choisissez loption X,Y,Z, vousmodifiez lemplacement du TeachTool relativement lorigine du robot.Finalement, si vous choisissez USER, vous modifiez lemplacement duUTool relativement un UFrame slectionn.
4.3.2.2.Dplacer le robot avec loutil TeachToolVous pouvez dplacer le robot en glissant manuellement le
TeachTool, reprsent par une boule verte. Pour ce faire, vous devez
cliquer sur le bouton afin dafficher les axes du TeachTool. Ensuite,vous pouvez dplacer la boule verte en glissant la souris sur ses axes. Il estaussi possible de changer lorientation du TeachTool en maintenant latouche SHIFT enfonce et en glissant la souris sur ses axes. De plus, il estaussi possible de bouger librement la boule verte en maintenant la touche
Ctrl enfonce ,tout en cliquant sur le TeachTool et tout en dplaant lasouris.
Vous pouvez changer le point de rfrence de dplacement en cliquant
sur le bouton . Une fentre apparatra comme montre ci-dessous. Cecivous donnera loption de choisir lorigine (World), loutil (Tool), lutilisateur(User), les joints (Joints) comme lment de rfrence pour le dplacement.
5/27/2018 Guide Etudiant
26/56
Robot rel LR Mate 200iC | p. 20
FIGURE No. 15: Barre doutils de coordonnes sur ROBOGUIDE
ATTENTION. Si le robot ne se dplace pas lendroit o vous avez bougle TeachTool cest peut-tre, parce que le point est hors de la porte durobot, ou bien que votre axe Z soit orient dans la mauvaise direction.
4.3.2.3.Dplacer le robot laide des jointsVous pouvez dplacer le robot en modifiant manuellement lorientation
des joints. Pour ce faire, vous devez cliquer sur le bouton et ensuiteglisser votre souris sur les diffrents joints du robot comme montr ci-dessous.
FIGURE No. 16: Manipulation des joints du robot sur ROBOGUIDE
5/27/2018 Guide Etudiant
27/56
Robot rel LR Mate 200iC | p. 21
4.3.2.4.Dplacer le robot automatiquement laide de loutilMove to
Il est possible de dplacer le robot automatiquement laide de loutil
Move to. Pour ce faire, vous devez cliquer sur le bouton . Une fentre,
comme limage ci-dessous, apparaitra. Vous avez dans cette fentre loptionde diriger votre TeachTool sur une face (Face), un ct (Edge), un coin(Vertex), un arc de cercle (Arc Ctr) ou une pice (Part).
FIGURE No. 17: Barredoutil Move to
Pour utiliser cet outil, vous devez tout dabord slectionner une desoptions mentionnes ci-dessus, ensuite vous devez cliquer sur une rgion devotre cellule de travail qui correspond lendroit o vous voulez dplacer lebout du bras du robot.
4.3.3.Utilisation de loutil de mesure
Pour accder loutil de mesure vous devez cliquez sur le bouton . Unefentre contenant les options de mesures comme montres sur la figure ci-dessoussouvrira.
5/27/2018 Guide Etudiant
28/56
Robot rel LR Mate 200iC | p. 22
FIGURE No. 18: Fentre de loutil de mesure
Pour mesurer la distance entre deux objets ou la longueur dune pice, il fautpremirement cliquer le bouton From et ensuite slectionn le type de surfaceque vous dsirez slectionner : face, ct, arrte, centre dune face ou le centre dunct. Aprs, vous devez slectionner lendroit o vous dsirez positionner le pointinitial de la mesure.
Pour choisir le point final de la mesure, vous devez rpter les tapesmentionnes prcdemment en choisissant les caractristiques dsires pour lepoint final et en cliquant ensuite sur la position du point final.
4.3.4.Comment exporter le programme au robot
Pour exporter un fichier vers le robot rel, vous devez premirement cliquerdroit sur le fichier en question et ensuite cliquer sur Export/To Robot comme lemontre la figure ci-dessous.
5/27/2018 Guide Etudiant
29/56
Robot rel LR Mate 200iC | p. 23
FIGURE No. 19: Export dun fichier de lordinateur vers le robot tape 1
Une fentre, comme le montre la figure ci-dessous, apparatra. Il vous devrez, sice nest dj pas fait, slectionner le robot vers lequel vous voulez exporter le robot.
Finalement, vous devez cliquer sur Export et le fichier devrait normalement treenvoy au robot.
FIGURE No. 20: Export dun fichier de lordinateur vers le robot etape 2
5/27/2018 Guide Etudiant
30/56
Langage KAREL | p. 24
CHAPITRE 5 : LANGAGE KAREL
Le langage de programmation KAREL est un langage spcialement cr pour les robots
FANUC. Si vous avez dj programm en PASCAL vous verrez plusieurs ressemblances dansla structure de programmation.
Afin de maitriser le langage KAREL, ce chapitre comportera plusieurs sections :
Cration et utilisation dun programme KAREL dans ROBOGUIDE
Structure de programmation
Commandes de programmation
Exemple de programme
5.1.Cration et utilisation dun programme Karel dans ROBOGUIDE
Le programme KAREL peut tre crit lintrieur du programme ROBOGUIDE. En effet,un diteur pour KAREL est incorpor lintrieur du programme ROBOGUIDE.
Pour ouvrir un nouveau fichier KAREL il faut aller dans le file browser et cliquezdroit sur file et slectionnez New file et cliquez sur KAREL source (.kl) comme lemontre la figure NO ci-dessous.
FIGURE No. 21: Chemin pour ouvrir un nouveau fichier KAREL
Ceci fait lditeur de programmation KAREL souvrira, comme le montre la figure ci-dessous.
5/27/2018 Guide Etudiant
31/56
Langage KAREL | p. 25
FIGURE No. 22: Fentre de lditeur de programme KAREL
Un fichier dextension .kl est alors cr. Par dfaut le nom du fichier est untitle1.kl.
Vous pouvez changer le nom du fichier en cliquant sur le bouton . Vous pouvez aussi
compiler le programme que vous avez crit en cliquant sur le bouton . Lorsque vouscompilez le programme, un fichier dextension .pc ayant le mme nom que votre fichierdextension .kl sera cr. Le fichier dextension .pc est le fichier qui est lu par lecontrleur du robot.
Pour excuter le programme dans le logiciel de simulation de ROBOGUIDE afin de voirle robot boug sur lcran, il faut passer par le boitier de commande virtuelle. La procdureest la suivante :
Allumer le botier de commande en cliquant sur ON
Allez dans le rpertoire des programmes en cliquant sur Select
Choisir le programme dsir ayant le nom du programme dsir etappuyer sur la touche ENTER. Le programme sera maintenantslectionn.
Maintenez appuyer la touche shift tout en cliquant sur le boutonFWD pour excuter le programme.
Le programme devrait maintenant dmarrer sil ny a pas derreur.
5.2.Structure de programmation
5.2.1.Structure de base du programme
5/27/2018 Guide Etudiant
32/56
Langage KAREL | p. 26
EXEMPLE No. 1: Structure de base du programmePROGRAM nom_fichier
Directive du compilateur
CONSTDclaration de constantes
TYPE
Dclaration de types
VAR
Dclaration de variables
BEGIN
noncs excutablesEND nom_fichier
5.2.1.1.Directive du compilateurLes directives du compilateur servent diriger la compilation du
programme. Plus prcisment ils servent :
Inclure dautre fichier dans le programme lors de lacompilation
Spcifier le programme et lattribut des tches
5/27/2018 Guide Etudiant
33/56
Langage KAREL | p. 27
TABLEAU No. 5: Liste des directives du compilateur
Directive Description
%ALPHABETIZESpecifies that variables will be created in alphabetical orderwhen p-code is loaded.
%CMOSVARSSpecifies the default storage for KAREL variables isCMOS RAM.
%CMOS2SHADOWInstructs the translator to put all CMOS variables inSHADOW memory.
%COMMENT =
comment
Specifies a comment of up to 16 characters. During loadtime, the comment is stored as a program attribute and can
be displayed on the SELECT screen of the teach pendant or
CRT/KB.
%CRTDEVICE
Specifies that the CRT/KB user window will be the default
in the READ and WRITE statements instead of the
TPDISPLAY window.
%DEFGROUP = nSpecifies the default motion group to be used by the
translator.
%DELAYSpecifies the amount of time the program will be delayed
out of every 250 milliseconds.
%ENVIRONMENT
filename
Used by the off-line translator to specify that a particular
environment file should be loaded.
%INCLUDE filename Specifies files to insert into a program at translation time.
%LOCKGROUP =n,n Specifies the motion group(s) locked by this task.
%NOABORT = optionSpecifies a set of conditions which will be prevented from
aborting the program.%NOBUSYLAMP Specifies that the busy lamp will be OFF during execution.
%NOLOCKGROUP Specifies that no motion groups will be locked by this task.
%NOPAUSE = optionSpecifies a set of conditions which will be prevented from
pausing the program.
%NOPAUSESHFTSpecifies that the task is not paused if the teach pendant
shift key is released.
%PRIORITY = n Specifies the task priority.
%SHADOWVARSSpecifies that all variables by default are created inSHADOW.
%STACKSIZE = n Specifies the stack size in long words.
%TIMESLICE = nSupports round-robin type time slicing for tasks with the
same priority.
%TPMOTIONSpecifies that task motion is enabled only when the teach
pendant is enabled.
%UNINITVARS Specifies that all variables are by default uninitialized.
5/27/2018 Guide Etudiant
34/56
Langage KAREL | p. 28
5.2.1.2.Dclaration de constantesLa dclaration de constantes est utile si vous rutilisez souvent une
mme valeur dans un programme et que vous ne voulez pas la changer tous les endroits o celle-ci est utilise lorsque vous voulez la modifier. Eneffet, vous aurez seulement changer la valeur de la constante dans la balise
CONST et la valeur sera traduite tous les endroits o vous avez appel laconstante. Lexemple ci-dessous prsente la structure de la dclaration deconstante.
EXEMPLE No. 2: Structure de la dclaration de constantesCONST
larg_table = 500
long_table = 200
haut_table = 100
5.2.1.3.Dclaration de typeLes types servent regrouper plusieurs variables ensemble afin de
mieux les structurer. La structure de la dclaration de type est montre danslexemple ci-dessous.
EXEMPLE No. 3: Structure de la dclaration de typeTYPE
new_type_name = STRUCTURE
field_name_1 : type_name_1
field_name_2: type_name_2
...ENDSTRUCTURE
Pour rcuprer les donnes dans la structure, il suffit dappeler lastructure suivie de la variable dsire sparer par un point . , commemontr dans lexemple NO. 4.
EXEMPLE No. 4: Structure de la rcupration des donnes dune variable situe lintrieur dune structure
var_name = new_type_name.field_name_1
5.2.1.4.Dclaration de variablesPour utiliser des variables lintrieur dun programme KAREL il faut
pralablement les dfinir. Lexemple suivant montre la structure de ladclaration dune variable.
5/27/2018 Guide Etudiant
35/56
Langage KAREL | p. 29
EXEMPLE No. 5: Structure de la dclaration de variablesVAR
I, length : INTEGER
p1, p2, p3, : POSITION
c : CONFIG
5.2.2.Type de variable prdfinieDans un programme il y a plusieurs types de variable. Elles ont chacune leur
utilit et leur tendue, comme le montre le tableau ci-dessous.
TABLEAU No. 6: Type de variables possible pour le langage KAREL
Type de variable Description tendue
BOOLEAN True, false
INTEGER Nombre entier [-2147483648 ; +2147483646]
REAL Nombre rel [-3,4028236E+38; -1,175494E-38]
[0,0] [1,175494E-38;3,4028236E+38] R
STRING Chaine de caractre 0 254 caractres
VECTOR VecteurCompos de trois valeursrelles
VECTOR = STRUCTUREX : REALY : REAL
Z : REALENDSTRUCTURE
X : Y : Z : [-3,4028236E+38; -1,175494E-38] [0,0] [1,175494E-38; 3,4028236E+38] R
ARRAY Le type de variable que letableau ARRAY contient est spcifierEx :JPOS : ARRAY[6] OF REAL
Min : ARRAY [1]Max : ARRAY[32767]
CONFIG Configuration du robot
CFG_FLIP : BOOLEANCFG_LEFT : BOOLEANCFG_UP : BOOLEANCFG_TURN_NO1 : INTEGERCFG_TURN_NO2 : INTEGERCFG_TURN_NO3: INTEGER
CFG_FLIP : R ou LCFG_LEFT :U ou D
CFG_UP :N ou FCFG_TURN_NO1 :[-8 ; 6] ECFG_TURN_NO2 :[-8 ; 6] ECFG_TURN_NO3: [-8 ; 6] E
XYZWPR Spcifie la positioncartsienne du UTOOL.
5/27/2018 Guide Etudiant
36/56
Langage KAREL | p. 30
XYZWPR = STRUCTUREX: REALY: REALZ: REAL
W: REALP: REALR: REALCONFIG_DATA: CONFIGENDSTRUCTURE
POSITION Matrice contenant le vecteurnormal, dorientation,dapproche et de localisation,ainsi que la configuration du
robot.
POSITION = STRUCTURENORMAL : VECTORORIENT : VECTOR
APPROACH : VECTORLOCATION : VECTORCONFIG_DATA : CONFIG
ENDSTRUCTURE
JOINTPOS Reprsentation de la position
en une matrice contenant lesangles des axes du robot.Les angles sont exprims endegr.
JOINTPOS1 : 1 degr de libert
JOINTPOS2 : 2 degrs de libertJOINTPOS3 : 3 degrs de libertJOINTPOS4 : 4 degrs de libertJOINTPOS5 : 5 degrs de libertJOINTPOS6 : 6 degrs de libertJOINTPOS7 : 7 degrs de libertJOINTPOS8 : 8 degrs de libertJOINTPOS9 : 9 degrs de libert
PATH Trajet constitu de plusieursnuds (nodes)
5.2.3.Structure de la commande de condition IFLa commande IF est une des commandes les plus utiles en programmation. Elle
permet de faire des choix selon la condition nonce. La condition peut-trerencontre ou pas. Si elle est rencontre, les noncs rattachs la commande THEN
5/27/2018 Guide Etudiant
37/56
Langage KAREL | p. 31
seront excuts, sinon, les noncs rattachs la commande ESLE seront excuts.Lexemple qui suit montre la structure de la commande IF.
EXEMPLE No. 6: Structure de la commande IFIF variable > 10
THENMOVE TO p1
ELSE
MOVE TO p2
ENDIF
Il nest pas obligatoire dutiliser la commande ELSE lintrieur de lacommande IF. Si elle est absente de la commande If, les noncs qui ne seront pasrencontrs par la condition seront tout simplement ignors.
5.2.4.Structure des boucles
5.2.4.1.Boucle FORLa boucle FOR est une rptition dfinie, c'est--dire que le nombre de
rptitions est connu et fixe.
EXEMPLE No. 7: Premire syntaxe dune boucle FORFOR variable = a TO b DO
InstructionsENDFOR
EXEMPLE No. 8: Deuxime syntaxe dune bouche FORFOR variable = b DOWNTO a DO
InstructionsENDFOR
La variable indique dans la boucle FOR doit faire partie du typeINTEGER.
Lexemple No. 7 montre une boucle FOR qui incrmentera la variable de1 chaque rptition. Par contre, lexemple No. 8 prsente plutt une boucle
FOR qui dcrmente la variable de 1 chaque rptition.
5.2.4.2.Boucle WHILELa boucle WHILE est une boucle indfinie, car le nombre de rptitions
dpend de la condition spcifier par le programmeur.
5/27/2018 Guide Etudiant
38/56
Langage KAREL | p. 32
EXEMPLE No. 9: Syntaxe dune boucle WHILEWHILE conditionDOInstructionsENDWHILE
5.3.Langage de programmation
5.3.1.Commande de programmation
TABLEAU No. 7: Liste de quelques commandes du langage KAREL
Nom de la commande Description Exemple
APPEND_NODE Insert un nud la suitedu dernier nud dunevariable de type PATH
VARlength, I : INTEGERpath1 : PATH
BEGINlength = PATH_LEN(path1)
FOR I = 1 TO longueur DOMOVE AXIS 4 BY 1APPEND_NODE(path1, 6)path1[i].node_pos= CURPOS(1,5,1)ENDFOREND
CLOSE FILE Permets de dissocier lefichier ouvert
prcdemment de lavariable du type FILE
CLOSE FILE fichier1
CLOSE HAND Permets de fermer lespinces du robot.
Le chiffre aprs lacommande correspond aunumro du RobotOutput auquel les pincessont relies.
CLOSE HAND 1
5/27/2018 Guide Etudiant
39/56
Langage KAREL | p. 33
CURPOS Retourne la positionactuelle du TCP
Syntaxe :CURPOS (axis_limit_mask,
ovr_trv_mask, group_no)Axis_limit_mask : [1 ; 6]*Ovr_trv_mask : [1 ; 6]*
*Dans cette version,cescommandes sontignores
CURPOSE (1,5,1)
MOVE ABOUT Permets une rotation duTCP autour dun vecteurspcifier en restant aux
mmes coordonnes
VARvector_1 : VECTORpos_1 : POSITION
BEGINMOVE TO pos_1vector_1 = ORIENT(pos_1)
MOVE ABOUT pos_1 BY 30END
MOVE AWAY Permets dloigner le TCPdun objet en reculant leTCP selon son axe des Zngatif
BEGINMOVE AWAY 50
END
MOVE AXIS Permets de changer
lorientation dun des axesdu robot
BEGIN
MOVE AXIS 3 BY 45END
MOVE NEAR Permets de dplacer leTCP prs de la positionspcifie, soit par unedistance spcifie selonlaxe des Z ngatif du TCP
VARpos_1 : POSITONBEGIN
MOVE NEAR pos_1 BY 60END
MOVE TO Dplace le TCP lacoordonne spcifie. Lavariable utilise par cettefonction peut tre detype : POSITON, XYZWPR,XYZWPREXT, JOINTPOS
VARcord : XYZWPRJPOS : JOINTPOSBEGIN
MOVE TO cordMOVE TO JPOSEND
5/27/2018 Guide Etudiant
40/56
Langage KAREL | p. 34
OPEN FILE Permets de lier un fichierextrieur une variabledu type FILE
Syntaxe :
OPEN FILE variable(attribut, nom_fichier)
Attribut :
RO : Lectureseulement
RW : Lecture etcriture
AP : Ajouter desdonnes un fichier
dj existant UD : Mise jour de
donnes
OPEN FILE fichier1 (RW,test.txt)
OPEN HAND Permets douvrir lespinces du robot
Le chiffre aprs lacommande correspond aunumro du RobotOutput auquel les pinces
sont relies.
OPEN HAND 1
PATH_LEN Dtermine le nombre denuds dans une variablePATH
VARp_len : INTEGERBEGINp_len = PATHLEN(parcour)END
PATHPOS Retourne la position dunnud
VARp_len, l : INTEGERBEGINp_len = PATHLEN(parcour)
FOR I = 1 TO p_len DO
ENDFOREND
5/27/2018 Guide Etudiant
41/56
Langage KAREL | p. 35
POS Retourne les donnescartsiennes et laconfiguration du bras durobot une variable dutype POSITION
VARp1 : POSITIONc : CONFIGBEGINCNV_STR_CONF(NUT, 0 ,0,0,c, 0)
p1 = POS(450, 0, 450, 0, 0, 0, c)MOVE TO p1
END
READ Permets de lire desdonnes
WRITE Permets dcrire desdonnes
5.3.2.Variables du systme
TABLEAU No. 8: Liste des variables de quelque variable du systmeNom de la variable Description Exemple
$GROUP[n].$termtype Permets de changer le type determinaison pour un groupe[n]Les valeurs possibles sont1 = fine2 = coarse3 = nosset4 = nodecel
5 = vardecel
$GROUP[1].$termtype = 2$GROUP[3].$termtype = 1
$GROUP[n].$motype Permets de changer le type demouvement pour un groupe[n]Les valeurs possibles sont6 = joint7 = linear8 = circular
$GROUP[1].$motype = 7
$MOTYPE Permets de changer le type demouvement pour tous les
groupesLes valeurs possibles sont6 = joint7 = linear8 = circular
$motype =6
5/27/2018 Guide Etudiant
42/56
Langage KAREL | p. 36
$SPEED Spcifie une vitessecartsienne en mm/sec aurobotValeur varie entre 0 2000mm/sec
$speed = 1000
$TERMTYPE Permets de changer le type determinaison pour tous lesgroupesLes valeurs possibles sont1 = fine2 = coarse3 = nosset4 = nodecel5 = vardecel
$TERMTYPE = 2
$UFRAME Transformation du rfrentiel
de la cellule (UFRAME) parrapport celui du robot.
$UTOOL Transformation du rfrentielde leffecteur (TCP) parrapport celui du poignet durobot.
5.4.Exemple de programmes
EXEMPLE No. 10: Dplacer le robot vers une position prdfinie
Dplacer le robot vers de coordonnes prdfinisPROGRAM dec_const
CONST --dclaration des constanteslarg_table = 500long_table = 200haut_table = 1
VAR --dclaration des variablesp1 : POSITIONc : CONFIG
BEGIN
CNV_STR_CONF(N U T, 0, 0, 0, c, 0) -- converti un variable--STRING en-- variable CONFIG
p1 = POS(larg_table, long_table, haut_table, 180, 0, 0, c) -- assigne les--coordonnes du--point p1
MOVE TO p1 -- bouge le robot la position
5/27/2018 Guide Etudiant
43/56
Langage KAREL | p. 37
p1END dec_const
EXEMPLE No. 11: Ajout de nuds dans une variable de type PATHPROGRAM test_pht_2VAR
length, I : INTEGERp1 : XYZWPRc : CONFIGpath1 : PATHlongueur : INTEGERfichier1 : FILE
BEGIN
CNV_STR_CONF('NUT, 0, 0,0', c, 0) --initialisation de la variable cp1 = POS(475,-190,375,-180,-90,0,c) --initialisation de la position p1MOVE TO p1 --dplacement vers la position p1length = PATH_LEN(path1) --dtermine le nombre de noeudslongueur = 30 --initialisation de la variable longueurFOR I= length DOWNTO 1 DO
DELETE_NODE(path1, I, 6) --supprime tous les anciens nudsENDFORFOR I = 1 TO longueur DO
MOVE AXIS 4 BY 1 --bougelaxe 4 de 1 degr
APPEND_NODE(path1, 6) --ajoute un nud au PATHpath1[i].node_pos= CURPOS(4,1,1) --enregistre la position actuelle au--noeud
ENDFOREND test_pht_2
5/27/2018 Guide Etudiant
44/56
Langage KAREL | p. 38
CHAPITRE 6 : ANNEXE
6.1.Tutoriel pour ROBOGUIDE
6.1.1.Pick and Place
Ce tutoriel vous guidera pas pas pour crer un environnement virtuel quisimulera la trajectoire dun robot lors dune manipulation Pick and place
Ouverture du fichier1. Ouvrez le logiciel ROBOGUIDE2. Allez dans fichier du menu suprieur du programme et cliquer
sur New Cell, une fentre apparatra3. Slectionnez le logiciel HandlingPRO et cliquez sur Next
4. Donner un nom au fichier, par exemple : tutoriel_PAP. Ensuite,cliquer sur Next
5. Cliquez Next encore et encore, jusqua ce que vous voyez la listedes diffrents robots
6. Choisissez le robot LR Mate 200iC et cliquez Next7. Cliquez Next jusqu' la fin et ensuite cliquez Finish8. Vous devriez alors avoir une cellule de travail avec le robot.
Modifier les paramtres du robot1. Allez dans View du menu suprieur du programme et cliquez
sur Navigator sil nest pas dj slectionn. Une petite fentre
appele Process Navigator souvrira.2. lintrieur de la section Define the Cell du Process
Navigator cliqu sur dit Robot Properties, une fentre avecles proprits du robot souvrira
3. lintrieur de cette fentre, il est possible de modifier lalocalisation du robot, mais dans le cadre de ce tutoriel nouslaisserons le robot lorigine.
4. Cocher Lock All Location Values pour fixer la position du robotet cliquez sur OK
Ajouter une pice (Part)
1. lintrieur de la section Define the Cell du ProcessNavigator cliqu sur Add a Part to the Cell, une fentre avecdiffrente option concernant la nature de la pice souvrira.
2. Dans le cadre de ce tutoriel, slectionnez Box Primitive Modelet cliquez sur OK. Une fentre avec les proprits de la piceapparatra.
3. Donnez un nom la pice, par exemple : cube
5/27/2018 Guide Etudiant
45/56
Langage KAREL | p. 39
4. Vous pouvez modifier la couleur du cube en cliquant sur la palettede couleur
5. Dans le champ Mass changer la masse pour 3 kg, car le robotpeut supporter un maximum de 5 kg en incluant la masse de lapince.
6. Dans les champs Size changez les dimensions pour 29 mm7. Cliquez sur OK, vous devriez avoir une plateforme (PartRack)
surmonte de la pice situe ct du robot.
Ajouter un outil au bout du bras du robot (EoAT)1. lintrieur de la section Define the Cell du Process
Navigator cliquez sur Edit End of Arm Tooling, une fentre desproprits de loutil souvrira.
2. Donnez un nom loutil en changeant le champ Name, parexemple : pince.
3. Importer un outil dj existant en cliquant sur le dossier ct du
champ CAD File, une fentre pour parcourir le fichier souvrira4. Aller dans EOATs/grippers et slectionnez le fichier 36005f-
200.IGS et cliquez ouvrir5. Changez la masse de la pince pour 2 kg en modifiant le champ
Mass6. Modifiez lchelle de la pice pour 0,2, en modifiant les champs
Scale, afin de donner une taille de pince proportionnelle aurobot. Ensuite, cliquez sur OK
7. Vous vous apercevrez que la pince nest pas installecorrectement. Pour corriger la situation, double-cliquez sur lapince pour faire apparaitre les proprits de loutil et changer lavaleur du champ W pour 270. Ceci effectuera une rotationautour de laxe des x de 270. Ensuite, cliquez sur Apply.
8. Il faut maintenant modifier le point de contact du robot avec lapice. Pour ce faire, cliquez sur longlet UTOOL des propritsde la pince et cochez Edit UTOOL.
9. Vous pouvez maintenant entrer les valeurs de la position du pointde contact par rapport au rfrentiel situ lextrmit du brasdu robot. Dans le cadre de cet exemple, entrez la valeur 170 dansle champ Z et cliquez sur Apply. La sphre verte devraitmaintenant se situer au point de contact des pinces
10.Il faut maintenant dterminer lemplacement de la pice lorsquele robot prendra la pice. Pour ce faire, aller dans longlet Partsdes proprits de la pince et slectionn sur la pice voulue (cubepour ce tutoriel) et cliquez Apply.
11.Dans le mme onglet, cocher Edit Part Offset. Vous pouvezmaintenant modifier la position de la pice par rapport aurfrentiel situ lextrmit du bras du robot. Dans le cadre de
5/27/2018 Guide Etudiant
46/56
Langage KAREL | p. 40
cetexemple, entrez les valeurs X=0, Y=-187.06, Z=0, W=90, P=R=0.Ensuite, cliquez sur Apply. Vous vous apercevrez que la picedisparaitra de la pince du robot, cest normal.
12.Maintenant il faut dterminer linteraction de la pince lors de lasimulation. Pour ce faire, allez dans longlet Simulation des
proprits de la pince et slectionnez la pice dsir. Ensuiteslectionnez Material Handling Clamp pour le champfunction et choisissez le fichier 36005f-200-4.IGS danstrajectoire EOATs/grippers en cliquant sur le fichier ct duchamp Actuated CAD. Cliquez OK.
Ajout une fixation (fixture) pour la position pick1. Pour rajouter une fixation, cliquez droit sur fixation dans le Cell
Browser, allez dans AddFixture et choisissez une option. Dansle cadre de cet exemple, choisissez CAD Library. Une fentreavec la librairie des fixations souvrira.
2. Cliquez le petit + gauche de Fixture pour avoir la liste detous les types de fixation. Aux fins de ce tutoriel, choisissez lefichier shelf04 et cliquez OK. Une fentre souvrira avec lesproprits de la fixation.
3. Donnez un nom la fixation en modifiant le champ Name, parexemple : SHELF.
4. Changez lchelle de la fixation en changeant les Scales pour 0.8et changez la localisation de la pice pour X=-600, Y=200, Z=W=P= R=0. Ensuite, cliquez sur Apply.
5. Configurez la pice sur la fixation en allant dans longlet Partsdes proprits de la fixation, slectionnez la pice dsire, soitcube et cliquez sur Apply.
6. Dans le mme onglet, cocher Edit Part Offset pour modifier lalocalisation de la pice sur la fixation. Dans le cadre de ce tutoriel,entrez les valeurs X=160, Y=160, Z=510, W=-90, P=0, R=90.Ensuite, cliquez sur Apply
7. Modifier les paramtres de simulation en allant dans longletSimulation des proprits de la fixation et cliquez sur la picedsire, soit cube pour ce tutoriel. Ensuite, cochez le champAllow part to be picked pour autoriser le programme prendreune pice sur la fixation. Ensuite, cliquez sur Apply et ensuite OK.
Ajout une fixation (fixture) pour la position place1. Les tapes sont sensiblement les mmes que la cration de la
fixation prcdente. Par contre, cette fixation sera spcialementconfigure pour permettre le dpt dune pice.
2. Crez une nouvelle fixation, mais au lieu choisir loption CADLibrary cliquez plutt sur Box
5/27/2018 Guide Etudiant
47/56
Langage KAREL | p. 41
3. Renommez la fixation pour BOX, changez les dimensions pourX=Y=Z=200 et changez la localisation pour X=400, Y=-300, Z=200,W=P=R=0. Ensuite, cliquez sur Apply.
4. Configurez les paramtres de la pice en allant dans longletParts et en slectionnant la pice Cube. Ensuite, cliquez
Apply. Cocher les champs Edit Part Offset et entrer X=Y=0,Z=14.58, W=-90, P=0, R=-90. Ensuite, cliquez sur Apply.
5. Configurez les paramtres de simulation en allant dans longletSimulation. Slectionne la pice cube et cochez le champAllow part to be placed. Ensuite, cliquez sur Apply et OK.
Programme de simulation Pick1. Pour crer un nouveau programme de simulation, cliquez droit
sur programs dans le Cell Browser et cliquez sur Addsimulation program. Une fentre de proprit pour leprogramme apparaitra.
2. Modifiez le nom pour PICK et cliquez Apply ensuite OK. Voustomberez alors sur la fentre ddition pour le programme desimulation.
3. Bouger le point fixe du robot (la balle verte) prs de la pice sur lafixation Shelf. Pour bouger le point fixe en glissant la souris surses axes aprs avoir cliqu le bouton des options principales duprogramme ROBOGUIDE.
FIGURE No. 23: Outil de manipulation du point fixe du robot
4. Dans la fentre du programme de simulation, cliquez surRecord pour enregistrer les coordonnes du robot. Une ligne deprogramme sajoutera.
5. Dans la ligne de programme, changer loption L (linear) pourJ (joint), le robot suivra alors un trajet circulaire pour atteindrece point.
6. Changer loption Fine pour CNT100 si ce nest dj pas fait.Ceci indiquera au robot pass par ce point sans y arrter.
7. Bouger ensuite le robot sur la pice. Pour que les pinces soitexactement lendroit de la pice, double cliquez sur la fixationSHELF allez dans longlet Parts et cliquez sur Move to. Lapince du robot se dplacera automatiquement sur la pice.
8. Cliquez sur Record dans menu du programme de simulation.Ensuite, mettez un mouvement linaire L et mettez unmouvement Fine la nouvelle ligne de programme cr.
5/27/2018 Guide Etudiant
48/56
Langage KAREL | p. 42
9. Dplacez les pinces hors du champ de la pice et cliqu encore surrecord.
10.Ensuite, changer les paramtres de la ligne de programme pourJ et CNT100
11.Slectionn la ligne juste aprs laction o la pice est prise, soit la
ligne 3 dans ce cas. Ensuite, cliqu la flche du bouton Inst dumenu du programme de simulation et cliqu sur Pickup. Unenouvelle ligne de programme se crera en dessous de la ligne 2.
12.Pour cette ligne de programme, choisissez la pice prise par lespinces, soit cube et slectionnez la fixation et loutil utilis.
13.Slectionne la ligne de programme aprs la commande Pickupet cliquez sur la flche du bouton Inst puis slectionner surPAYLOAD[1]. Une ligne de programme apparatra aprs lacommande Pickup. La commande PAYLOAD servira indiquer le poids supplmentaire que le robot doit soulever
lorsquil ramasse lobjet.14.Cliquez sur X pour fermer la fentre du programme de simulation.
Programme de simulation Place1. Le programme de simulation Place se construira sensiblement
de la mme manire que le programme Pick.2. Cliquez droit sur programs dans le Cell Browser et cliquez
sur Add simulation program. Une fentre de proprit pour leprogramme apparaitra.
3. Modifiez le nom pour PLACE et cliquez Apply ensuite OK.4. Bouger le point fixe du robot prs de la pice sur la fixation
BOX.5. Cliquez sur Record pour enregistrer les coordonnes du robot.6. Changer les paramtres de la ligne de programme pour J et
CNT1007. Dplacez les pinces du robot sur la pice de la fixation BOX en
utilisant la commande Move to8. Cliquez su Record et insrez les paramtres L et Fine.9. Bouger les pinces hors de la porte de la pice.10.Cliquez sur Record et insrez les paramtres J et CNT100.11.Slectionnez la ligne de programme aprs avoir dpos la pice.12.Insrez la commande Drop en cliquant sur la flche du bouton
Inst13.Dans la ligne de programme de la commande Drop,
slectionnez la pice, loutil et la fixation appropris14.Slectionnez la ligne de programme aprs la commande DROP15.Insrez la commande PAYLOAD [1] en cliquant sur la flche du
bouton Inst
5/27/2018 Guide Etudiant
49/56
Langage KAREL | p. 43
16.Sur la ligne de commande PAYLAOD changer le 1 pour un2.
17.Cliquez sur X pour fermer la fentre du programme de simulation.
Programme TP Main1. Pour crer un nouveau programme TP, cliquez droit sur
programs dans le Cell Browser et cliquez sur Add TPprogram. La tlcommande Teach Panel souvrira.
2. Cliquez droit sur le programme TP dans le Cell Browser etrenommez le nom du programme pour MAIN.
3. Cliquez sur ON pour autoriser lcriture sur la manette.4. Cliquez sur EDIT pour accder la fentre de commande.5. Cliquez sur NEXT pour accder plus doptions et cliquez sur
F1 [INST]. Une liste de commande apparatra. Slectionn NextPage [8] et slectionnez Payload [2]. Cliquez sur ENTER etentrez le nombre du Payload, soit 2, car cest le nombre du
Payload lorsque le robot est vide.6. Cliquez sur F1 [INST] et slectionnez la commande CALL [6].7. Slectionnez Call program et choisissez le programme PICK.
Cliquez ENTER deux fois de sort que la balise [END] soitslectionne.
8. Cliquez sur F1 [INST] et slectionnez la commande CALL [6].9. Slectionnez Call program et choisissez le programme DROP.
Cliquez ENTER deux fois de sort que la balise [END] soitslectionne.
10.Cliquez sur F1 [INST] et slectionnez la commande JMP/LBL[6]. Slectionnez JMP LBL[ ]
11.Entrez le nombre du JMP LBL, soit 1.12.Slectionnez la ligne aprs le PAY LOAD et cliquez sur F5
[EDCMD]. Slectionnez Insert et cliquez ENTER. Une ligne videapparatra la suite de la commande PAYLOAD.
13.Cliquez sur F1 [INST] et slectionnez la commande JMP/LBL[6]. Slectionnez LBL[ ]
14.Entrez le nombre du LBL, soit 1. Vous avez maintenant uneboucle dans votre programme born par les commandes LBL(Label) et JMP LBL (Jump Label
15.Cliquez sur X pour fermer la fentre du programme TP.
Roulez le programme1. Assurez-vous que le programme MAIN et slectionnez et clique
sur le bouton montr ci-dessous.
FIGURE No. 24: Bouton pour rouler un programme
5/27/2018 Guide Etudiant
50/56
Langage KAREL | p. 44
2. Votre robot devrait alors prendre la pice de la fixation SHELFet la dposer sur la fixation BOX
5/27/2018 Guide Etudiant
51/56
Erreurs frquentes | p. 45
CHAPITRE 7 : ERREURS FRQUENTES
7.1.Problmes de configuration de lordinateur
Pour pouvoir utiliser le logiciel ROBOGUIDE sur lordinateur, celui-ci doit avoircertaines configurations prcises.
1. Le diviseur de dcimal doit tre le . au lieu de la ,2. La sauvegarde des fichiers doit se faire sur un disque physique et non un disque
rseau
7.1.1.Changer le type de diviseur de dcimalePour changer le type de diviseur de dcimal vous devez :
1. allez dans panneau de configuration
2. cliquez sur la section Horloge, langue et rgion3. cliquez sur Modifier le format de la date, de lheure ou des nombres4. une fentre apparaitra comme celle-ci
FIGURE No. 25: Fentre de rgion et langue du panneau de configuration
5. cliquez sur paramtre supplmentaire, une fentre apparatra comme ci-dessous
5/27/2018 Guide Etudiant
52/56
Erreurs frquentes | p. 46
FIGURE No. 26: Fentre des options avances du format des nombres
6. Changez dans la section Symbole dcimal la virgule par un point sibesoin
7. Cliquer OK
7.1.2.Changer lemplacement du fichier de sauvegarde
Si votre programme signale une erreur lorsque vous voulez crer un fichier, ilest fort probable que lemplacement du fichier de sauvegarde soit sur un disquerseau au lieu dun disque local.
Pour changer lemplacement du fichier de sauvegarde, vous devez :1. Ouvrir ROBOGUIDE2. Cliquez sur longlet Tools de la barre doutils du programme3. Allez dans la section General telle que montre ci-dessous
5/27/2018 Guide Etudiant
53/56
Erreurs frquentes | p. 47
FIGURE No. 27: Fentre pour changer la trajectoire de sauvegarde des
documents sur ROBOGUIDE
4. Changer le champ Default Workcell Path pour un emplacement sur undisque local
5. Cliquez sur OK
7.1.3.Appliquer les valeurs DCSSi lerreur Need to apply DCS parameter apparait sur votre boitier de
commande virtuel, vous devez suivre les instructions suivantes pour vous dfaire delimpasse.
1. Ouvrez le boitier de commande virtuelle dans ROBOGUIDE2. Cliquez sur menu3. Dans le menu, slectionnez NEXT pour voir dautre onglet4. Slectionner System, la fentre des options du systme apparatra
5/27/2018 Guide Etudiant
54/56
Erreurs frquentes | p. 48
FIGURE No. 28: Trajet pour appliquer un DCS tape 1
5. Cliquez F1 pour TYPE et choisissez DCS
FIGURE No. 29: Trajet pour appliquer un DCS - tape 2
5/27/2018 Guide Etudiant
55/56
Erreurs frquentes | p. 49
6. Cliquez sur F2 pour APPLY
FIGURE No. 30: Appliquer un DCS
7. Un mot de passe vous sera demand, alors demandez au responsable de
cours ou de laboratoire pour quil inscrive le mot de passe.8. Vous devez ensuite confirmer les modifications en pesant sur F4 pour
OK
5/27/2018 Guide Etudiant
56/56
Erreurs frquentes | p. 50
FIGURE No. 31: Confirmation de lapplication du DCS
9. Redmarrez le contrleur en allant dans Robot/restart controller/coldstart du menu principal de ROBOGUIDE.
7.2.Dboguer le boitier de commande virtuelParfois, lors de lexcution de certains programmes, le boitier de commande virtuel
signal des erreurs. La plupart du temps pour enlever le message derreur il faut seulementpeser sur shift et reset. Par contre, parfois ceci ne suffit pas. Dans ce cas il faut appuyersur licne reset1du menu de bouton et ensuite peser sur play2et finalement peser dustop3 comme le montre la figure ci-dessous.
FIGURE No. 32: Procdure pour rsoudre les messages derreurs du boitier decommande virtuel
Si le message derreur ne disparait toujours pas alors il faut redmarrer le contrleur
virtuel en cliquant sur Robot/Restart Controller/Cold Start.
132