14624

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

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

Физика

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

Русский

2013-06-08

294 KB

33 чел.

Лабораторная работа №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

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


 

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

12705. Создание трёхмерных моделей и ассоциативных чертежей деталей, входящих в состав сборочной единицы 2.31 MB
  Методические рекомендации по выполнению конструкторской документации в системе КОМПАС 3D Лабораторная работа №1 Создание трёхмерных моделей и ассоциативных чертежей деталей входящих в состав сборочной единицы Содержание. Введение. 1. Задание
12706. Организация военно-патриотического воспитания подростков на примере деятельности клуба Мужество 270.5 KB
  Патриотическое воспитание учащихся в настоящее время приобретает архиважное значение. Воспитать патриотов сегодня – это значит обеспечить будущее завтра. В советский период на самых различных государственных уровнях патриотической работе с молодёжью уделяется очень большое значение.
12707. Simulink: Инструмент моделирования динамических систем 3.66 MB
  И.В.Черных. Simulink: Инструмент моделирования динамических систем. Содержание 1. Общие сведения 52. Запуск Simulink 53. Обозреватель разделов библиотеки Simulink 64. Создание модели 85. Окно модели 106. Основные приемы подготовки и редактирования модели 11 6.1. Добавление текстовых надпис...
12708. ЗАКОНЫ КИРХГОФА И ОСНОВНЫЕ СВОЙСТВА ЛИНЕЙНОЙ РЕЗИСТИВНОЙ ЦЕПИ 95 KB
  ЗАКОНЫ КИРХГОФА И ОСНОВНЫЕ СВОЙСТВА ЛИНЕЙНОЙ РЕЗИСТИВНОЙ ЦЕПИ Лабораторная работа 1 по дисциплине Электротехника Цель работы. Проверить справедливость законов Кирхгофа а также основных принципов свойств и теорем линейных цепей на примере р...
12709. Создание буклета «Планшет» 2.65 MB
  Упражнение 5. Создание буклета Планшет Рис.6.1.Готовый буклет Цель упражнения: освоить создание и редактирование текстовых объектов и эффект обтекания текстом. 1. Создаем новый документ с размерами рабочего листа...
12710. Конспект лекций к изучению курса Solid Work 593.01 KB
  Лекция №1 Тема: Основные понятия структура документа в программе SolidWorks.Цель:Ознакомиться с основными понятиями структурой документа общими сведениями о панелях инструментов. План лекции: Общие сведения о программе SolidWorks. Окна документов. Условные об...
12711. Создание простой модели в SolidWorks 2001 132 KB
  Практическая работа №2. Тема: Создание простой модели в SolidWorks 2001.Цель: Создание простой модели основания с применением инструментов эскиза прямоугольник окружность нанесением размеров добавлением бобышки выреза изменением элементов добавление скруглений измен...
12712. Создание модели детали типа Корпус в SolidWorks 2001 233.5 KB
  Практическая работа №3. Тема: Создание модели детали типа Корпус в SolidWorks 2001.Цель: Создание модели детали типа корпус с применением объектов эскиза: многоугольник окружность линия ось нанесением размеров добавлением бобышки выреза изменением элементов добавлен
12713. Создание модели детали типа Качалка в SolidWorks 2001 381 KB
  Практическая работа №4. Тема: Создание модели детали типа Качалка в SolidWorks 2001.Цель: Создание модели детали типа Качалка с применением различных инструментов эскиза знакомство с взаимосвязями эскиза и элементами. Необходимое оборудование и материалы: ПК перс