Diseño y Control de Robots (DyCR)
Transcript of Diseño y Control de Robots (DyCR)
![Page 1: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/1.jpg)
Maestría en Ingeniería Eléctrica
Especialización en Electrónica Digital y Automatización
Prof. Dr. Héctor Montes Franceschi
Diseño y Control de Robots (DyCR)“Análisis cinemático del brazo robótico de Stanford”
Universidad Tecnológica de PanamáFacultad de Ingeniería Eléctrica
![Page 2: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/2.jpg)
Características principales del brazo robótico de Stanford
• Es un robot manipulador de 6 ejes con cinco articulaciones rotacionales y una prismática, lo que le da seis grados de libertad.
• Las articulaciones 1, 2, 4, 5 y 6 son rotacionales, cuyas variables serán θi, esto es, θ1, θ2, θ4, θ5, θ6, respectivamente.
• La articulación 3 es del tipo prismática, por lo tanto, la variable de esta articulación es d3.
• La gráfica de este brazo robótico se encuentra en la siguiente diapositiva.
![Page 3: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/3.jpg)
Brazo robótico de Stanford
θ1
θ2
θ5
θ4
θ6
d3
l2l1
l6
Articulación prismática
![Page 4: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/4.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
1. El eje zi-1 se coloca a lo largo del eje de la articulación ‘i’. Es decir, el eje z0 se coloca a lo largo de la articulación ‘1’.
2. El eje xi es normal al eje zi-1. Esto es, por ejemplo, el eje x2 es perpendicular al eje z1.
3. El eje yi completa el sistema dextrógiro. El eje ‘y’ correspondiente forma el sistema cartesiano según la regla de la mano derecha, por ejemplo, si el eje ‘x’ sale de esta hoja hacia el frente y el eje ‘z’ va hacia arriba de esta hoja, entonces, el sistema dextrógiro se completa colocando el eje ‘y’ a la derecha de esta hoja.
Asignación de los sistemas de coordenadas
![Page 5: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/5.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. El eje zi-1 se coloca a lo largo del eje de la articulación ‘i’. Es decir, el eje z0 se coloca a lo largo de la articulación ‘1’.
2. El eje xi es normal al eje zi-1. Esto es, por ejemplo, el eje x2 es perpendicular al eje z1.
3. El eje yi completa el sistema dextrógiro. El eje ‘y’ correspondiente forma el sistema cartesiano según la regla de la mano derecha, por ejemplo, si el eje ‘x’ sale de esta hoja hacia el frente y el eje ‘z’ va hacia arriba de esta hoja, entonces, el sistema dextrógiro se completa colocando el eje ‘y’ a la derecha de esta hoja.
Asignación de los sistemas de coordenadas
![Page 6: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/6.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Zi-1” un ángulo “ i”, para que “Xi-1 ” coincida con “Xi ”.
2. Traslación a lo largo de “Zi-1” una distancia “di”, para que “Oi-1” coincida con “Oi”.
3. Traslación a lo largo de “Xi ” una distancia “ai”, para que “Oi-1” coincida con “Oi”.
4. Rotación alrededor del eje “Xi ” un ángulo “αi”, para que “Zi-1” coincida con “Zi”. Se rota el “{Si-1}”.
Obtención de los parámetros de D-H
![Page 7: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/7.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Z0” un ángulo “1”, para que “X0 ” coincida con “X1 ”.
2. Traslación a lo largo de “Z0” una distancia “d1”, para que “O0” coincida con “O1”.
3. Traslación a lo largo de “X1 ” una distancia “a1”, para que “O0” coincida con “O1”.
4. Rotación alrededor del eje “X1 ” un ángulo “α1”, para que “Z0” coincida con “Z1”. Se rota el “{S0}”.
Obtención de los parámetros de D-HART. 1
![Page 8: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/8.jpg)
θ1
l1
Z1
X1Y1
Z0
X0
Y0
1. Rotación alrededor del eje “Z0” un ángulo “1”, para que “X0 ” coincida con “X1 ”.
2. Traslación a lo largo de “Z0” una distancia “d1”, para que “O0” coincida con “O1”.
3. Traslación a lo largo de “X1 ” una distancia “a1”, para que “O0” coincida con “O1”.
4. Rotación alrededor del eje “X1 ” un ángulo “α1”, para que “Z0” coincida con “Z1”. Se rota el “{S0}”.
Obtención de los parámetros de D-HART. 1
Z1
X1
Y1
Z0
X0
Y0
Z1
X1
Y1X0
Z0
Y0
α1
ART. a d α θ1
![Page 9: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/9.jpg)
θ1
l1
Z1
X1Y1
Z0
X0
Y0
1. Rotación alrededor del eje “Z0” un ángulo “1”, para que “X0 ” coincida con “X1 ”.
2. Traslación a lo largo de “Z0” una distancia “d1”, para que “O0” coincida con “O1”.
3. Traslación a lo largo de “X1 ” una distancia “a1”, para que “O0” coincida con “O1”.
4. Rotación alrededor del eje “X1 ” un ángulo “α1”, para que “Z0” coincida con “Z1”. Se rota el “{S0}”.
Obtención de los parámetros de D-HART. 1
Z1
X1
Y1
Z0
X0
Y0
Z1
X1
Y1X0
Z0
Y0
α1
ART. a d α θ1 0 l1 -π/2 θ1
![Page 10: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/10.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Z1” un ángulo “2”, para que “X1 ” coincida con “X2 ”.
2. Traslación a lo largo de “Z1” una distancia “d2”, para que “O1” coincida con “O2”.
3. Traslación a lo largo de “X2 ” una distancia “a2”, para que “O1” coincida con “O2”.
4. Rotación alrededor del eje “X2 ” un ángulo “α2”, para que “Z1” coincida con “Z2”. Se rota el “{S1}”.
Obtención de los parámetros de D-HART. 2
![Page 11: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/11.jpg)
Z1
Z2
X1Y1 X2
Y2θ2
l2
1. Rotación alrededor del eje “Z1” un ángulo “2”, para que “X1 ” coincida con “X2 ”.
2. Traslación a lo largo de “Z1” una distancia “d2”, para que “O1” coincida con “O2”.
3. Traslación a lo largo de “X2 ” una distancia “a2”, para que “O1” coincida con “O2”.
4. Rotación alrededor del eje “X2 ” un ángulo “α2”, para que “Z1” coincida con “Z2”. Se rota el “{S1}”.
Obtención de los parámetros de D-HART. 2
ART. a d α θ2
Z1
Z2
X1
Y1X2
Y2
Z2
X1 Y1
X2
Y2
α2
![Page 12: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/12.jpg)
Z1
Z2
X1Y1 X2
Y2θ2
l2
1. Rotación alrededor del eje “Z1” un ángulo “2”, para que “X1 ” coincida con “X2 ”.
2. Traslación a lo largo de “Z1” una distancia “d2”, para que “O1” coincida con “O2”.
3. Traslación a lo largo de “X2 ” una distancia “a2”, para que “O1” coincida con “O2”.
4. Rotación alrededor del eje “X2 ” un ángulo “α2”, para que “Z1” coincida con “Z2”. Se rota el “{S1}”.
Obtención de los parámetros de D-HART. 2
ART. a d α θ2 0 l2 π/2 θ2
Z1
Z2
X1
Y1X2
Y2
Z2
X1 Y1
X2
Y2
α2
![Page 13: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/13.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Z2” un ángulo “3”, para que “X2 ” coincida con “X3”.
2. Traslación a lo largo de “Z2” una distancia “d3”, para que “O2” coincida con “O3”.
3. Traslación a lo largo de “X3 ” una distancia “a3”, para que “O2” coincida con “O3”.
4. Rotación alrededor del eje “X3 ” un ángulo “α3”, para que “Z2” coincida con “Z3”. Se rota el “{S2}”.
Obtención de los parámetros de D-HART. 3
![Page 14: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/14.jpg)
Z2
Y3
X2
Y2
X3
d3
1. Rotación alrededor del eje “Z2” un ángulo “3”, para que “X2 ” coincida con “X3”.
2. Traslación a lo largo de “Z2” una distancia “d3”, para que “O2” coincida con “O3”.
3. Traslación a lo largo de “X3 ” una distancia “a3”, para que “O2” coincida con “O3”.
4. Rotación alrededor del eje “X3 ” un ángulo “α3”, para que “Z2” coincida con “Z3”. Se rota el “{S2}”.
Obtención de los parámetros de D-HART. 3
Z2
Y3
X2
Y2
X3 Z3
Z3
α3=?
Z2
Y3
X2
Y2
X3
Z3
α3=?
![Page 15: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/15.jpg)
Z2
Y3
X2
Y2
X3
d3
1. Rotación alrededor del eje “Z2” un ángulo “3”, para que “X2 ” coincida con “X3”.
2. Traslación a lo largo de “Z2” una distancia “d3”, para que “O2” coincida con “O3”.
3. Traslación a lo largo de “X3 ” una distancia “a3”, para que “O2” coincida con “O3”.
4. Rotación alrededor del eje “X3 ” un ángulo “α3”, para que “Z2” coincida con “Z3”. Se rota el “{S2}”.
Obtención de los parámetros de D-HART. 3
Z2
Y3
X2
Y2
X3 Z3
Z3
α3=?
Z2
Y3
X2
Y2
X3
Z3
α3=?ART. a d α θ3 0 d3 0 0
![Page 16: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/16.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Z3” un ángulo “4”, para que “X3 ” coincida con “X4”.
2. Traslación a lo largo de “Z3” una distancia “d4”, para que “O3” coincida con “O4”.
3. Traslación a lo largo de “X4 ” una distancia “a4”, para que “O3” coincida con “O4”.
4. Rotación alrededor del eje “X4 ” un ángulo “α4”, para que “Z3” coincida con “Z4”. Se rota el “{S3}”.
Obtención de los parámetros de D-HART. 4
![Page 17: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/17.jpg)
Z3
Y3; Z4X3 ; X4 Y4
θ4
1. Rotación alrededor del eje “Z3” un ángulo “4”, para que “X3 ” coincida con “X4”.
2. Traslación a lo largo de “Z3” una distancia “d4”, para que “O3” coincida con “O4”.
3. Traslación a lo largo de “X4 ” una distancia “a4”, para que “O3” coincida con “O4”.
4. Rotación alrededor del eje “X4 ” un ángulo “α4”, para que “Z3” coincida con “Z4”. Se rota el “{S3}”.
Obtención de los parámetros de D-HART. 4
Y3
Z3; Z4X3 ; X4 Y4
α4
ART. a d α θ4
![Page 18: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/18.jpg)
Z3
Y3; Z4X3 ; X4 Y4
θ4
1. Rotación alrededor del eje “Z3” un ángulo “4”, para que “X3 ” coincida con “X4”.
2. Traslación a lo largo de “Z3” una distancia “d4”, para que “O3” coincida con “O4”.
3. Traslación a lo largo de “X4 ” una distancia “a4”, para que “O3” coincida con “O4”.
4. Rotación alrededor del eje “X4 ” un ángulo “α4”, para que “Z3” coincida con “Z4”. Se rota el “{S3}”.
Obtención de los parámetros de D-HART. 4
Y3
Z3; Z4X3 ; X4 Y4
α4
ART. a d α θ4 0 0 -π/2 θ4
![Page 19: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/19.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Z4” un ángulo “5”, para que “X4 ” coincida con “X5”.
2. Traslación a lo largo de “Z4” una distancia “d5”, para que “O4” coincida con “O5”.
3. Traslación a lo largo de “X5 ” una distancia “a5”, para que “O4” coincida con “O5”.
4. Rotación alrededor del eje “X5” un ángulo “α5”, para que “Z4” coincida con “Z5”. Se rota el “{S4}”.
Obtención de los parámetros de D-HART. 5
![Page 20: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/20.jpg)
Z4
Z5
X4 Y4
X5
Y5
θ5
1. Rotación alrededor del eje “Z4” un ángulo “5”, para que “X4 ” coincida con “X5”.
2. Traslación a lo largo de “Z4” una distancia “d5”, para que “O4” coincida con “O5”.
3. Traslación a lo largo de “X5 ” una distancia “a5”, para que “O4” coincida con “O5”.
4. Rotación alrededor del eje “X5” un ángulo “α5”, para que “Z4” coincida con “Z5”. Se rota el “{S4}”.
Obtención de los parámetros de D-HART. 5
ART. a d α θ5
Z4
Z5
X4Y4
X5
Y5
α5
Z5
X4
Z4
Y4X5
Y5
![Page 21: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/21.jpg)
Z4
Z5
X4 Y4
X5
Y5
θ5
1. Rotación alrededor del eje “Z4” un ángulo “5”, para que “X4 ” coincida con “X5”.
2. Traslación a lo largo de “Z4” una distancia “d5”, para que “O4” coincida con “O5”.
3. Traslación a lo largo de “X5 ” una distancia “a5”, para que “O4” coincida con “O5”.
4. Rotación alrededor del eje “X5” un ángulo “α5”, para que “Z4” coincida con “Z5”. Se rota el “{S4}”.
Obtención de los parámetros de D-HART. 5
ART. a d α θ5 0 0 π/2 θ5
Z4
Z5
X4Y4
X5
Y5
α5
Z5
X4
Z4
Y4X5
Y5
![Page 22: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/22.jpg)
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
1. Rotación alrededor del eje “Z5” un ángulo “6”, para que “X5” coincida con “X6”.
2. Traslación a lo largo de “Z5” una distancia “d6”, para que “O5” coincida con “O6”.
3. Traslación a lo largo de “X6 ” una distancia “a6”, para que “O5” coincida con “O6”.
4. Rotación alrededor del eje “X6” un ángulo “α6”, para que “Z5” coincida con “Z6”. Se rota el “{S5}”.
Obtención de los parámetros de D-HART. 6
![Page 23: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/23.jpg)
Z5
Z6
X5
Y5
X6
Y6
θ6
l6
1. Rotación alrededor del eje “Z5” un ángulo “6”, para que “X5” coincida con “X6”.
2. Traslación a lo largo de “Z5” una distancia “d6”, para que “O5” coincida con “O6”.
3. Traslación a lo largo de “X6 ” una distancia “a6”, para que “O5” coincida con “O6”.
4. Rotación alrededor del eje “X6” un ángulo “α6”, para que “Z5” coincida con “Z6”. Se rota el “{S5}”.
Obtención de los parámetros de D-HART. 6
ART. a d α θ6
Z6
Z5
X5
Y5
X6
Y6
Z6
Z5
X5
Y5
X6
Y6
α6=?
![Page 24: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/24.jpg)
Z5
Z6
X5
Y5
X6
Y6
θ6
l6
1. Rotación alrededor del eje “Z5” un ángulo “6”, para que “X5” coincida con “X6”.
2. Traslación a lo largo de “Z5” una distancia “d6”, para que “O5” coincida con “O6”.
3. Traslación a lo largo de “X6 ” una distancia “a6”, para que “O5” coincida con “O6”.
4. Rotación alrededor del eje “X6” un ángulo “α6”, para que “Z5” coincida con “Z6”. Se rota el “{S5}”.
Obtención de los parámetros de D-HART. 6
ART. a d α θ6 0 l6 0 θ6
Z6
Z5
X5
Y5
X6
Y6
Z6
Z5
X5
Y5
X6
Y6
α6=?
![Page 25: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/25.jpg)
Obtención de los parámetros de D-H
ART. a d α θ1 0 l1 -π/2 θ1
2 0 l2 π/2 θ2
3 0 d3 0 04 0 0 -π/2 θ4
5 0 0 π/2 θ5
6 0 l6 0 θ6
Z0
Z1
Z2
Z3
Y3; Z4
Z5
Z6
X0
Y0
X1Y1 X2
Y2
X3 ; X4 Y4
X5
Y5
X6
Y6
θ1
θ2
θ5θ4
θ6
l2l1
l6
d3
![Page 26: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/26.jpg)
Matrices de transformación homogénea de cada articulación
ART. a d α θ1 0 l1 -π/2 θ1
2 0 l2 π/2 θ2
3 0 d3 0 04 0 0 -π/2 θ4
5 0 0 π/2 θ5
6 0 l6 0 θ6
i
i1
cos cos sen sen sen cossen cos cos -sen cos sen
0 sen cos d0 0 0 1
i i i i i i
i i i i i iii
i i i
aa
A
01
1
1 0 -S1 01 0 1 0
0 1 0 l0 0 0 1
CS C
A
12
2
2 0 S2 02 0 2 0
0 1 0 l0 0 0 1
CS C
A
23
3
1 0 0 00 1 0 00 0 1 d0 0 0 1
A 34
4 0 4 04 0 4 0
0 1 0 00 0 0 1
C SS C
A
45
5 0 5 05 0 5 0
0 1 0 00 0 0 1
C SS C
A 56
6
6 6 0 06 6 0 0
0 0 1 l0 0 0 1
C SS C
A0 1 2 3 4 5
1 2 3 4 5 6T A A A A A A
![Page 27: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/27.jpg)
Matrices de transformación homogénea del robot
Para ello se utilizará el siguiente código de Matlab®:
%multiplicación de matrices simbólicas%declaración de símbolossyms C1 S1 L1 C2 S2 L2 d3 C4 S4 C5 S5 C6 S6 L6
%matrices de transformación AiA1=[C1 0 -S1 0; S1 0 C1 0; 0 -1 0 L1; 0 0 0 1];A2=[C2 0 S2 0; S2 0 -C2 0; 0 1 0 L2; 0 0 0 1];A3=[1 0 0 0; 0 1 0 0; 0 0 1 d3; 0 0 0 1];A4=[C4 0 -S4 0; S4 0 C4 0; 0 -1 0 0; 0 0 0 1];A5=[C5 0 S5 0; S5 0 -C5 0; 0 1 0 0; 0 0 0 1];A6=[C6 -S6 0 0; S6 C6 0 0; 0 0 1 L6; 0 0 0 1];
%Obtención de la matriz de transformación homogénea TT=A1*A2*A3*A4*A5*A6;
% Luego, en el command windows escriba T y obtendrá la respuesta.
![Page 28: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/28.jpg)
Matrices de transformación homogénea del robot
La respuesta de T en el Command Window de Matlab es la siguiente:
% Si desea ver la respuesta de una manera más adecuada/resumida puede utilizar la función 'pretty(T)' de esta manerapretty(T);
Para ello se utilizará el siguiente código de Matlab®:
[ ‐ S6*(C4*S1 + C1*C2*S4) ‐ C6*(C5*(S1*S4 ‐ C1*C2*C4) + C1*S2*S5), S6*(C5*(S1*S4 ‐C1*C2*C4) + C1*S2*S5) ‐ C6*(C4*S1 + C1*C2*S4), C1*C5*S2 ‐ S5*(S1*S4 ‐ C1*C2*C4),C1*S2*d3 ‐ L2*S1 ‐ L6*(S5*(S1*S4 ‐ C1*C2*C4) ‐ C1*C5*S2)]
Fila 1 de T
Fila 2 de T[ S6*(C1*C4 ‐ C2*S1*S4) + C6*(C5*(C1*S4 + C2*C4*S1) ‐ S1*S2*S5), C6*(C1*C4 ‐C2*S1*S4) ‐ S6*(C5*(C1*S4 + C2*C4*S1) ‐ S1*S2*S5), S5*(C1*S4 + C2*C4*S1) + C5*S1*S2, L6*(S5*(C1*S4 + C2*C4*S1) + C5*S1*S2) + C1*L2 + S1*S2*d3]
![Page 29: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/29.jpg)
Matrices de transformación homogénea del robot
La respuesta de T en el Command Window de Matlab es la siguiente:
Fila 3 de T
Fila 4 de T
[ S2*S4*S6 ‐ C6*(C2*S5 + C4*C5*S2), S6*(C2*S5 + C4*C5*S2) + C6*S2*S4, C2*C5 ‐ C4*S2*S5, L1 + C2*d3 + L6*(C2*C5 ‐ C4*S2*S5)]
[ 0, 0, 0, 1]
Con pretty(T), la respuesta sería la siguiente:
/ ‐ S6 #4 ‐ C6 #7, S6 #7 ‐ C6 #4, C1 C5 S2 ‐ S5 #9, C1 S2 d3 ‐ L2 S1 ‐ L6 (S5 #9 ‐ C1 C5 S2) \| || S6 #3 + C6 #5, C6 #3 ‐ S6 #5, #6, L6 #6 + C1 L2 + S1 S2 d3 || || S2 S4 S6 ‐ C6 #2, S6 #2 + C6 S2 S4, #1, L1 + C2 d3 + L6 #1 || |\ 0, 0, 0, 1 /
![Page 30: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/30.jpg)
Matrices de transformación homogénea del robot
Donde los números representan lo siguiente,
#1 == C2 C5 ‐ C4 S2 S5
#2 == C2 S5 + C4 C5 S2
#3 == C1 C4 ‐ C2 S1 S4
#4 == C4 S1 + C1 C2 S4
#5 == C5 #8 ‐ S1 S2 S5
#6 == S5 #8 + C5 S1 S2
#7 == C5 #9 + C1 S2 S5
#8 == C1 S4 + C2 C4 S1
#9 == S1 S4 ‐ C1 C2 C4
![Page 31: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/31.jpg)
Matrices de transformación homogénea del robot
De aquí, se encuentran las posiciones px, py y pz del robot
px = C1 S2 d3 - L2 S1 - L6 (S5 #9 - C1 C5 S2)px = C1 S2 d3 - L2 S1 - L6 [S5 (S1 S4 - C1 C2 C4) - C1 C5 S2]
py = L6 #6 + C1 L2 + S1 S2 d3 py = L6 [S5 #8 + C5 S1 S2] + C1 L2 + S1 S2 d3 py = L6 [S5 (C1 S4 + C2 C4 S1) + C5 S1 S2] + C1 L2 + S1 S2 d3
pz = L1 + C2 d3 + L6 #1 pz = L1 + C2 d3 + L6 (C2 C5 - C4 S2 S5)
![Page 32: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/32.jpg)
Utilizando la Robotics System Toolbox
% Modelo del robot de Standford usando la Robotics SystemToolbox% se declaran algunas variables simbólicas (con 'q' se tienen todas las variables)syms q1 q2 q3 q4 q5 q6 d1 d2 d6
% usando los parámetros de D-H se completa cada articulaciónL1=Revolute('a', 0, 'd', d1, 'alpha', -pi/2); L2=Revolute('a', 0, 'd', d2, 'alpha', pi/2); L3=Prismatic('a', 0, 'theta', 0, 'alpha', 0); L4=Revolute('a', 0, 'd', 0, 'alpha', -pi/2); L5=Revolute('a', 0, 'd', 0, 'alpha', pi/2); L6=Revolute('a', 0, 'd', d6, 'alpha', 0);
L=[L1 L2 L3 L4 L5 L6]; % vector con todas las articulaciones
% se realiza los enlaces de las articulacionesR_Stanford = SerialLink(L, 'name', 'R-STD');
%obtención de la matriz de transformación homogéneaT = R_Stanford.fkine([q1 q2 q3 q4 q5 q6]);
![Page 33: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/33.jpg)
Utilizando la Robotics System Toolbox
En el Command Window se puede obtener los parámetros de D-H
>>R_Stanford
![Page 34: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/34.jpg)
Utilizando la Robotics System Toolbox
También se puede obtener la MTH. Sin embargo, como es sabido es muy grande. A manera de ejemplo, solo se colocará la respuesta de px.
>>T
(24678615572571482867467662723121*d6*cos(q1)*sin(q2))/6582018229284824168619876730229402019930943462534319453394436096 ‐(122597380068651197257713859414983140362437055831*d6*sin(q1))/533996758980227520598755426542388028650676130589163192486760401955554931445160137505740521734144 ‐ (4967757600021511*q3*sin(q1))/81129638414606681695789005144064 ‐ d2*sin(q1) + (122597380068651197257713859414983140362437055831*d6*cos(q2)*sin(q1))/533996758980227520598755426542388028650676130589163192486760401955554931445160137505740521734144 ‐ (4967757600021511*d6*cos(q4)*sin(q1))/81129638414606681695789005144064 ‐(4967757600021511*d6*cos(q5)*sin(q1))/81129638414606681695789005144064 + q3*cos(q1)*sin(q2) + (4967757600021511*q3*cos(q2)*sin(q1))/81129638414606681695789005144064 ‐(4967757600021511*d6*cos(q1)*cos(q2)*sin(q4))/81129638414606681695789005144064 ‐(24678615572571482867467662723121*d6*cos(q1)*cos(q4)*sin(q2))/6582018229284824168619876730229402019930943462534319453394436096 ‐(122597380068651197257713859414983140362437055831*d6*cos(q2)*cos(q4)*sin(q1))/533996758980227520598755426542388028650676130589163192486760401955554931445160137505740521734144 + d6*cos(q1)*cos(q5)*sin(q2) + (4967757600021511*d6*cos(q2)*cos(q5)*sin(q1))/81129638414606681695789005144064 + (4967757600021511*d6*cos(q4)*cos(q5)*sin(q1))/81129638414606681695789005144064 + (24678615572571482867467662723121*d6*sin(q1)*sin(q2)*sin(q4))/6582018229284824168619876730229402019930943462534319453394436096 ‐ d6*sin(q1)*sin(q4)*sin(q5) + d6*cos(q1)*cos(q2)*cos(q4)*sin(q5) + (4967757600021511*d6*cos(q1)*cos(q2)*cos(q5)*sin(q4))/81129638414606681695789005144064 + (24678615572571482867467662723121*d6*cos(q1)*cos(q4)*cos(q5)*sin(q2))/6582018229284824168619876730229402019930943462534319453394436096 + (122597380068651197257713859414983140362437055831*d6*cos(q2)*cos(q4)*cos(q5)*sin(q1))/533996758980227520598755426542388028650676130589163192486760401955554931445160137505740521734144 ‐(4967757600021511*d6*cos(q1)*sin(q2)*sin(q4)*sin(q5))/81129638414606681695789005144064 ‐(24678615572571482867467662723121*d6*cos(q2)*sin(q1)*sin(q4)*sin(q5))/6582018229284824168619876730229402019930943462534319453394436096 ‐ (4967757600021511*d6*cos(q4)*sin(q1)*sin(q2)*sin(q5))/81129638414606681695789005144064 ‐(24678615572571482867467662723121*d6*cos(q5)*sin(q1)*sin(q2)*sin(q4))/6582018229284824168619876730229402019930943462534319453394436096]
![Page 35: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/35.jpg)
Utilizando la Robotics System Toolbox
Se le darán valores a las dimensiones del robot de Stanford, esto es, d1= 0.4 m;d2= 0.15 m; y, d6= 0.3 m.
Se harán dos gráficas con las siguientes características:
Fig. q1 q2 q3 q4 q5 q6Fig. 1 0 0 0 0 0 0Fig. 2 45º 60º 0.2 45º 0 -60º
R_Stanford.plot([0 0 0 0 0 0], 'workspace', [-1 1 -1 1 -0.1 1.5], 'reach', 1)
R_Stanford.plot([pi/4 pi/3 0.2 pi/4 0 -pi/3], 'workspace', [-1 1 -1 1 -0.1 1.5], 'reach', 1)
![Page 36: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/36.jpg)
Fig. q1 q2 q3 q4 q5 q6Fig. 1 0 0 0 0 0 0
R_Stanford.plot([0 0 0 0 0 0], 'workspace', [-1 1 -1 1 -0.1 1.5], 'reach', 1)
T1 = 1 0 0 00 1 0 0.150 0 1 0.70 0 0 1
T1=R_Stanford.fkine([0 0 0 0 0 0]);
![Page 37: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/37.jpg)
Fig. q1 q2 q3 q4 q5 q6Fig. 2 45º 60º 0.2 45º 0 -60º
R_Stanford.plot([pi/4 pi/3 0.2 pi/4 0 -pi/3], 'workspace', [-1 1 -1 1 -0.1 1.5], 'reach', 1)
T2 = 0.5245 ‐0.5915 0.6124 0.20010.1585 0.7745 0.6124 0.4123‐0.8365 ‐0.2241 0.5000 0.65
0 0 0 1
T2=R_Stanford.fkine([pi/4 pi/3 0.2 pi/4 0 -pi/3]);
![Page 38: Diseño y Control de Robots (DyCR)](https://reader036.fdocuments.net/reader036/viewer/2022072312/62daf5e8b24328163a132848/html5/thumbnails/38.jpg)
Cinemática inversa
Se obtendrá la cinemática inversa con los tres primeros gdl, desacoplando cinemáticamente los otros tres gdl (muñeca).
En Matlab, la MTH es la siguiente:
/ C1 C2, ‐S1, C1 S2, C1 S2 d3 ‐ L2 S1 \| || C2 S1, C1, S1 S2, C1 L2 + S1 S2 d3 || || ‐S2, 0, C2, L1 + C2 d3 || |\ 0, 0, 0, 1 /
Donde la posición cartesiana del extremo del último eslabón es:
1 2 3 2 11 2 1 2 31 2 3
p C S d L Spy C L Sx
S dpz L C d
0 1 21 2 3T A A A