14624

Решение прямой задачи кинематики манипулятора

Лабораторная работа

Физика

Лабораторная работа №3: Вариант 1 Решение прямой задачи кинематики манипулятора. Цель работы: решение прямой задачи о положении манипуляционной системы на ЭВМ на основе формализованного описания кинематических цепей Геометрические характеристики звеньев: ...

Русский

2013-06-08

294 KB

36 чел.

Лабораторная работа №3:

Вариант 1

Решение прямой задачи кинематики манипулятора.

Цель работы:

решение прямой задачи о положении манипуляционной системы на ЭВМ на основе формализованного описания кинематических цепей

Геометрические характеристики звеньев:

L1=560 мм

L2=500 мм

L3=767 мм

L4=95 мм

Таблица кодирования основанная на методе Денавита-Хартенберга:

1

2

3

4

0

L2

L3

0

90

0

0

90

L1

L2

L3

L4

90+

 

Матрица преобразований в общем виде:

Матрицы преобразований, соответствующие кодам:

Программа для расчета абсолютных координат точек позиционирования по заданным значениям перемещений:

l1=560;

l2=500;

l3=767;

l4=295;

a1=0; a2=l2; a3=l3; a4=0;

al1=pi/2; al2=0; al3=0; al4=pi/2;

s1=l1; s2=l2; s3=l3; s4=l4;

x=ones(1,500);

y=ones(1,500);

z=ones(500,500);

for t=0:0.1:50,

i=1;    

q1=0.01*t;

q2=0.63*t;

q3=0.9*t;

q4=0.2*t;

Q1=pi/2+q1;

Q2=q2;

Q3=q3;

Q4=3*pi/2+q4;

%%syms Q1 Q2 Q3 Q4 al1 al2 al3 al4 a1 a2 a3 a4 s1 s2 s3 s4 A1 A2 A3 A4 Arez

%matrix

A0=[0;

   0;

   0;

   1];

A1=[cos(Q1),-cos(al1)*sin(Q1),sin(al1)*sin(Q1),a1*cos(Q1);

   sin(Q1),cos(al1)*cos(Q1),-sin(al1)*cos(Q1),a1*sin(Q1);

   0,sin(al1),cos(al1),s1;

   0,0,0,1];

A2=[cos(Q2),-cos(al2)*sin(Q2),sin(al2)*sin(Q2),a2*cos(Q2);

   sin(Q2),cos(al2)*cos(Q2),-sin(al2)*cos(Q2),a2*sin(Q2);

   0,sin(al2),cos(al2),s2;

   0,0,0,1];

A3=[cos(Q3),-cos(al3)*sin(Q3),sin(al3)*sin(Q3),a3*cos(Q3);

   sin(Q3),cos(al3)*cos(Q3),-sin(al3)*cos(Q3),a3*sin(Q3);

   0,sin(al3),cos(al3),s3;

   0,0,0,1];

A4=[cos(Q4),-cos(al4)*sin(Q4),sin(al4)*sin(Q4),a4*cos(Q4);

   sin(Q4),cos(al4)*cos(Q4),-sin(al4)*cos(Q4),a4*sin(Q4);

   0,sin(al4),cos(al4),s4;

   0,0,0,1];

Arez=A1*A2*A3*A4*A0;

Arez=Arez';

x(i)=Arez(1);

y(i)=Arez(2);

z(i,i)=Arez(3);

i=i+1;

end

surf(x,y,z)

shading interp

colorbar

Arez

Результат работы программы – конечная точка РО.

Arez =

  965.7   1490.4   1286.2

Графики изменения абсолютных координат для заданной программы работы робота:


 

А также другие работы, которые могут Вас заинтересовать

11662. ГАРМОНИЧЕСКИЙ АНАЛИЗ ПЕРИОДИЧЕСКИХ ФУНКЦИЙ 225 KB
  Лабораторная работа № 9 ГАРМОНИЧЕСКИЙ АНАЛИЗ ПЕРИОДИЧЕСКИХ ФУНКЦИЙ Цель работы теоретический расчет и экспериментальное изучение спектров периодических сигналов. 9.1. Краткая теория Периодическим называется сигнал для которого где посто...
