Resultados Robots de la Jacobiana inversa por medio de matlab, Apuntes de Dinámica de sistemas
octavio-humberto-cas
octavio-humberto-cas

Resultados Robots de la Jacobiana inversa por medio de matlab, Apuntes de Dinámica de sistemas

TXT (11 KB)
3 páginas
20Número de visitas
Descripción
Resultados de los jacobianos de un robot con una pata
20 Puntos
Puntos necesarios para descargar
este documento
Descarga el documento
Vista previa3 páginas / 3
Descarga el documento

tao = aq1*l1^2*m1 + aq1*l1^2*m2 + aq1*l1^2*m3 + (aq1*l2^2*m2)/2 + (aq1*l2^2*m3)/2 + (aq1*l3^2*m3)/2 + (13*aq1*lc1^2*m1)/12 + (13*aq1*lc2^2*m2)/24 + (13*aq1*lc3^2*m3)/24 + 2*aq1*l1*lc1*m1 + aq1*l2*lc2*m2 + aq1*l3*lc3*m3 - (g*l3*m3*sin(q2 - q1 + q3))/2 - (g*lc3*m3*sin(q2 - q1 + q3))/2 + (aq1*l2^2*m2*cos (2*q2))/2 + (aq1*l2^2*m3*cos(2*q2))/2 + (13*aq1*lc2^2*m2*cos(2*q2))/24 + (g*l2*m2*cos(q1 + q2))/2 + (g*l2*m3*cos(q1 + q2))/2 + (g*lc2*m2*cos(q1 + q2))/2 - (aq1*l3^2*m3*cos(2*q2 + 2*q3))/2 - (13*aq1*lc3^2*m3*cos(2*q2 + 2*q3))/24 + g*l1*m1*cos(q1) + g*l1*m2*cos(q1) + g*l1*m3*cos(q1) + g*lc1*m1*cos(q1) + (g*l2*m2*cos(q1 - q2))/2 + (g*l2*m3*cos(q1 - q2))/2 + (g*lc2*m2*cos(q1 - q2))/2 - (g*l3*m3*sin(q1 + q2 + q3))/2 - (g*lc3*m3*sin(q1 + q2 + q3))/2 - aq1*l2*l3*m3*sin(2*q2 + q3) - aq1*l2*lc3*m3*sin(2*q2 + q3) + aq1*l2*lc2*m2*cos(2*q2) + (l3^2*m3*vq1*vq2*sin(q2))/2 + (13*lc3^2*m3*vq1*vq2*sin(q2))/24 - aq1*l3*lc3*m3*cos (2*q2 + 2*q3) + (l3^2*m3*vq1*vq2*sin(q2 + 2*q3))/2 + (13*lc3^2*m3*vq1*vq2*sin(q2 + 2*q3))/24 - 2*aq1*l1*l3*m3*sin(q2 + q3) - 2*aq1*l1*lc3*m3*sin(q2 + q3) - (l2^2*m2*vq1*vq2*sin(2*q2))/2 - (l2^2*m3*vq1*vq2*sin(2*q2))/2 - (13*lc2^2*m2*vq1*vq2*sin(2*q2))/24 + 2*aq1*l1*l2*m2*cos(q2) + 2*aq1*l1*l2*m3*cos (q2) + 2*aq1*l1*lc2*m2*cos(q2) - aq1*l2*l3*m3*sin(q3) - aq1*l2*lc3*m3*sin(q3) + (l3^2*m3*vq1*vq2*sin(2*q2 + 2*q3))/2 + (l3^2*m3*vq1*vq3*sin(2*q2 + 2*q3))/2 + (13*lc3^2*m3*vq1*vq2*sin(2*q2 + 2*q3))/24 + (13*lc3^2*m3*vq1*vq3*sin(2*q2 + 2*q3))/24 + l3*lc3*m3*vq1*vq2*sin(2*q2 + 2*q3) + l3*lc3*m3*vq1*vq3*sin(2*q2 + 2*q3) - l1*l3*m3*vq1*vq2*cos(q2 + q3) - l1*l3*m3*vq1*vq3*cos(q2 + q3) - (l2*l3*m3*vq1*vq2*cos(q2 + q3))/2 - l1*lc3*m3*vq1*vq2*cos(q2 + q3) - l1*lc3*m3*vq1*vq3*cos(q2 + q3) - (l2*lc3*m3*vq1*vq2*cos(q2 + q3))/2 - l1*l3*m3*vq1*vq2*cos(q3) - (l2*l3*m3*vq1*vq3*cos(q3))/2 - l1*lc3*m3*vq1*vq2*cos(q3) - (l2*lc3*m3*vq1*vq3*cos(q3))/2 - l1*l2*m2*vq1*vq2*sin(q2) - l1*l2*m3*vq1*vq2*sin (q2) - l1*lc2*m2*vq1*vq2*sin(q2) + l3*lc3*m3*vq1*vq2*sin(q2) - (l2*l3*m3*vq1*vq2*cos(q2 - q3))/2 - l2*l3*m3*vq1*vq2*cos(2*q2 + q3) - (l2*l3*m3*vq1*vq3*cos(2*q2 + q3))/2 - (l2*lc3*m3*vq1*vq2*cos(q2 - q3))/2 - l2*lc3*m3*vq1*vq2*cos(2*q2 + q3) - (l2*lc3*m3*vq1*vq3*cos(2*q2 + q3))/2 + l3*lc3*m3*vq1*vq2*sin(q2 + 2*q3) - l2*lc2*m2*vq1*vq2*sin(2*q2) aq2*l2^2*m2 + aq2*l2^2*m3 + aq2*l3^2*m3 + aq3*l3^2*m3 + (13*aq2*lc2^2*m2)/12 + (13*aq2*lc3^2*m3)/12 + (13*aq3*lc3^2*m3)/12 + 2*aq2*l2*lc2*m2 + 2*aq2*l3*lc3*m3 + 2*aq3*l3*lc3*m3 + (g*l3*m3*sin(q2 - q1 + q3))/2 + (g*lc3*m3*sin(q2 - q1 + q3))/2 + (g*l2*m2*cos(q1 + q2))/2 + (g*l2*m3*cos(q1 + q2))/2 + (g*lc2*m2*cos(q1 + q2))/2 - (g*l2*m2*cos(q1 - q2))/2 - (g*l2*m3*cos(q1 - q2))/2 - (g*lc2*m2*cos(q1 - q2))/2 + (l2^2*m2*vq1^2*sin(2*q2))/2 + (l2^2*m3*vq1^2*sin(2*q2))/2 + (13*lc2^2*m2*vq1^2*sin (2*q2))/24 - (g*l3*m3*sin(q1 + q2 + q3))/2 - (g*lc3*m3*sin(q1 + q2 + q3))/2 - (l3^2*m3*vq1^2*sin(2*q2 + 2*q3))/2 - (13*lc3^2*m3*vq1^2*sin(2*q2 + 2*q3))/24 + l1*l3*m3*vq1^2*cos(q2 + q3) + l1*lc3*m3*vq1^2*cos(q2 + q3) - l2*l3*m3*vq3^2*cos(q3) - l2*lc3*m3*vq3^2*cos(q3) + l1*l2*m2*vq1^2*sin(q2) + l1*l2*m3*vq1^2*sin(q2) + l1*lc2*m2*vq1^2*sin(q2) + l3^2*m3*vq1*vq3*sin(q2) + (13*lc3^2*m3*vq1*vq3*sin (q2))/12 + l2*l3*m3*vq1^2*cos(2*q2 + q3) + l2*lc3*m3*vq1^2*cos(2*q2 + q3) + l2*lc2*m2*vq1^2*sin(2*q2) - 2*aq2*l2*l3*m3*sin(q3) - aq3*l2*l3*m3*sin(q3) - 2*aq2*l2*lc3*m3*sin(q3) - aq3*l2*lc3*m3*sin(q3) - l3*lc3*m3*vq1^2*sin(2*q2 + 2*q3) + (l2*l3*m3*vq1*vq3*cos(q2 + q3))/2 + (l2*lc3*m3*vq1*vq3*cos(q2 + q3))/2 - 2*l2*l3*m3*vq2*vq3*cos(q3) - 2*l2*lc3*m3*vq2*vq3*cos(q3) + 2*l3*lc3*m3*vq1*vq3*sin(q2) - (l2*l3*m3*vq1*vq3*cos(q2 - q3))/2 - (l2*lc3*m3*vq1*vq3*cos(q2 - q3))/2

