Professional Documents
Culture Documents
Nombre
Smbolo
Grados de Libertad
Superficie Comn
Rotacional
Cilindro
Prismtica
Prisma
Helicoidal
Tornillo
Cilndrica
Cilindro
Esfrica
Esfera
Planar
Plano
Las operaciones que podemos realizar con matrices y vectores son diversas . Las ms comunes son:
R3 x3
T
f1x3
P3 x1
R1x1
R- matriz de rotacin
p- matriz de traslacin
f- matriz de perspectiva
w- matriz de escaldo
Es importante notar que el producto de estas matrices en general no es
conmutativo
SOLUCIN
>> Tp=[1 0 0 6;0 1 0 3; 0 0 1 8;0 0 0 1];
>> ruvw=[-2 7 3 1]';
>> rxyz=Tp*ruvw
rxyz =
4
10
11
1
r1xyz =
10
7
19
1
Se trata de realizar primero una rotacin sobre uno de los ejes del
sistema OXYZ seguida de una traslacin, las matrices homogneas
sern las que a continuacin se expresan:
Rotacin de un ngulo a sobre el eje OX seguido de una traslacin
de vector pxyz
% T((x,a),p)= [1 0 0 px;0 cosa sena py;0 sena cosa pz;0 0 0 1] (VI)
>> t1=rotz(-pi/2)
t1 =
0.0000 1.0000
0
0
-1.0000 0.0000
0
0
0
0 1.0000
0
0
0
0 1.0000
>> ruvw=[4 8 12 1]'
ruvw =
4
8
12
1
>> rxyz=t1*ruvw
rxyz =
8.0000
-4.0000
12.0000
Queda as:
Txa=[1 0 0 8;0 0 -1 -4;0 1 0 12;0 0 0 1]
Txa =
1008
0014
0 1 0 12
0001
[ru rv rw 1]'= ruvw=[-3,4, -11,1]'
% Ahora ya podemos aplicar [rx ry rz 1]'=T[ru rv rw 1]' ,
ecuacin (IV).
Se trata de realizar primero una traslacin seguida de una rotacin sobre los
ejes coordenados del sistema OXYZ. Las matrices homogneas resultantes son
las siguientes:
Traslacin del vector px, y, z seguida de rotacin de un ngulo a sobre el eje
OX. T(p,(x,a))= [1 0 0 px; 0 cosa sena pycosa-pzsena; 0 sena cosa
pysena+pzcosa;0 0 0 1] (I)
Traslacin del vector px, y, z seguida de rotacin de un ngulo b sobre el eje
OY. T(p,(y,b))= [cosb 0 senb pxcosb+pzsenb;0 1 0 py; senb 0 cosb
pzcosb+pxsenb; 0 0 0 1] (II).
tr = trotx(.2)*troty(.3)*transl(1,2,3)
trplot(tr)
4
Z
3.5
3
X
2.5
2
2.5
2
3
2.5
1.5
1.5
0.5
1
X
0
0
1
0
0 8
-1 -12
0 -4
0 1
>> Tpxa*ruvw
ans =
11
-23
0
1
11.0000
-23.0000
0.0000
1.0000
>> T=rotz(pi/2)*Tp*rotx(pi/2)
T=
0.0000 -0.0000 1.0000 -5.0000
1.0000 0.0000 -0.0000 5.0000
0 1.0000 0.0000 10.0000
0
0
0 1.0000
T=r2t(rotz(pi/2))*transl(5,5,10)*r2t(rotx(-pi/2))
T=
0.0000 -0.0000 -1.0000 -5.0000
1.0000 0.0000 0.0000 5.0000
0
-1.0000 0.0000 10.0000
0
0
0
1.0000
x l1 cos 1 l2 cos q1 q2
y l1sen1 l2 sen q1 q2
>> L1=1
>> L2=1
>> th1=0:(pi/2)/20:pi/2
>> th2=0:(pi/2)/20:pi/2
>> px=L1*cos(th1)+L2*cos(th1+th2)
>> py=L1*sin(th1)+L2*sin(th1+th2)
>> plot(px,py)
function valor_a_retornar=nombre_de_funcion(parametros,...)
function p=pcd(L1,L2,th1,th2)
px=L1*cos(th1)+L2*cos(th1+th2);
py=L1*sin(th1)+L2*sin(th1+th2);
p=[px; py]
donde p es la variable que se retorna, y pcd es el nombre de la
funcin seguido de los argumentos. La variable p contiene en la primera
fila la secuencia de coordenadas X, y en la segunda las Y. La funcin
debe escribirse en un fichero de texto separado cuyo nombre debe ser
el de la funcin seguido de la extensin .m (pcd.m).
>> p=pcd(L1,L2,th1,th2);
>> plot(p(1,:),p(2,:))
Eslabn 1:
a1 = 350 mm
d1= 460.5 mm
1 = 0
1 = 1 {variable, rotacin}
Eslabn 2:
a2 = 250 mm
d2= 85.5 mm
2= 0
2 = 2 {variable, rotacin}
Eslabn 3:
a3 = 0 mm
d3= d3 {variable, prismtica}
3 = 0
3 = 0
yz x
SRX 611
-1
1
0.5
1
0.5
-0.5
Y
-1
-0.5
-1
X
UNIN
ai
alfai
di
tetai
q1
q2
0.000000
yz x
0
D2
-1
-2
2
1
2
1
-1
Y
-1
-2
-2
Cinemtica Directa
T = fkine(robot, q)
fkine calcula la cinemtica directa para un vector q que
representa las coordenadas de la articulacin. Devuelve una
matriz de transformacin homognea que describe el efector
final.
UNIN
Teta
alfa
q1
l1
90
d2
90
d3
q4
l4
4
3
2
rob =
1
x
ROBCIL
-1
-2
-3
-4
4
2
0
-2
-4
-4
-2
standard D&H
parameters
X
D
(std)
(std)
(std)
(std)
R/P
PARMETROS D - H
UNIN
Teta
alfa
q1
l1
d2
-a2
-90
d3
q4
l4
PARMETROS D - H
UNIN
Teta
alfa
q1+90
l1
-90
q2-90
a2
q3+180
90
q4
l4
-90
q5
90
q6
l6