11663. ИССЛЕДОВАНИЕ АКТИВНОГО ЛИНЕЙНОГО ЧЕТЫРЕХПОЛЮСНИКА 314.5 KB
  Лабораторная работа № 10 ИССЛЕДОВАНИЕ АКТИВНОГО ЛИНЕЙНОГО ЧЕТЫРЕХПОЛЮСНИКА Цель работы: исследование основных параметров линейного активного четырехполюсника частотной амплитудной переходной импульсной характеристик Y и Zпараметров. Приборы: генерато
11664. Изучение основ работы с базовыми инструментами в системе программирования VB-Net 2008 425.5 KB
  Изучение основ работы с базовыми инструментами в системе программирования VBNet 2008. Цель работы: Изучение основ работы с основными инструментами VBNET: командной строкой полем метки текстовым полем познакомиться с вспомогательными элементами управления: радиокнопкой ф
11665. ОПРЕДЕЛЕНИЕ УСКОРЕНИЯ СВОБОДНОГО ПАДЕНИЯ ПРИ ПОМОЩИ МАТЕМАТИЧЕСКОГО МАЯТНИКА 120.13 KB
  МЕТОДИЧЕСКИЕ УКАЗАНИЯ К ЛАБОРАТОРНОЙ РАБОТЕ № 1.1 ОПРЕДЕЛЕНИЕ УСКОРЕНИЯ СВОБОДНОГО ПАДЕНИЯ ПРИ ПОМОЩИ МАТЕМАТИЧЕСКОГО МАЯТНИКА ЦЕЛЬ РАБОТЫ 1 Ознакомиться с теорией маятника. 2 Экспериментальное определить ускорение свободного падения в данном географическо...
11666. ОПРЕДЕЛЕНИЕ МОМЕНТА ИНЕРЦИИ ФИЗИЧЕСКОГО МАЯТНИКА 221.71 KB
  МЕТОДИЧЕСКИЕ УКАЗАНИЯ К ЛАБОРАТОРНОЙ РАБОТЕ № 1.2 ОПРЕДЕЛЕНИЕ МОМЕНТА ИНЕРЦИИ ФИЗИЧЕСКОГО МАЯТНИКА ЦЕЛЬ РАБОТЫ: определить момент инерции физического маятника и исследовать зависимость момента инерции от положения центра масс маятника относительно оси вращен
11667. ИССЛЕДОВАНИЕ СЛОЖЕНИЯ ВЗАИМНО ПЕРПЕНДИКУЛЯРНЫХ КОЛЕБАНИЙ РАЗЛИЧНЫХ ЧАСТОТ 232.61 KB
  МЕТОДИЧЕСКИЕ УКАЗАНИЯ К ЛАБОРАТОРНОЙ РАБОТЕ № 1.4 ИССЛЕДОВАНИЕ СЛОЖЕНИЯ ВЗАИМНО ПЕРПЕНДИКУЛЯРНЫХ КОЛЕБАНИЙ РАЗЛИЧНЫХ ЧАСТОТ Цель работы: исследование траектории движения точки участвующей в двух взаимно перпендикулярных колебаниях; проверка градуировки шк
11668. ОПРЕДЕЛЕНИЕ КОЭФФИЦИЕНТА САМОИНДУКЦИИ МЕТОДОМ ЖУБЕРА 132.19 KB
  МЕТОДИЧЕСКИЕ УКАЗАНИЯ К ЛАБОРАТОРНОЙ РАБОТЕ №4.1 ОПРЕДЕЛЕНИЕ КОЭФФИЦИЕНТА САМОИНДУКЦИИ МЕТОДОМ ЖУБЕРА ЦЕЛЬ РАБОТЫ Исследовать зависимость коэффициента самоиндукции от положения подвижного сердечника. ПРИБОРЫ И ПРИНАДЛЕЖНОСТИ Исследуемая катушка само...
11669. Ландшафтно-екологічна навчальна практика 8.88 MB
  Шацький національний природний парк розташований біля с.Світязь Шацького району у Волинській області. Парк є місцем, де відпочиваючі проводять свій вільний час. Територія відмінно вписана в навколишній пейзаж із однойменним озером на його території.