m3*(l3 + lc3)*(aq2*l3 + aq3*l3 + aq2*lc3 + aq3*lc3 + (g*sin(q2 - q1 + q3))/2 - (g*sin(q1 + q2 + q3))/2 - aq2*l2*sin(q3) - (l3*vq1^2*sin(2*q2 + 2*q3))/2 - (lc3*vq1^2*sin(2*q2 + 2*q3))/2 + l1*vq1^2*cos(q2 + q3) + (l2*vq1^2*cos(q3))/2 + l2*vq2^2*cos(q3) + (l2*vq1^2*cos(2*q2 + q3))/2 + l3*vq1*vq3*sin(q2) + lc3*vq1*vq3*sin(q2)) + (lc3^2*m3* (aq2 + aq3 + vq1*vq3*sin(q2)))/12 - (lc3^2*m3*vq1^2*sin(2*q2 + 2*q3))/24 tao1 = aq1*l1^2*m1 + aq1*l1^2*m2 + aq1*l1^2*m3 + (aq1*l2^2*m2)/2 + (aq1*l2^2*m3)/2 + (aq1*l3^2*m3)/2 + (13*aq1*lc1^2*m1)/12 + (13*aq1*lc2^2*m2)/24 + (13*aq1*lc3^2*m3)/24 + 2*aq1*l1*lc1*m1 + aq1*l2*lc2*m2 + aq1*l3*lc3*m3 - (g*l3*m3*sin(q2 - q1 + q3))/2 - (g*lc3*m3*sin(q2 - q1 + q3))/2 + (aq1*l2^2*m2*cos (2*q2))/2 + (aq1*l2^2*m3*cos(2*q2))/2 + (13*aq1*lc2^2*m2*cos(2*q2))/24 + (g*l2*m2*cos(q1 + q2))/2 + (g*l2*m3*cos(q1 + q2))/2 + (g*lc2*m2*cos(q1 + q2))/2 - (aq1*l3^2*m3*cos(2*q2 + 2*q3))/2 - (13*aq1*lc3^2*m3*cos(2*q2 + 2*q3))/24 + g*l1*m1*cos(q1) + g*l1*m2*cos(q1) + g*l1*m3*cos(q1) + g*lc1*m1*cos(q1) + (g*l2*m2*cos(q1 - q2))/2 + (g*l2*m3*cos(q1 - q2))/2 + (g*lc2*m2*cos(q1 - q2))/2 - (g*l3*m3*sin(q1 + q2 + q3))/2 - (g*lc3*m3*sin(q1 + q2 + q3))/2 - aq1*l2*l3*m3*sin(2*q2 + q3) - aq1*l2*lc3*m3*sin(2*q2 + q3) + aq1*l2*lc2*m2*cos(2*q2) + (l3^2*m3*vq1*vq2*sin(q2))/2 + (13*lc3^2*m3*vq1*vq2*sin(q2))/24 - aq1*l3*lc3*m3*cos (2*q2 + 2*q3) + (l3^2*m3*vq1*vq2*sin(q2 + 2*q3))/2 + (13*lc3^2*m3*vq1*vq2*sin(q2 + 2*q3))/24 - 2*aq1*l1*l3*m3*sin(q2 + q3) - 2*aq1*l1*lc3*m3*sin(q2 + q3) - (l2^2*m2*vq1*vq2*sin(2*q2))/2 - (l2^2*m3*vq1*vq2*sin(2*q2))/2 - (13*lc2^2*m2*vq1*vq2*sin(2*q2))/24 + 2*aq1*l1*l2*m2*cos(q2) + 2*aq1*l1*l2*m3*cos (q2) + 2*aq1*l1*lc2*m2*cos(q2) - aq1*l2*l3*m3*sin(q3) - aq1*l2*lc3*m3*sin(q3) + (l3^2*m3*vq1*vq2*sin(2*q2 + 2*q3))/2 + (l3^2*m3*vq1*vq3*sin(2*q2 + 2*q3))/2 + (13*lc3^2*m3*vq1*vq2*sin(2*q2 + 2*q3))/24 + (13*lc3^2*m3*vq1*vq3*sin(2*q2 + 2*q3))/24 + l3*lc3*m3*vq1*vq2*sin(2*q2 + 2*q3) + l3*lc3*m3*vq1*vq3*sin(2*q2 + 2*q3) - l1*l3*m3*vq1*vq2*cos(q2 + q3) - l1*l3*m3*vq1*vq3*cos(q2 + q3) - (l2*l3*m3*vq1*vq2*cos(q2 + q3))/2 - l1*lc3*m3*vq1*vq2*cos(q2 + q3) - l1*lc3*m3*vq1*vq3*cos(q2 + q3) - (l2*lc3*m3*vq1*vq2*cos(q2 + q3))/2 - l1*l3*m3*vq1*vq2*cos(q3) - (l2*l3*m3*vq1*vq3*cos(q3))/2 - l1*lc3*m3*vq1*vq2*cos(q3) - (l2*lc3*m3*vq1*vq3*cos(q3))/2 - l1*l2*m2*vq1*vq2*sin(q2) - l1*l2*m3*vq1*vq2*sin (q2) - l1*lc2*m2*vq1*vq2*sin(q2) + l3*lc3*m3*vq1*vq2*sin(q2) - (l2*l3*m3*vq1*vq2*cos(q2 - q3))/2 - l2*l3*m3*vq1*vq2*cos(2*q2 + q3) - (l2*l3*m3*vq1*vq3*cos(2*q2 + q3))/2 - (l2*lc3*m3*vq1*vq2*cos(q2 - q3))/2 - l2*lc3*m3*vq1*vq2*cos(2*q2 + q3) - (l2*lc3*m3*vq1*vq3*cos(2*q2 + q3))/2 + l3*lc3*m3*vq1*vq2*sin(q2 + 2*q3) - l2*lc2*m2*vq1*vq2*sin(2*q2) tao2 = aq2*l2^2*m2 + aq2*l2^2*m3 + aq2*l3^2*m3 + aq3*l3^2*m3 + (13*aq2*lc2^2*m2)/12 + (13*aq2*lc3^2*m3)/12 + (13*aq3*lc3^2*m3)/12 + 2*aq2*l2*lc2*m2 + 2*aq2*l3*lc3*m3 + 2*aq3*l3*lc3*m3 + (g*l3*m3*sin(q2 - q1 + q3))/2 + (g*lc3*m3*sin(q2 - q1 + q3))/2 + (g*l2*m2*cos(q1 + q2))/2 + (g*l2*m3*cos(q1 + q2))/2 + (g*lc2*m2*cos(q1 + q2))/2 - (g*l2*m2*cos(q1 - q2))/2 - (g*l2*m3*cos(q1 - q2))/2 - (g*lc2*m2*cos(q1 - q2))/2 + (l2^2*m2*vq1^2*sin(2*q2))/2 + (l2^2*m3*vq1^2*sin(2*q2))/2 + (13*lc2^2*m2*vq1^2*sin (2*q2))/24 - (g*l3*m3*sin(q1 + q2 + q3))/2 - (g*lc3*m3*sin(q1 + q2 + q3))/2 - (l3^2*m3*vq1^2*sin(2*q2 + 2*q3))/2 - (13*lc3^2*m3*vq1^2*sin(2*q2 + 2*q3))/24 +

