Escolar Documentos
Profissional Documentos
Cultura Documentos
ii
iii
iv
vi
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 du
robot un outil trs puissant et utile. Pour assurer une bonne rptabilit et une bonne
prcision des manipulations du robot, celui-ci doit tre programm par lutilisateur.
Dans ce guide vous trouverez les informations ncessaires pour faire fonctionner un
robot Fanuc LR Mate 200iC. Plus prcisment, le guide est divis en quatre parties. Il y aura
tout dabord une prsentation des diffrentes mesures de scurit. Ensuite, il y aura une
description 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 y
aura 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 des
erreurs frquentes ainsi que leurs rsolutions.
Introduction | p. 1
Pour utiliser le robot en mode automatique, vous devez obligatoirement fermer les
portes 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 rduite
3. Effectuer la trajectoire au complet vitesse normale
Mesure scurit | p. 2
FIGURE No. 1:
FIGURE No. 2:
FIGURE No. 3:
FIGURE No. 4:
FIGURE No. 5:
J1
J2
J3
J4
J5
J6
Moment du poignet (N*m)
J4
J5
J6
Inertie de la charge du
J4
2
poignet (kg*m )
J5
J6
Poids du robot sans charge (kg)
388
380
240
720
350
350
400
450
450
720
11.9
11.9
6.7
0.3
0.3
0.1
27
FIGURE No. 6:
TABLEAU No. 2:
De plus, le joint 2 du robot est indpendant des autres joints. Cest--dire que si
le joint 2 change dorientation, le joint 3, 4, 5, 6 vont rester parallles leur position
de dpart, comme le montre la figure ci-dessous
FIGURE No. 7:
Indpendance du joint 2
6
FIGURE No. 8:
5
Prsentation des diffrentes fentre du programme ROBOGUIDE
TABLEAU No. 3:
Numro
1
2
3
4
5
6
7
Description
Barre du menu principal
Boutons des diffrentes fonctions du programme
Progress Navigator, le navigateur de progrs
Cell Browser, arborescence
Teach Panel, simulation de la tlcommande du robot.
Barre dtat, montrant les diffrents programmes et le contrleur slectionn
workcell, cellule de travail, l o la reprsentation de lenvironnement rel
est prsente.
Afficher / Masquer la barre doutils rapide pour enregistrer des coordonns dans
un 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 Targets
Dessiner 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
Vue du ctdroit
Vue de ct gauche
Vue de face
Vue de derrire
4.2.1.1. Le robot
Les pices sont les lments que lon dsire manipuler avec le robot. Les
pices peuvent tre modlises sur un logiciel 3D comme CATIA et tre
importes lintrieur de ROBOGUIDE.
Les obstacles sont les lments qui reprsentent les diffrents objets qui
pourraient interfrer avec la trajectoire du robot. Il est important
dincorporer les obstacles qui sont prsents dans lenvironnement de travail
rel lintrieur du logiciel de simulations pour sassurer que le robot
nentre pas en collision avec des objets.
FIGURE No. 9:
Navigateur de procd
Arborescence
Boitier de commande
sur le bouton
. Une fentre apparatra comme montre ci-dessous. Ceci
vous donnera loption de choisir lorigine (World), loutil (Tool), lutilisateur
(User), les joints (Joints) comme lment de rfrence pour le dplacement.
Robot rel LR Mate 200iC | p. 19
Barredoutil Move to
Pour utiliser cet outil, vous devez tout dabord slectionner une des
options mentionnes ci-dessus, ensuite vous devez cliquer sur une rgion de
votre cellule de travail qui correspond lendroit o vous voulez dplacer le
bout du bras du robot.
Pour accder loutil de mesure vous devez cliquez sur le bouton . Une
fentre contenant les options de mesures comme montres sur la figure ci-dessous
souvrira.
Pour mesurer la distance entre deux objets ou la longueur dune pice, il faut
premirement cliquer le bouton From et ensuite slectionn le type de surface
que vous dsirez slectionner : face, ct, arrte, centre dune face ou le centre dun
ct. Aprs, vous devez slectionner lendroit o vous dsirez positionner le point
initial de la mesure.
Pour choisir le point final de la mesure, vous devez rpter les tapes
mentionnes prcdemment en choisissant les caractristiques dsires pour le
point final et en cliquant ensuite sur la position du point final.
Pour exporter un fichier vers le robot rel, vous devez premirement cliquer
droit sur le fichier en question et ensuite cliquer sur Export/To Robot comme le
montre la figure ci-dessous.
Robot rel LR Mate 200iC | p. 22
Ceci fait lditeur de programmation KAREL souvrira, comme le montre la figure cidessous.
Langage KAREL | p. 24
Un fichier dextension .kl est alors cr. Par dfaut le nom du fichier est untitle1.kl.
compiler le programme que vous avez crit en cliquant sur le bouton . Lorsque vous
compilez le programme, un fichier dextension .pc ayant le mme nom que votre fichier
dextension .kl sera cr. Le fichier dextension .pc est le fichier qui est lu par le
contrleur du robot.
Langage KAREL | p. 25
Langage KAREL | p. 26
TABLEAU No. 5:
Directive
%ALPHABETIZE
%CMOSVARS
%CMOS2SHADOW
%COMMENT =
comment
%CRTDEVICE
%DEFGROUP = n
%DELAY
%ENVIRONMENT
filename
%INCLUDE filename
%LOCKGROUP =n,n
%NOABORT = option
%NOBUSYLAMP
%NOLOCKGROUP
%NOPAUSE = option
%NOPAUSESHFT
%PRIORITY = n
%SHADOWVARS
%STACKSIZE = n
%TIMESLICE = n
%TPMOTION
%UNINITVARS
Description
Specifies that variables will be created in alphabetical order
when p-code is loaded.
Specifies the default storage for KAREL variables is
CMOS RAM.
Instructs the translator to put all CMOS variables in
SHADOW memory.
Specifies a comment of up to 16 characters. During load
time, the comment is stored as a program attribute and can
be displayed on the SELECT screen of the teach pendant or
CRT/KB.
Specifies that the CRT/KB user window will be the default
in the READ and WRITE statements instead of the
TPDISPLAY window.
Specifies the default motion group to be used by the
translator.
Specifies the amount of time the program will be delayed
out of every 250 milliseconds.
Used by the off-line translator to specify that a particular
environment file should be loaded.
Specifies files to insert into a program at translation time.
Specifies the motion group(s) locked by this task.
Specifies a set of conditions which will be prevented from
aborting the program.
Specifies that the busy lamp will be OFF during execution.
Specifies that no motion groups will be locked by this task.
Specifies a set of conditions which will be prevented from
pausing the program.
Specifies that the task is not paused if the teach pendant
shift key is released.
Specifies the task priority.
Specifies that all variables by default are created in
SHADOW.
Specifies the stack size in long words.
Supports round-robin type time slicing for tasks with the
same priority.
Specifies that task motion is enabled only when the teach
pendant is enabled.
Specifies that all variables are by default uninitialized.
Langage KAREL | p. 27
ARRAY
CONFIG
XYZWPR
VECTOR = STRUCTURE
X : REAL
Y : REAL
Z : REAL
ENDSTRUCTURE
Le type de variable que le
tableau ARRAY contient est
spcifier
Ex :
JPOS : ARRAY[6] OF REAL
Configuration du robot
CFG_FLIP : BOOLEAN
CFG_LEFT : BOOLEAN
CFG_UP : BOOLEAN
CFG_TURN_NO1 : INTEGER
CFG_TURN_NO2 : INTEGER
CFG_TURN_NO3: INTEGER
Spcifie la position
cartsienne du UTOOL.
CFG_FLIP : R ou L
CFG_LEFT :U ou D
CFG_UP :N ou F
CFG_TURN_NO1 :[-8 ; 6] E
CFG_TURN_NO2 :[-8 ; 6] E
CFG_TURN_NO3: [-8 ; 6] E
Langage KAREL | p. 29
POSITION
JOINTPOS<n>
PATH
XYZWPR = STRUCTURE
X: REAL
Y: REAL
Z: REAL
W: REAL
P: REAL
R: REAL
CONFIG_DATA: CONFIG
ENDSTRUCTURE
POSITION = STRUCTURE
NORMAL : VECTOR
ORIENT : VECTOR
APPROACH : VECTOR
LOCATION : VECTOR
CONFIG_DATA : CONFIG
ENDSTRUCTURE
Reprsentation de la position
en une matrice contenant les
angles des axes du robot.
Les angles sont exprims en
degr.
seront excuts, sinon, les noncs rattachs la commande ESLE seront excuts.
Lexemple qui suit montre la structure de la commande IF.
Langage KAREL | p. 31
Langage KAREL | p. 32
CURPOS
Retourne la position
actuelle du TCP
CURPOSE (1,5,1)
Syntaxe :
CURPOS (axis_limit_mask,
ovr_trv_mask, group_no)
Axis_limit_mask : [1 ; 6]*
Ovr_trv_mask : [1 ; 6]*
MOVE ABOUT
MOVE AWAY
MOVE AXIS
MOVE NEAR
MOVE TO
VAR
vector_1 : VECTOR
pos_1 : POSITION
BEGIN
MOVE TO pos_1
vector_1 = ORIENT(pos_1)
MOVE ABOUT pos_1 BY 30
END
BEGIN
MOVE AWAY 50
END
BEGIN
MOVE AXIS 3 BY 45
END
VAR
pos_1 : POSITON
BEGIN
MOVE NEAR pos_1 BY 60
END
VAR
cord : XYZWPR
JPOS : JOINTPOS
BEGIN
MOVE TO cord
MOVE TO JPOS
END
Langage KAREL | p. 33
OPEN FILE
Syntaxe :
OPEN FILE variable
(attribut, nom_fichier)
OPEN HAND
PATH_LEN
PATHPOS
Attribut :
RO : Lecture
seulement
RW : Lecture et
criture
AP : Ajouter des
donnes un fichier
dj existant
UD : Mise jour de
donnes
Permets douvrir les
pinces du robot
Le chiffre aprs la
commande correspond au
numro du Robot
Output auquel les pinces
sont relies.
Dtermine le nombre de
nuds dans une variable
PATH
Retourne la position dun
nud
OPEN HAND 1
VAR
p_len : INTEGER
BEGIN
p_len = PATHLEN(parcour)
END
VAR
p_len, l : INTEGER
BEGIN
p_len = PATHLEN(parcour)
FOR I = 1 TO p_len DO
ENDFOR
END
Langage KAREL | p. 34
POS
READ
WRITE
VAR
p1 : POSITION
c : CONFIG
BEGIN
CNV_STR_CONF(NUT, 0 ,0,0,c, 0)
p1 = POS(450, 0, 450, 0, 0, 0, c)
MOVE TO p1
END
Langage KAREL | p. 35
$SPEED
$TERMTYPE
$UFRAME
$UTOOL
$speed = 1000
$TERMTYPE = 2
Langage KAREL | p. 36
p1
END dec_const
EXEMPLE No. 11:
Ajout de nuds dans une variable de type PATH
PROGRAM test_pht_2
VAR
length, I : INTEGER
p1 : XYZWPR
c : CONFIG
path1 : PATH
longueur : INTEGER
fichier1 : FILE
BEGIN
CNV_STR_CONF('NUT, 0, 0,0', c, 0)
--initialisation de la variable c
p1 = POS(475,-190,375,-180,-90,0,c)
--initialisation de la position p1
MOVE TO p1
--dplacement vers la position p1
length = PATH_LEN(path1)
--dtermine le nombre de noeuds
longueur = 30
--initialisation de la variable longueur
FOR I= length DOWNTO 1 DO
DELETE_NODE(path1, I, 6)
--supprime tous les anciens nuds
ENDFOR
FOR I = 1 TO longueur DO
MOVE AXIS 4 BY 1
--bougelaxe 4 de 1 degr
APPEND_NODE(path1, 6)
--ajoute un nud au PATH
path1[i].node_pos= CURPOS(4,1,1)
--enregistre la position actuelle au
--noeud
ENDFOR
END test_pht_2
Langage KAREL | p. 37
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 qui
simulera la trajectoire dun robot lors dune manipulation Pick and place
Ouverture du fichier
1. Ouvrez le logiciel ROBOGUIDE
2. Allez dans fichier du menu suprieur du programme et cliquer
sur New Cell, une fentre apparatra
3. 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 liste
des diffrents robots
6. Choisissez le robot LR Mate 200iC et cliquez Next
7. Cliquez Next jusqu' la fin et ensuite cliquez Finish
8. Vous devriez alors avoir une cellule de travail avec le robot.
Modifier les paramtres du robot
1. 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 avec
les proprits du robot souvrira
3. lintrieur de cette fentre, il est possible de modifier la
localisation du robot, mais dans le cadre de ce tutoriel nous
laisserons le robot lorigine.
4. Cocher Lock All Location Values pour fixer la position du robot
et cliquez sur OK
Ajouter une pice (Part)
1. lintrieur de la section Define the Cell du Process
Navigator cliqu sur Add a Part to the Cell, une fentre avec
diffrente option concernant la nature de la pice souvrira.
2. Dans le cadre de ce tutoriel, slectionnez Box Primitive Model
et cliquez sur OK. Une fentre avec les proprits de la pice
apparatra.
3. Donnez un nom la pice, par exemple : cube
Langage KAREL | p. 38
Langage KAREL | p. 44
Si votre programme signale une erreur lorsque vous voulez crer un fichier, il
est fort probable que lemplacement du fichier de sauvegarde soit sur un disque
rseau au lieu dun disque local.
Pour changer lemplacement du fichier de sauvegarde, vous devez :
1. Ouvrir ROBOGUIDE
2. Cliquez sur longlet Tools de la barre doutils du programme
3. Allez dans la section General telle que montre ci-dessous
Erreurs frquentes | p. 46
Erreurs frquentes | p. 47
Appliquer un DCS
Erreurs frquentes | p. 49
Erreurs frquentes | p. 50