Beruflich Dokumente
Kultur Dokumente
c
6
! "
Resumen. !"#
"! $%& %
' ( %
% #
m Denavit ± Hartenberg, Matriz de Transformación Homogénea, Cinemática Directa, Cinemática Directa , dextrógiro
#Y
a#a#%
'( %
2no de los objetivos importantes del robot es ubicar su Este algoritmo define un sistema de coordenadas específico
extremo en el punto deseado del espacio y orientado de tal para cada eslabón mediante una relación entre la rotación -
manera que se optimice el trabajo de este. Mediante el análisis traslación entre elementos contiguos.
cinemático se puede determinar la posición y los ángulos de El algoritmo de Denavit ± Hartenberg, basado en 14 reglas [2],
los elementos mecánicos del robot en un instante dado. Este consta de tres etapas:
análisis resulta ser muy importante porque de este surge el a.Y O# $% que definen parámetros
a#
c.Y #$ '$&! % donde se forman las
matrices de transformación homogénea de los elementos
previo a su resolución.
Mediante el análisis cinemático directo se puede obtener la
ubicación espacial (x, y, z) de los elementos del brazo, en base
en cada articulación å .
a sus características geométricas, como es el ángulo existente
8# +
å En este análisis, la variable desconocida es la articulatoria y
å
(1a)
la conocida es la ubicación espacial del extremo final del
å
(1b)
(1c) brazo. En resumen, se deben encontrar los valores de las
variables articulares para que el extremo final del robot se
å Ü
(2) espacial.
å Ü
(3b)
describe la posición y orientación entre los sistemas de dos (3c)
eslabones seguidos del robot:
Para este análisis, partimos de la matriz de transformación
« Ê " " Ê " » homogénea genérica T (2).
¬ " ¼
" Ê
! " !
Ê " ¼ Donde T es:
1
!¬
!# " !####
¬ 0 ¼
&
" Ê Ê
! " !
¬ ¼
$#### $## $ #%
0 0 0 1 ½
a#)#*"!$%& Se toma un elemento, se obtiene su inversa y multiplicado por
configuración: para encontrar las variables articulares.
c c
c
ö
m ti i
t t l i
i
li l lii
t t l i
L c # $#
L $# # c #
8 L # c #
ö L # c #
t l ti
t i
llt l %t:
«(1 0 " (1 0»
¬ " ( 0 ( 0 ¼¼
0
1 ¬ 1 1
¬ 0 1 0 1 ¼
¬ ¼
0 0
0 1½
« r r r »
¬ r r r ¼¼
Ô
! ¬
@
¬ Ô ¼
¬ ¼
l l
it
it t Ô ½
t l
l
i l til
«(3 " (3 0 3(3 »
it
l
l
l ¬ " ( (3 0 3 " (3 ¼¼
i
l t t l ti
t i 2
3 ¬ 3
l lt l C i
¬ 0 0
1 0 ¼
t !i
ll i l
ti
¬ ¼
0 0 0 1 ½
«(4 " (
ili
l t
i i m
t í
4 0 4(4 »
c c -.)åL c -.)åL L
%l ll
)
l ii l t +
l
l l l
l i l til ti %t
tllt
ti
t l t l "
¼,
-
,
.#
,
@
c c
c
$ $
Y así obtenemos los siguientes valores: q1 =
x= -17.0575 cm 15.0000
y= -4.5706 cm
z= 24.9446 cm q2 =
30.0000
ê#
Del cual igualamos los elementos de las últimas columnas - Trabajamos al inicio con 4 grados de libertad y obtuvimos
resultantes los valores deseados, pero al momento de realizar cinemática
/ )å0 1 #2 )* å0 34 )* å0 1 0 3 4 )* å0 inversa se complicó demasiado, por esta razón trabajamos el
5# 3 # 4 4 )å0 1 0 1 4 )* å0
/ )* å0 3 #2 )å0 $
análisis para tres grados de libertad, el cual es suficiente para
que el robot pueda ubicarse en cualquier punto. En las pruebas
realizadas con el robot, se pudo visualizar que este tenía el
del cual agrupando términos y despejando las variables
mismo valor que para 4 G.L.
articulares tenemos:
- Tuvimos cierta confusión al realizar las pruebas en Matlab
0 676 8 9
porque teníamos valores que eran incorrectos que habían sido
dado en radianes, pero lo pudimos solucionar aplicando los
0
å3å/ )å0 1 2 )* å0 å4 1 # 4 )å0 1 # å4 3 5 # 4 )* å0
6)* < =
å/ )å0 1 2 )* å0 1 å4 3 5#
,#
-
[1] Revista de la Facultad de Ingeniería. ³Análisis cinemático
Ahora, probamos con diferentes valores de x, y e z y con el de un robot industrial tipo SCARA.pdf´.
tamaño de los eslabones. Para mayor facilidad, hemos tomado #Julio de 1999
como coordenadas del extremo final los datos
correspondientes a los valores resultantes de la cinemática
directa y el tamaño de los eslabones dados anteriormente. Así [2] Manipuladores Industriales. CINEMATICA. %#
se logra llegar a los resultados anteriores de las variables *#2005. Cuenca-Ecuador
articulares, lo cual demuestra que el modelo se ha realizado
satisfactoriamente. [3] La representación Denavit-Hartenberg.pdf. .& &
/#Marzo 2008
Ó#
Se realizó un programa en el cual se multiplicaron las matrices
de transformación homogénea, además se introdujeron las
ecuaciones de las coordenadas del extremo del robot y de las
variables articulares y con los datos de los eslabones y
variables articulares, pudimos obtener el resultado para la
cinemática directa e inversa.
Estos son los resultados obtenidos en Matlab:
y=
-4.5706
z=
24.9446