Exos Robotique
Exos Robotique
Exos Robotique
EDITION: 2006
IMPRESSION: OCTOBRE 2007
UTILISATION INTERNE
H. DEMOUVEAU
2005-2006
Exercices de robotique
2005-2006
2005-2006
2005-2006
2005-2006
2005-2006
2005-2006
Exercice
A l'aide des symboles des articulations reprsenter un robot sphrique, poignet droit
2005-2006
Fig 1a)
Liaison Rotule
centrale
Fig 1b)
2005-2006
2005-2006
Repre platine
Ze
Zo
Xo
Repre outil
Zpl
Repre Plateau
Za
Ya
Zt
Repre Table
Xa
Repre Robot
Repre Atelier
SCHEMA 1
r r r
Atelier Oa, Xa , Ya , Za
L'Atelier est considr comme repre de base, et servira rfrencer tous les autres.
Robot Or, Xr , Yr , Zr
L'origine du Robot est plac 1,58 mtres de l'origine de l'Atelier OaOr forme un angle de
-15avec Xa. Son repre est tourn par rapport celui de l'Atelier de -60 autour de Za
r r r
Table Ot, Xt , Yt , Zt
L'origine de la Table est plac sur l'axe X du Robot, 1 mtre de ce dernier. Son repre est orient de
180 autour de l'axe Zr.
Le plateau est li la Table situe 730 mm de hauteur, il est constitu d'un disque tournant d'paisseur
20 mm, et peut recevoir 8 pices rgulirement rparties sur un diamtre de 500 mm
10
40
30
Point de centrage
50
30
60
Xp
15
Zp
Zp
50
80
Yp
(Oo, Xo , Yo , Zo)
r
Outil
Dans le repre Re,L'extrmit de l'outil est positionn au point de coordonnes
120
0 et orient d'un angle de + 90 autour de Ye
35
r r r
Platine Effecteur Oe, Xe , Ye , Ze
Elle correspond l'interface de fixation des outils. Dans l'tat actuel, nous connaissons ses coordonnes
0
Questions
Donner les positions et attitudes des points entre et sortie de l'axe de l'alsage des pices dans le
repre du plateau
En fonction des informations fournies, pour la premire pice (telle que reprsente sur le shma)
donner les coordonnes et orientation de l'outil au point de centrage et au point de fin de perage de la
pice dans le repre Robot, puis dans le repre Atelier.
On souhaite rajouter deux postes la mme distance du robot que le premier, orients 70 autour de
l'axe Zr. Quelles seront les nouvelles coordonnes des points entre et sortie dans le repre Robot, puis
dans le repre Atelier ?
Quelles sont dans le repre outil actuel les deux positions que devra atteindre le robot ?
11
2005-2006
Tx
r
1) Translation pure de vecteur T = Ty
Tz
2) Matrice homogne inverse d'une translation pure
3) Rotation autour des axes principaux : x , y , z
4) Idem pour les angles 90, -90, 180, -180
5) Ecrire la matrice rsultante de deux matrices de rotation d'angle respectifs
parallles
1,
2 autour d'axes
Partie 2
Donner l'expression de la matrice homogne de la transformation consistant effectuer une rotation de
z radians autour de l'axe colinaire z passant par le point P de coordonnes (Tx,Ty,Tz). ( attention on
ne
Partie 3
Soit la matrice [3x3] :
2
6
2
4
4
2
6+2 3
2
6 2
8
8
4
6+2 3
23 2
6
8
8
4
2), En utilisant la convention de BRIAN, Retrouver partir de l'oprateur Matriciel la valeur des angles
qui caractrisent la rotation effectue.
12
2005-2006
Ai = 0,9659
0
0,2588
0,25
0,2588 0,933
La rotation qui permet de passer de Ai Af peut se faire autour d'une droite fixe.
1) Cette rotation caractrise par son vecteur directeur est exprime dans repre de dpart Ri, dterminer le
vecteur URi et l'angle Ri qui la caractrisent
2) Cette rotation est maintenant exprime par rapport au repre R0, dterminer le vecteur UR0 et l'angle R0 qui
la caractrisent
3) Comment vrifier si les deux vecteurs UR0 et URi dterminent la mme droite ? Proposer une mthode
4) A l'aide de la mthode propose au 3) vrifier si c'est le cas
Rponse
Ux = 0,5
U = Uy = 0,5 et = 30
Uz = 0,7071
13
2005-2006
Te =
0 0 1 30
1
0 0 0
Exercice 1
Le mouvement lmentaire que l'on souhaite raliser est connu dans le repre effecteur Re
T
Dplacement lmentaire e d e = [0 0 1]
Rotation lmentaire e e = [0 0.05 0]
Exercice 2
On connat pour ce robot les bornes d'erreur de position 1 mm dans chaque direction et d'orientation 0.01
rd autour de xn et 0.15 rd autour de yn de l'organe terminal, lors des dplacements.
Dterminer pour le robot l'erreur correspondante au niveau de l'effecteur.
Evaluer n d n , n n
Dterminer e d e , e e
14
2005-2006
Modle gomtrique
Z0,Z1
600
X5, X6
X4
Z6
X2, X3
Z4
110
Z5
Z3
700
X0, X1
Z2
220
120
1
0
2
1
3
2
4
3
5
4
6
5
1
0
0
0
1 (0)
1
d2
90
0
2 (90)
1
d3
0
0
3 (0)
1
d4
90
r4
4 (0)
1
0
-90
r5
5 (0)
1
0
90
0
6 (0)
15
2005-2006
600
100
110
Robot S10
6 axes
ti l ti
Structure srie
700
220
800
150
120
N repre
N repre
antcdent
i
di
i
ri
i
16
2005-2006
modlisation gomtrique
zo
L2
L3
ze
ye
E
xe
L1
yo
xo
Axes
Antcdent
i
di
i
ri
i
Ecriture des matrices de passages
0T1 , 1T2, 2T3
Dtermination de la jacobienne
17
2005-2006
Modlisation directe
130
360
c 305
1100
560
510
18
2005-2006
1150
350
200
680
250
680
310
130
200
IRB 60/2
1)
2)
3)
4)
5)
6)
2005-2006
Chaine principale
corps
Antcdant
0
-1
1
0
2
1
Boucle cinmatique
3
2
4
3
5
4
6
1
7
6
17
7
14
3
0i
i
di
i
ri
i
Boucle cinmatique
Boucle cinmatique
corps
10
16
13
11
15
12
Eff
Antcdant
10
11
0i
i
di
i
ri
i
20
2005-2006
400
15
corps
Antcd
ant
0i
0
-1
1
0
2
1
3
2
i
di
i
ri
21
4
3
5
4
6
5
Eff
6
2005-2006
Boucle cinmatique
corps
10
Antcdant
1'
0i
i
di
i
ri
i
22
2005-2006
23
2005-2006
750
160
Paramtres de D_H
Corps
1
Ant
di
i
ri
3i
24
2005-2006
750
160
Paramtres de D_H
Corps
1
Ant
0
di
0
0
i
ri
0
i
31
2
1
0
90
0
32
3
2
435
0
160
33
4
3
0
-90
435
34
5
4
0
90
0
35
6
5
0
-90
0
36
En fonction des paramtres proposs, o se situent les repres de bases et effecteurs de ce robot ?
Dterminer le modle gomtrique inverse du robot, indiquer la mthode applique
25
2005-2006
Etalonnage de robot
Un mcanisme est constitu dun porteur cylindrique. (on ne considrera pas le poignet)
1) a Reprsenter le schma cinmatique dune telle architecture.
1) b Donner les paramtres de DHK correspondant au schma que vous avez ralis.
2 ) Les tolrances de fabrication entranent des erreurs sur lidentification des paramtres gomtriques du
robot, parmi les paramtres de DHK lesquels sont systmatiquement affects par ces erreurs.
En assimilant ces erreurs des petits dplacements dterminer lerreur que cela entrane sur le
positionnement et lorientation de loutil (on sinspirera de la mthode de calcul applique pour
dterminer le modle diffrentiel direct)
Poser le calcul pour un seul bras (seuls les paramtres retenus au 2 seront considrs)
Seuls les termes du premier ordre seront retenus
Comment gnraliser le calcul tout le robot ?
Mettre sous forme matricielle linfluence sur la prcision du robot de la somme de toutes ces dispersions
ramenes dans le repre de base du robot
x
y
Rx
Ry
Rz
26
2005-2006
Ya
Yr
Xa
T0
27
2005-2006
Yn
Xn
Ye
28
2005-2006
Correction de trajectoire
Pour contrler quun robot ne se dplace pas par rapport la rfrence au sol , on dplace
loutil de ce robot sur un palpeur positionn par rapport un systme de "Coordonnes
universelles".
Lors du premier contrle on mmorise la position du point atteint par le robot (point id0):
Lors d'un autre test, le robot est repositionn sur ce point. L'oprateur constate que l'outil s'est
dcal, il remet l'outil face au capteur et constate l'information de positon (point id1)
Id0 Localisation identifie par le robot lors du premier contrle par rapport au du robot:
Id1 :Localisation identifie par le robot lors du deuxime contrle par rapport au repre du
robot
Repre du Robot :Localisation du repre du robot dans le systme "Coordonnes
universelles"
X
Y
Z
Rx
Ry
Rz
Point Id0
-261,93
1410,26
836
-75
90
0
Point Id1
X
-232,24
Y
1430,89
Z
810,15
Rx
-164
Ry
89
Rz
90
Repre du Robot :
X
-2041
Y
1535
Z
0
Rx
0
Ry
0
Rz
15
Reprsenter sur un schma les diffrents repres voqus Ce schma doit permettre
lorganisation des calculs matriciels.
Faire apparatre le repre Coordonnes universelles le repre de base, le nouveau
repre du robot aprs dplacement et le repre de la position atteinte par le robot),
dterminer sous forme de matrice homogne les dplacements (linaires et rotation) du
nouveau repre du robot dans son repre "Coordonnes de base".
Un ensemble de trajectoires a t programme dans le repre de base avant le
dplacement du robot.
Proposer une solution de calcul faire sur les points programms pour que les
trajectoires soient nouveau ralisables sans avoir reprogrammer par apprentissage
tous les points
29
2005-2006
Mthode de triangulation
Point vis
2
1
2
1
Yth1
Yth2
Z th1
Z th2
Xth2
Yth2=0
Zth2
Xth2
X th1
Thodolite 2
Thodolite 1
La mthode de triangulation est un principe trs utilis pour la dtermination des coordonnes
de points dans l'espace.
En robotique elle est utilise pour identifier les coordonnes de points atteints par l'effecteur
lors de dplacements du robot
Les informations recueillies sont :
l'angle d'azimut i fourni par rapport Ythi dans le plan horizontal
l'angle de site i par rapport Zthi dans un plan vertical
(les thodolites ont des repres parallles, et sont considrs dans un mme plan X,Z, le
thodolite 1 tant positionn l'origine de ce plan)
En considrant la distance entre les thodolites connue, dterminer l'expression
des coordonnes du point vis en fonction de Xth2, Zth2, 1, 1, 2, 2 dans le
repre du thodolite N1
On considre la distance des thodolites : Xth2=1000 mm, Zth2=200 mm
On a vis deux points P1,P2
Les informations sur ces points sont les suivantes :
1,
1,
2, 2
P1 (- 49.7334, 44.0879, 11.7683, 37.7459 )
P2 (-74.6829, 48.3399, -56.7191, 31.7699 )
(Les angles i sont considrs positifs dans le sens trigonomtrique, -180i180 )
(Les angles i sont compris entre 0 verticale vers le haut, et 180 verticale vers le bas)
Calculer les coordonnes de P1 et P2 dans le repre du thodolite N1
La distance entre les points P1 P2 est connue, elle a pour valeur : 2500 mm
Dterminer les coordonnes relles Xth2r et Yth2r du thodolite 2
30
2005-2006
Rponses :
Coordonnes des points dans le repre Thodolites
P1 (850, 720, 1150)
P2 (1716.03, 470, 1583.01)
31
2005-2006
On souhaite mettre place une loi d'interpolation articulaire de forme polynomiale, entre deux
points P1, P2 avec contraintes de continuit de vitesse et d'acclration.
Si on note qi la variable de l'articulation i
Cette trajectoire se fait entre P1 et P2
Les point initial P1 et final P2 sont caractriss par leur coordonnes articulaires
P1 (q1,i ; q 2,i ; q 3,i ; q 4,i ; q 5,i ; q 6,i )
P2 (q1,f ; q 2,f ; q 3,f ; q 4,f ; q 5,f ; q 6,f )
32
2005-2006
On souhaite mettre place une loi d'interpolation articulaire continue partir de la loi trapze,
entre deux points P1, P2.
Au lieu de prendre une acclration et une dclration constantes, qui prsentent une
discontinuit, on remplace cette phase par une loi du deuxime degr.
q i
q i
tfi-i
tfi
tps
Ki
tfi
tps
33
2005-2006
1) Quelles sont les conditions aux limites de vitesse et acclration pour l'articulation i?
2) Donner l'quation de la phase d'acclration en dduire celle de dclration (en
considrant saturation en acclration et en vitesse)
3) Exprimer les dures des phases de dclration et acclration, et la dure du mouvement?
4) En s'inspirant de la mthode de la loi trapze, mettre en place une loi de mouvement pour
que : acclrations et dclrations de toutes les articulations soient de mme dure.
5) En comparant les dures d'acclrations et dclrations avec celles d'une loi trapze
indiquer de quelle valeur sera augmente la dure d'une mme trajectoire avec cette nouvelle
loi.
34
2005-2006
Gnration de trajectoire
Soit le robot STAUBLI RX 130 dont les caractristiques cinmatiques en vitesse Vi et
acclration Ai sont les suivantes :
N
Q1
Articulation
Vi Max /s 203
Ai Max /s 745
Q2
Q3
Q4
Q5
Q6
185
487
250
965
400
2775
320
1708
580
4817
Point
1
2
3
P1
-76.
-80
42
P2
-120
-38
42
P3
-79
-9
31
P4
-2
-70
105
QUESTIONS
I)
En considrant que la trajectoire entre P1 et P4 suit une loi de type Trapze
Sans tenir compte de 4, 5, 6
I 1) Dterminer la dure de la phase d'acclration, du pallier de vitesse constante, et de la
phase de dclration.
I 2) Dterminer, la valeur des acclrations, et vitesses prises par les articulations durant cette
trajectoire, Prciser les articulations qui seront le plus sollicites.
II )On ralise une trajectoire entre P1 et P4 , P2 et P3 servant de points de passage avec une
mthode d'interpolation linaire qui assure la continuit des vitesses et acclrations
Sans tenir compte de 4, 5, 6
II 1) Dterminer la dure de dplacement pour chaque segment, en dduire la dure totale de
la trajectoire.
II 2) Au point P2 dterminer la dure des phases de transitions pour chaque articulation en
considrant que la trajectoire est ralise avec continuit de vitesse et acclration.
II 3) Dterminer l'erreur thorique maximale ralise lors de ces dplacements sur chaque
articulation, par rapport la position programme.
35
2005-2006
Gnration de trajectoire
Soit le robot STAUBLI RX 130 dont les caractristiques cinmatiques en vitesse Vi et
acclration Ai sont les suivantes :
N
Q1
Articulation
Vi Max /s 203
Ai Max /s 745
Q2
Q3
Q4
Q5
Q6
185
487
250
965
400
2775
320
1708
580
4817
Point
1
2
3
P1
-76.
-80
42
P2
-120
-38
42
P3
-79
-9
31
P4
-2
-70
105
QUESTIONS
II )On ralise une trajectoire entre P1 et P4 , P2 et P3 servant de points de passage avec une
mthode d'interpolation linaire qui assure la continuit des vitesses et acclrations
Sans tenir compte de 4, 5, 6
II 1) Dterminer la dure de dplacement pour chaque segment, en dduire la dure totale de
la trajectoire.
36
OUTIL N 1
Anne 2007/2008
DPARTEMENT ou SERVICE :
* Promotion concerne :
FI 1ere anne
2e anne
2e anne
dEnseignement :
3e anne
Autres ESM
Jacques Boonaert
4e anne
TSIM
IPHC
cours DRIRE
Admis sur titreAdmis sur dossier
MATIRE : Robotique
POLYCOPI TIR :
* Option concerne :
25 exemplaires
EI
IQ
GC
ISIC
GE
PR
IM
TPC
Nombre
Publications
de pages
Editeur (livres)
Auteur (s)
Service reprographie
e-mail :[email protected]
tel :2012
Titres
copies
Loriginal
Nombre
de pages
dans
de loriginal
publications
Editeur (livres)
Auteur (s)
Titres
Nombre de pages
Nombre de pages
Copies dans
de loriginal
Loriginal