Corr TD 2
Corr TD 2
Corr TD 2
Exercice 1 :
x3 x2
z2 x4
z4
z3
x1
z1
m12 =
[ cos(q1), -sin(q1), 0, a1*cos(q1)]
[ sin(q1), cos(q1), 0, a1*sin(q1)]
[ 0, 0, 1, 0]
[ 0, 0, 0, 1]
m23 =
[ cos(q2), 0, -sin(q2), 0]
[ sin(q2), 0, cos(q2), 0]
[ 0, -1, 0, 0]
[ 0, 0, 0, 1]
m34 =
[ 1, 0, 0, 0]
[ 0, 1, 0, 0]
[ 0, 0, 1, d3 + q3]
[ 0, 0, 0, 1]
m14 = m12* m23* m34
[ cos(q1 + q2), 0, -sin(q1 + q2), a1*cos(q1) - sin(q1 + q2)*(d3 + q3)]
[ sin(q1 + q2), 0, cos(q1 + q2), a1*sin(q1) + cos(q1 + q2)*(d3 + q3)]
[ 0, -1, 0, 0]
[ 0, 0, 0, 1].
L'une des pattes avant peut être modélisée par le schéma suivant
:
Ce robot est représenté dans la position où ses coordonnées
articulaires q1, q2, q3 et q4 sont nulles.
On considère que le robot évolue dans le plan de la figure, c'est
à dire que q1 = 0. Dans ce cas particulier,
z1 z2
q1 = 0 q2
x2
x1
y1 y2
y4
z3
z4 y3
x4
q4 q3
x3
z5
y5
x5
M45 =
[ cos(q4 - pi/2), -sin(q4 - pi/2), 0, L4*cos(q4 - pi/2)]
[ sin(q4 - pi/2), cos(q4 - pi/2), 0, L4*sin(q4 - pi/2)]
[ 0, 0, 1, 0]
[ 0, 0, 0, 1]
=
[ sin(q4), cos(q4), 0, L4*sin(q4)]
[ -cos(q4), sin(q4), 0, -L4*cos(q4)]
[ 0, 0, 1, 0]
[ 0, 0, 0, 1]
M15 = M12.M23.M34.M45=[ R15 O1O5]
R15=
[ -sin(q2 + q3 + q4), -cos(q2 + q3 + q4), 0]
[ cos(q2 + q3 + q4) , -sin(q2 + q3 + q4), 0]
[ 0, 0, 1]
O1O5 =
[L0 + L1 - L3*cos(q2 + q3) - L2*sin(q2) - L4*sin(q2 + q3 + q4)]
[L2*cos(q2) - L3*sin(q2 + q3) + L4*cos(q2 + q3 + q4) ]
[ 0]
Correction
+) les coordonnées 1P(q1=0, q2=0, q3=0 et q4=0)= [L0 + L1 - L3, L2 +
L4,0]’
Ex1 :
syms q1 q2 q3 a1 d3 real
m12=[ cos(q1) -sin(q1) 0 a1*cos(q1); sin(q1) cos(q1) 0 a1*sin(q1); 0 0 1
0; 0 0 0 1]
m23=[ cos(q2) 0 -sin(q2) 0 ; sin(q2) 0 cos(q2) 0; 0 -1 0 0; 0 0 0 1]
m34=[ 1 0 0 0; 0 1 0 0; 0 0 1 q3+d3; 0 0 0 1]
m14=m12*m23*m34
m14=simplify(m14)
m24=m23*m34
m24=simplify(m24)
Ex2 :
syms q1 q2 q3 q4 L0 L1 L2 L3 L4 real
M12=[ 1 0 0 L0+L1; 0 1 0 0; 0 0 1 0; 0 0 0 1]
M23=[ cos(q2+pi/2) -sin(q2+pi/2) 0 L2*cos(q2+pi/2); sin(q2+pi/2)
cos(q2+pi/2) 0 L2*sin(q2+pi/2); 0 0 1 0; 0 0 0 1]
M23=simplify(M23)
M34=[ cos(q3+pi/2) -sin(q3+pi/2) 0 L3*cos(q3+pi/2); sin(q3+pi/2)
cos(q3+pi/2) 0 L3*sin(q3+pi/2); 0 0 1 0; 0 0 0 1]
M34=simplify(M34)
M45=[ cos(q4-pi/2) -sin(q4-pi/2) 0 L4*cos(q4-pi/2); sin(q4-pi/2) cos(q4-
pi/2) 0 L4*sin(q4-pi/2); 0 0 1 0; 0 0 0 1]
M45=simplify(M45)
M15 = M12*M23*M34*M45
M15=simplify(M15)