𝟏 𝟎 𝟎 𝒍𝟏
𝑨𝟏 𝟎 = [𝟎 𝟎 𝟏 𝟎]
𝟎 −𝟏 𝟎 𝒒𝟏
𝟎 𝟎 𝟎 𝟏
𝟏 𝟎 𝟎 𝟎
𝑨𝟐 𝟏 = [𝟎 𝟎 −𝟏 𝟎 ]
𝟎 𝟏 𝟎 𝒒𝟐
𝟎 𝟎 𝟎 𝟏
• Matriz de transformación del sistema 3 al 2.
Cálculo Matlab
𝟏 𝟎 𝟎 𝒍𝟏
𝒒𝟐
𝑨𝟐 𝟎 = [𝟎 𝟏 𝟎 ]
𝟎 𝟎 𝟏 𝒒𝟏
𝟎 𝟎 𝟎 𝟏
𝒙 = 𝒍𝟏 + 𝒍𝟐 ∙ 𝐜𝐨𝐬(𝒒𝟑)
𝒚 = 𝒒𝟐 + 𝒍𝟐 ∙ 𝐬𝐢𝐧(𝒒𝟑)
𝒛 = 𝒒𝟏
𝟎 𝟎 −𝒍𝟐 ∗ 𝒔𝒊𝒏(𝒒𝟑)
𝑱 = [𝟎 𝟏 𝒍𝟐 ∗ 𝒄𝒐𝒔(𝒒𝟑) ]
𝟏 𝟎 𝟎
• Valores de J resultantes
Cálculo Matlab
𝒙̇ = −𝒍𝟐 ∙ 𝒔𝒊𝒏(𝒒𝟑)
𝒚̇ = 𝒍𝟐 ∙ 𝒄𝒐𝒔(𝒒𝟑)
𝒛̇ = 𝟎
• ANEXOS
CÓDIGO
%% ROBOT PPR
% UNIVERSIDAD POLITECNICA SALESIANA
% NOMBRES: SANTIAGO FEICAN, PABLO GÓMEZ, ROMANELLA SORIA
% MATERIA: ROBÓTICA
% INGENIERIA MECATRONICA 9NO CICLO
clc;
clear all;
close all;
%% Cinemática Directa
syms q1 q2 q3 l1 l2;
%Valores de distancias ai
a1 = l1;
a2 = 0;
a3 = l2;
%% Matriz Jacobiana
xo = A03(1,4)
yo = A03(2,4)
zo = A03(3,4)
% Factores de Jacobianos
q1_1=diff(xo,q1);
q1_2=diff(yo,q1);
q1_3=diff(zo,q1);
q2_1=diff(xo,q2);
q2_2=diff(yo,q2);
q2_3=diff(zo,q2);
q3_1=diff(xo,q3);
q3_2=diff(yo,q3);
q3_3=diff(zo,q3);
% Parametros Jacobiano
dx= J(1,3) %Xprima
dy= J(2,3) %Yprima
dz= J(3,3) %Zprima