TP 63
TP 63
TP 63
Jacobiano
Ejercicio 1: Considere el robot planar de 2 gdl de la siguiente figura.
𝑥 = 𝑎1 cos(𝜃1 ) + 𝑎2 cos(𝜃1 + 𝜃2 )
𝑦 = 𝑎1 sin(𝜃1 ) + 𝑎2 sin(𝜃1 + 𝜃2 )
𝑧=0
𝛼=0
𝛽=0
𝛾 = 𝜃1 + 𝜃2
1. Mediante derivación respecto del tiempo obtenga el Jacobiano del robot que
corresponde a:
𝑝̇ = 𝐽(𝑞)𝑞̇
Donde:
- 𝑝̇ = [𝑥̇ 𝑦̇ 𝑧̇ 𝛼̇ 𝛽̇ 𝛾̇ ]𝑇
- 𝑞 = [𝜃1 𝜃2 ]𝑇
ROBOTICA I
Trabajo Práctico N°6
3. Trabaje solo con las coordenadas X-Y (primeras 2 filas del 𝐽) y verifique mediante la
inversa algebraica que 𝑞̇ = 𝐽−1 (𝑞)𝑝̇ se cumple.
1.
2.
3.
Ejercicio 3: El siguiente código de ejemplo se puede utilizar para obtener el Jacobiano del
ejercicio 1 de forma general. Haga los cambios necesarios para verificar los resultados del
ejercicio 2. Tenga en cuenta que con las identidades trigonométricas se puede cambiar
radicalmente una misma expresión.
syms q1 q2 a1 a2 real
q = [q1 q2];
dh = [0,0,a1,0,0;
ROBOTICA I
Trabajo Práctico N°6
0,0,a2,0,0];
R = SerialLink(dh);
J = simplify(R.jacob0(q));
disp(J)
Ejercicio 4: Agregando el código siguiente al código anterior, se puede observar una expresión
simplificada del determinante del Jacobiano del mismo robot. Es importante recordar que una
matriz cuadrada tiene inversa únicamente si su determinante es distinto de cero.
Jr = J(1:2,:);
DJr = simplify(det(Jr));
disp(DJr)
1) Adapte el código anterior para analizar el Jacobiano simbólico y halle la expresión del
determinante. ¿Puede aplicar los puntos 1 y 2 del ejercicio anterior?
2) Trabaje numéricamente con longitud de eslabón 1, 0.8 y 0.6. Calcule el Jacobiano y su
determinante para 𝑞 = [𝜋/6 0 𝜋/6]. Verifique que el determinante es cero.
Verifique que el rango de la matriz es menor que los GDL del robot (función “rank”).
Ejecute la función “jsingu(J)” e interprete y relacione el resultado con el robot del
ejercicio 1.
3) Para la posición articular anterior:
a. Calcule la velocidad articular requerida para lograr las siguientes velocidades
cartesianas: 𝑣 = [1 0 0]. Use el jacobiano reducido.
b. ¿Por qué existe inversa?
c. ¿Cuál es el número de condición del jacobiano reducido?
d. Asuma que 𝑞2 no es cero, sino que está cerca: 𝑞2 = 0.001. ¿Cuánto valen las
velocidades articulares para lograr el mismo 𝑣?
e. ¿Cuánto valen el determinante y el número de condición del jacobiano en este
caso?
f. ¿Qué conclusión puede sacar sobre la proximidad del punto singular?
4) Adopte la posición articular 𝑞 = [𝜋/3 −𝜋/3 −𝜋/2]:
a. Realice un plot del robot agregando las opciones ‘view’, ‘top’ para tener una
vista del plano.
b. Después de usar “hold on” haga una elipse de manipulabilidad traslacional en
el extremo del robot con la función “plot_ellipse”. Use “help plot_ellipse” para
ver los parámetros necesarios. Tenga en cuenta que el resultado debe ser una
elipse traslacional en el plano, por lo que el jacobiano reducido necesario debe
tener solo las primeras 2 filas.
ROBOTICA I
Trabajo Práctico N°6
c. Calcule con “ikine” la otra posición articular que dejar el extremo en igual
posición y orientación cartesianas. Dibuje una elipse en el extremo para este
caso.
d. Dibuje una elipse para la posición singular dada por 𝑞 = [𝜋/4 0 0].
e. Teniendo en cuenta que los ejes de la elipse indican la magnitud de las
velocidades que puede alcanzar el extremo en esas direcciones, responda:
i. ¿Cómo debe ser la elipse para que el extremo pueda alcanzar
cualquier velocidad en cualquier dirección?
ii. ¿Cómo debe ser la elipse para que el extremo no pueda lograr
velocidades en alguna dirección en particular?
iii. ¿La elipse (y por lo tanto la posibilidad de lograr velocidades en
distintas direcciones) depende de la posición final del extremo o de la
posición articular completa?
iv. ¿En cuál de las configuraciones el robot tiene una mejor
manipulabilidad traslacional?