Beruflich Dokumente
Kultur Dokumente
DENAVIT-HARTENBERG
Cristina Castejón
Conceptos de robótica
• Cadena cinemática abierta formada por
eslabones y articulaciones:
– Rotación
– Prismáticas
• Estudio cinemático
• Estudio dinámico
Conceptos de geometría espacial
• Consideraremos como sistemas de
referencia los formados por tres
ejes rectilíneos (X,Y,Z):
– Ortogonales (perpendiculares 2 a 2)
– Normalizados (las longitudes de los
vectores básicos de cada eje son
iguales)
– Dextrógiros (el tercer eje es producto
vectorial de los otros 2)
Conceptos de geometría espacial
• Las coordenadas de un punto P(x,y,z), son
las proyecciones de dicho punto
perpendicular a cada eje.
• Utilización de las llamadas coordenadas
generalizadas
⎛ x '⎞
⎜ ⎟ x ' = x ⋅ω
⎜ y ' ⎟ donde ω : factor de escala
y' = y⋅ω
⎜ z'⎟ normalmente ω = 1
⎜⎜ ⎟⎟ z' = z⋅ω
⎝ ω⎠
Traslaciones y Rotaciones
⎛1 0 0 dx ⎞ ⎛1 0 0 0⎞
⎜ ⎟ ⎜ ⎟
⎜ 0 1 0 dy ⎟ ⎜ 0 cos θ − s enθ 0⎟
Tras(d x , d y , d z ) = Rot(x, θ) =
⎜0 0 1 dz ⎟ ⎜ 0 senθ cos θ 0⎟
⎜⎜ ⎟ ⎜⎜ ⎟
⎝0 0 0 1 ⎟⎠ ⎝0 0 0 1 ⎟⎠
( x, y, z, α, β, γ ) = f ( q1 , q 2 ,..., q n )
Resolución cinemática directa
Sn = T ⋅ S0
( q1 , q 2 ,..., q n ) = f ( x, y, z, α, β, γ )
Obtención de la matriz T.
• Sencillo para cadenas cinemáticas abiertas
de cualquier número de grados de libertad,
pero complejo para el caso de cadenas
cinemáticas cerradas.
• Parámetros de D-H.
articul αi ai θi di
1
.....
n
algoritmo
Z2
– Si la articulación es
rotativa, el eje será Z1
ejes. X3
Z2
Z2
X3
α3= 0º Z1
Y1 X1
articul αi ai θi di
1 -90
2 90
3 0
algoritmo
a1= 0 Y3
a2= 0 Z3 X2 Y
a3= 0
2
Z2
X3
Z1
Y1 X1
articul αi ai θi di
1 -90 0
2 90 0
3 0 0
algoritmo
Z2
θ3= -90º X3
Z1
Y1 X1
articul αi Ai θi di
1 -90 0 -90
2 90 0 -90
3 0 0 -90
algoritmo
• di: distancia a los largo del eje Zi-1 desde el origen del
sistema Si-1 hasta la intersección del eje Zi-1 con el eje Xi. En
el caso de articulaciones prismáticas será la variable de
desplazamiento.
Y3
L3
d1= L1 Z3 X2 Y
d2= L2
2
d3= L3 X3
Z2
L2
Z1
Y1 X1
articul αi Ai θi di L1
1 -90 0 -90 L1
2 90 0 -90 L2
3 0 0 -90 L3
ejemplo
Obtención de T
• Matriz de transformación desde el sistema
i-1 hasta el i.
i −1
A i = Rot ( Zi −1 , θi ) ⋅ Tras ( 0, 0, d i ) ⋅ Tras ( a i , 0, 0 ) ⋅ Rot ( X i , α i )
⎛ cos θi − s e n θi 0 0⎞ ⎛1 0 0 0 ⎞ ⎛1 0 0 ai ⎞ ⎛ 1 0 0 0⎞
⎜ ⎟ ⎜ ⎟ ⎜ ⎟ ⎜ ⎟
s e n θi cos θi 0 0⎟ ⎜0 1 0 0 ⎟ ⎜0 1 0 0 ⎟ ⎜ 0 cos α i − s enα i 0⎟
i −1
Ai = ⎜ ⋅ ⋅ ⋅
⎜ 0 0 1 0⎟ ⎜0 0 1 di ⎟ ⎜ 0 0 1 0 ⎟ ⎜ 0 senα i cos α i 0⎟
⎜⎜ ⎟ ⎜ ⎟ ⎜ ⎟ ⎜ ⎟
⎝ 0 0 0 1 ⎟⎠ ⎜⎝ 0 0 0 1 ⎟⎠ ⎜⎝ 0 0 0 1 ⎟⎠ ⎜⎝ 0 0 0 1 ⎟⎠
• Matriz de transformación
T = 0 A n = 0 A1 ⋅ 1 A 2 ⋅L ⋅ i −1 A i ⋅L ⋅ n −1 A n
Resolución cinemática directa
Sn = T ⋅ S0