SISTEMA ROBÓTICO
ALEXIS PEDROZA
TUTOR:
UNAD -2018
Introducción
ALEXIS PEDROZA
https://youtu.be/2-kmQtyZlv4
Cinemática directa
Matriz de traslación
Supóngase un sistema O’UVW que se encuentra trasladado con respecto al sistema OXYZ.
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Matriz de rotación:
Vectores unitarios:
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Como
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Entonces
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
La matriz de rotación está dada por:
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de https://es.slideshare.net/tysonLlanos/05-cinematica2
Las transformaciones básicas que relacionan el sistema de referencia del elemento i con el
sistema i-1 son:
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
Tomado de http://www.utm.mx/~hugo/robot/Robot2.pdf
3. Localizar el eje de cada articulación. Si ésta es rotativa, el eje será su propio eje de giro.
Si es prismática, será el eje a lo largo del cual se produce el desplazamiento.
5. Situar el origen del sistema de la base {S 0} en cualquier punto del eje Z 0. Los ejes X 0
e Y 0 se situarán de modo que formen un sistema dextrógiro con Z 0 .
6. Para i de 1 a n-1, situar el sistema {Si} (solidario al eslabón i) en la intersección del eje
Zi con la línea normal común a Zi-1 y Zi. Si ambos ejes se cortasen se situaría {Si} en el
punto de corte. Si fuesen paralelos {Si} se situaría en la articulación i+1.
10. Obtener como el ángulo que hay que girar en torno a Zi-1 para que Xi-1 y Xi queden
paralelos. 11. Obtener como la distancia medida a lo largo del eje Zi-1, que habría que
desplazar {Si1} para que Xi y Xi-1 quedasen alineados.
12. Obtener como la distancia medida a lo largo de Xi, que ahora coincidiría con Xi-1 12.
Obtener como la distancia medida a lo largo de X , i, que ahora coincidiría con Xi-1, que
habría que desplazar el nuevo {Si-1} para que su origen coincidiese con { Si }.
13. Obtener como el ángulo que habría que girar en torno a Xi, que ahora coincidiría con
Xi-1, para que el nuevo { Si-1} coincidiese totalmente con { Si }
15. Obtener la matriz de transformación que relaciona el sistema de la base con el del
extremo del robot.
1. Representación Funcional del robot donde ilustra los 6 grados de libertar el robot
puma es el más se asemeja a este.
Imagen tomada de: https://personal.us.es/jcortes/Material/Material_archivos/Articulos%20PDF/RobotPUMA.pdf
3. Algoritmo de Denavit-Hartenberg
El parámetro θi es el ángulo que hay que girar sobre el eje zi-1 para que xi-1 y xi queden
paralelos.
El parámetro di es la distancia sobre el eje zi-1 que hay que desplazar el sistema i-1 para
que xi-1 y xi queden alineados.
El parámetro ai es la distancia sobre el eje xi que hay que desplazar el sistema i-1 para que
su origen coincida con el sistema i.
El parámetro αi es el ángulo que hay que girar sobre xi para que el sistema i-1 coincida con
el sistema i
Articulación θ d a α
1 q1 L1 0 90
2 q2-90 0 L2 0
3 q3 0 0 -90
4 q4 -l3 0 90
5 q5 0 0 -90
6 q6 -L4 0 0
Matrices de transformación.
C1 0 S1 0
S1 0 -C1 0
°A1 = 0 1 0 L1
0 0 0 1
S2 - 0 L2C2
C2
1 A2 = C2 S2 0 L2S2
0 0 1 0
° 0 0 0 1
C3 0 -S3 0
S3 0 C3 0
2 A3 = 0 -1 0 0
0 0 0 1
C4 0 S4 0
S4 0 -C4 0
3 A4 = 0 1 0 -
L3
0 0 0 1
C5 0 -S5 0
S5 0 C5 0
0 -1 0 0
0 0 0 0
4 A5 =
C6 - 0 -
S6 L4C6
5 A6 = S6 C6 0 -
L4S6
0 0 1 0
0 0 0 1
T = °A1 * 1 A2 * 2 A3 * 3 A4 * 4 A5 = ° A6
La matriz T resultante, está formada por una submatriz 3x3 dedicada a la orientación (n 0,a , ) y un
vector 3x1 dedicado al posicionamiento ( p).
nx 0x ax px
ny 0y ay py
T= nz 0z ay pz
0 0 0 w
Se obtiene la posición (x, y, z) del extremo del robot la columna de la matriz de transformación
(T).
0
0
°A6 0
1
= (X,Y,Z,W) p = (X,Y,Z)
3. Realizar la simulación del modelo cinemático en Matlab y comparar con los
resultados anteriores, adjuntar capturas de pantalla de esta simulación.
Bibliografía
Barrientos, A., Peñin, L. F., Balaguer, C., & Aracil, R. (2007). Fundamentos de robótica.
Segunda Edición. Pag 65 a 214. McGraw-Hill, Interamericana de España. Recuperado
de http://bibliotecavirtual.unad.edu.co:2077/lib/unadsp/reader.action?docID=10566097