Avancelab 7
Avancelab 7
Avancelab 7
𝐶1 −𝑆1 0 0
1 𝐴1 = [ 𝑆1
0 𝐶1 0 0]
0 0 1 𝑙1
0 0 0 1
𝐶2 −𝑆2 0 𝑙2
11 𝐴2 = [𝑆2 𝐶2 0 0 ]
0 0 1 0
0 0 0 1
𝐶3 −𝑆3 0 𝑙3
1 𝐴3 = [𝑆3 𝐶3 0 0 ]
2
0 0 1 0
0 0 0 1
1 0 0 0
13 𝐴4 = [ 0 1 0 0 ]
0 0 1 𝑞3
0 0 0 1
𝑃𝑦
𝑞1 = tan−1 ( )
𝑃𝑥
𝑃𝑦
𝑞2 = 360 − tan−1 ( )
𝑃𝑥
𝑞3 = 𝑙1 − 𝑃𝑧
𝑃𝑦
𝑞4 = 𝑞2 + tan−1 ( )
−𝑃𝑥
2. La Figura 2 representa la estructura de un robot plano de dos grados de libertad, caracterizados por
las variables articulares (q1,q2). Se pide:
2.1. Resolver el Problema Cinemático Directo para este robot, es decir, obtener x=f 1(q1,q2), y=f2(q1,q2) y
la orientación espacial, por métodos geométricos y el método de Denavit-Hartenberg.
MÉTODOS GEOMÉTRICOS
𝑋 = 𝑞1 + 𝐿 ∗ cos(30) + 𝐿 ∗ cos(30 + 𝑞2)
𝑌 = 𝐿 ∗ sin(30) + 𝐿 ∗ sin(30 + 𝑞2)
𝛼 = 30 + 𝑞2
MÉTODOS DENAVIT-HARTENBERG
Y2 X2
Y1
X1
Y0
X0