Escolar Documentos
Profissional Documentos
Cultura Documentos
SÃO CARLOS - SP
2022
1
SUMÁRIO
1. INTRODUÇÃO 2
2. CINEMÁTICA DIRETA 3
2.1. TRANSFORMAÇÕES DE BASES 3
2.2. NOTAÇÃO DENAVIT-HARTENBERG 3
2.3. LIMITAÇÕES DE JUNTAS 5
2.4. CÓDIGOS DA CONSTRUÇÃO DO KUKA E DA CINEMÁTICA DIRETA 6
2.5. RESULTADOS OBTIDOS 7
2.5.1. Tabelas de parâmetros da matriz Denavit-Hartenberg 7
2.5.2. Imagens da simulação 8
3. CINEMÁTICA INVERSA 9
3.1. ENVELOPE DE TRABALHO DO ROBÔ 9
3.2. CÓDIGO DA CINEMÁTICA INVERSA 10
3.3. RESULTADOS OBTIDOS 10
3.3.1. Dados numéricos 10
3.3.2. Imagens da simulação 11
4. JACOBIANO 12
4.1. DEFINIÇÃO DE JACOBIANO 12
4.2. APLICANDO O JACOBIANO 12
5. DINÂMICA 14
5.1. EQUAÇÕES DE MOVIMENTO DE CORPO RÍGIDO 14
5.2. DINÂMICA DIRETA 14
5.3. CÓDIGO E DEFINIÇÕES DAS VARIÁVEIS DINÂMICAS 15
6. CONTROLE 17
7. SIMULAÇÃO DA TRAJETÓRIA 20
7.1. CÓDIGO 20
7.2. RESULTADOS 22
8. REFERÊNCIAS 25
2
1. INTRODUÇÃO
Figura 1 - Robô Kuka KR 1000 TITAN com cotas referentes ao envelope de trabalho
2. CINEMÁTICA DIRETA
ângulo entre os
variável de uma
Ângulo de junta θj eixos xj-1 e xj em
junta de revolução
relação ao eixo zj-1
distância da
Deslocamento de origem da base j-1 variável de uma
dj
link ao eixo xj ao longo junta prismática
do eixo zj-1
distância entre os
Comprimento de eixos zj-1 e zj ao
aj constante
link longo do eixo xj; é
paralelo a ẑj-1 ⨯ ẑj
Range of motion,
Axis
software-limited
1 +/- 150°
2 +17.5° to -130°
3 +145° to -110°
4 +/- 350°
5 +/- 118°
6 +/- 350°
Fonte: Elaborada pelos autores
6
clc
clear all
close all
a1 = 0.6;
a2 = 1.4;
a3 = 0; % para fins de simulação
d1 = 1.1;
d4 = 1.6;
d6 = 0.4;
% Criando o robô
kuka = SerialLink(L, 'name', 'Braço articulado de 6 juntas');
kuka.plot(qf0)
3. CINEMÁTICA INVERSA
−1
𝑞 = 𝒦 (ξ)
4. JACOBIANO
𝑑𝑝
𝑑𝑞
= 𝐽(𝑞)
𝑑𝑝 = 𝐽(𝑞)𝑑𝑞
𝑑𝑝 𝑑𝑞
𝑑𝑡
= 𝐽(𝑞) 𝑑𝑡
5. DINÂMICA
% Gravidade em m/s^2
L(1).G = 9.81;
L(2).G = 9.81;
L(3).G = 9.81;
L(4).G = 9.81;
L(5).G = 9.81;
L(6).G = 9.81;
% Inércia do Motor
L(1).Jm = 0;
L(2).Jm = 0;
L(3).Jm = 0;
L(4).Jm = 0;
L(5).Jm = 0;
L(6).Jm = 0;
6. CONTROLE
Constante de Torque do
Kt 0.4602 N.m
Motor
Kg Redução 80
Coeficiente Viscoso de
Beq 2.4e-1 N.m.s
Amortecimento
Momento de Inércia do
Jm 2.76e-5 kg.m2
Rotor
Momento de Inércia
Jeq 1.2e-1 kg.m2
Equivalente da Carga
Com as FTs definidas a ferramenta sisotool do Matlab foi usada para obter
uma resposta que se adequasse à nossa aplicação, com a opção do PID tuning, foi
obtido o seguinte resultado para o controlador:
19
7. SIMULAÇÃO DA TRAJETÓRIA
7.1. CÓDIGO
qb = [0 0 0 0 0 0];
Ti = transl(3,1.5,1); % Coordenadas requeridas (x,y,z) do end-effector (mudar para a
requerida)
% Basear-se no envelope de trabalho para as coodenadas
qe = kuka.ikine(Ti); %coordenadas de juntas (rad) para o Ti obtido
%kuka.plot(qi) % plota a posição final graficamente
Tempo = 0:1:30;
Mov = kuka.fkine(Traj);
X = transl(Mov);
figure
21
figure
%simulação da trajetória do robo
kuka.plot(qb)
hold on
plot3(X(:,1),X(:,2),X(:,3))
kuka.plot(Traj)
title('Trajetória')
figure
%plotando as acelerações
plot(QDD(:,1))
hold on
plot(QDD(:,2))
plot(QDD(:,3))
plot(QDD(:,4))
plot(QDD(:,5))
plot(QDD(:,6))
title('Acelerações')
figure
%plotando as velocidades
plot(QD(:,1))
hold on
plot(QD(:,2))
plot(QD(:,3))
plot(QD(:,4))
plot(QD(:,5))
plot(QD(:,6))
title('Velocidades')
figure
%plotando as posições
plot(Q(:,1))
hold on
plot(Q(:,2))
plot(Q(:,3))
plot(Q(:,4))
plot(Q(:,5))
plot(Q(:,6))
title('Posições')
22
C = kuka.coriolis(q,qd);
7.2. RESULTADOS
8. REFERÊNCIAS
[1] https://physika.info/site/documents/PFC-Itallo(2014).pdf
[2]
https://www.kuka.com/pt-br/produtos-servi%C3%A7os/sistemas-de-rob%C3%B4/rob
%C3%B4s-industriais/kr-1000-titan
[3] https://grabcad.com/library/robot-kuka-kr1000-1
[4]
https://mecanica.ufes.br/sites/engenhariamecanica.ufes.br/files/field/anexo/2009-2_f
elipe_padilha_e_beatriz_miranda.pdf
[5] CORKE, Peter I. Robotics Toolbox for MATLAB®. 10. ed. 2020. Disponível em:
https://petercorke.com/download/27/rtb/1050/rtb-manual.pdf.