l1*l3*m3*vq1^2*cos(q2 + q3) + l1*lc3*m3*vq1^2*cos(q2 + q3) - l2*l3*m3*vq3^2*cos(q3) - l2*lc3*m3*vq3^2*cos(q3) + l1*l2*m2*vq1^2*sin(q2) + l1*l2*m3*vq1^2*sin(q2) + l1*lc2*m2*vq1^2*sin(q2) + l3^2*m3*vq1*vq3*sin(q2) + (13*lc3^2*m3*vq1*vq3*sin (q2))/12 + l2*l3*m3*vq1^2*cos(2*q2 + q3) + l2*lc3*m3*vq1^2*cos(2*q2 + q3) + l2*lc2*m2*vq1^2*sin(2*q2) - 2*aq2*l2*l3*m3*sin(q3) - aq3*l2*l3*m3*sin(q3) - 2*aq2*l2*lc3*m3*sin(q3) - aq3*l2*lc3*m3*sin(q3) - l3*lc3*m3*vq1^2*sin(2*q2 + 2*q3) + (l2*l3*m3*vq1*vq3*cos(q2 + q3))/2 + (l2*lc3*m3*vq1*vq3*cos(q2 + q3))/2 - 2*l2*l3*m3*vq2*vq3*cos(q3) - 2*l2*lc3*m3*vq2*vq3*cos(q3) + 2*l3*lc3*m3*vq1*vq3*sin(q2) - (l2*l3*m3*vq1*vq3*cos(q2 - q3))/2 - (l2*lc3*m3*vq1*vq3*cos(q2 - q3))/2 tao3 = m3*(l3 + lc3)*(aq2*l3 + aq3*l3 + aq2*lc3 + aq3*lc3 + (g*sin(q2 - q1 + q3))/2 - (g*sin(q1 + q2 + q3))/2 - aq2*l2*sin(q3) - (l3*vq1^2*sin(2*q2 + 2*q3))/2 - (lc3*vq1^2*sin(2*q2 + 2*q3))/2 + l1*vq1^2*cos(q2 + q3) + (l2*vq1^2*cos(q3))/2 + l2*vq2^2*cos(q3) + (l2*vq1^2*cos(2*q2 + q3))/2 + l3*vq1*vq3*sin(q2) + lc3*vq1*vq3*sin(q2)) + (lc3^2*m3* (aq2 + aq3 + vq1*vq3*sin(q2)))/12 - (lc3^2*m3*vq1^2*sin(2*q2 + 2*q3))/24 >>

No hay comentarios
Descarga el documento