Исследование рабочей зоны робота типа «Версатран» с 4-степенями подвижности

Исследование рабочей зоны робота типа " Версатран" с 4-степенями подвижности

Для воспроизведения двигательных функций человека в процессе трудовой деятельности созданы манипуляторы — многозвенные механизмы с управляемыми приводами на каждом звене. Манипуляторы разделяются на биотехнические и автоматические. Биотехнические манипуляторы управляются оператором дистанционного или непосредственно в результате перемещения рабочего органа манипулятора.

В автоматических манипуляторах рабочие функции выполняются без участия человека.

Промышленный робот — это автоматический манипулятор промышленного применения, имеющий систему программного управления, обеспечивающую быструю переналадку для выполнения задач, различающихся последовательностью и характером манипуляционных действий.

В роботизированных технологических комплексах ПР выполняют функции восприятия внешней среды, принятия решений и выполнения манипуляционных действий.

Манипуляторы ПР характеризуются грузоподъемностью, объемом рабочей зоны, числом звеньев, погрешностью позиционирования, системой координат, конструктивной и компоновочной схемой, типом системы управления.

Первые промышленные роботы появились в США сравнительно недавно, в 1962 г. Это были роботы типов «Версатран», «Юнимейт», «Универсал», «Циклон», оснащенные устройствами ЧПУ позиционного типа. Первые ПР были манипуляционными и использовались для обслуживания прессов, штампов, нагревательных печей и другого технологического оборудования в цехах с вредными условиями труда. Наибольшее распространение получили манипуляционные роботы грузоподъемностью до 20 кг с цикловым двухпозиционным управлением.

Планирование обработки информации действий манипуляционного робота — один из важнейших путей, который повышает эффективность работы всей системы управления манипуляционного робота. Оно включает определение последовательности этапов с преобразованием модели внешней среды робота, обеспечение мультипроцессорного режима обработки данных, планирование последовательности опроса систем очувствления как перед началом выполнения роботом технологических операций, так и в ходе ее выполнения с указанием приоритета каждой из операций.

робот версатран серводвигатель кинематика

1. Кинематическое исследование робота

1.1 Определение численных значений параметров, S, a и кинематической пары и составление таблицы кинематических пар

В основу получения математической модели кинематики робота положим специальные системы координат и преобразования Денавита-Хартенберга.

Введем необходимые обозначения кинематических звеньев и пар робота (рис. 1) в соответствии с правилами, предложенными Денавитом и Хартенбергом. Неподвижному звену присвоим нулевой номер, первому подвижному звену, соединенному со стойкой, номер 1 и далее по порядку до пятого оконечного подвижного звена, на котором закреплен схват.

Рис. 1. Кинематическая схема робота типа «Версатран»

Кинематические пары обозначим символом A_i, у которого нижний индекс i равен меньшему из номеров звеньев, образующих данную кинематическую пару. Таким образом, индекс i, связанный с кинематическими парами, будет принимать значения от 0 до 3.

Важным в методологии Денавита-Хартенберга является выбор расположения осей Z_i и X_i специальных систем координат и их начала O_i (i = 0,… 4). Ось Y_i назначается так, чтобы система координат была правой.

Оси Z_i (i=1,2,4) должны быть направлены по осям вращения кинематических пар (рис. 3).Ось Z₃ направлена по направляющей кинематической пары А₂. Начало координат O₀ инерциальной (базовой) системы координат расположим на оси Z₀ в основании манипулятора (рис. 1). Так как ось Z₁ пересекается с осью Z₀, а ось Z₁ — с осями Z_2,3,4, то начала координат O₀ и O₁, O₂, O₃, O₄ необходимо расположить в точках пересечения названных осей координат (рис. 1). Оси X₁ и X₂ X₃ X₄ направляются перпендикулярно плоскостям, образуемым соответственно осями Z₀, Z₁ и осями Z₂, Z₃, Z₄. Введенные системы координат позволяют определять положения четырех подвижных звеньев в неподвижной инерциальной системе координат O₀X₀Y₀Z₀.

Систему координат O₄X₄Y₄Z₄, связанную с четвертым подвижным звеном и определяющую положение схвата в инерциальной системе координат, следует расположить на этом звене особым образом. Начало координат O₅ поместим в центр (в характерную точку) схвата (рис. 1), ось X₄ направим перпендикулярно оси Z₃, так чтобы она лежала в плоскости, образованной осью Z₃ и характерной точкой схвата. Ось Z₄ расположим параллельно оси Z₃ и сонаправлено с ней.

В основу методики Денавита-Хартенберга положено определение положения i-й системы координат в (i-1) — й (i=1,…, 4) с использованием четырех параметров, а именно, с помощью:

1) угла ц_i поворота (i-1) — ой системы координат вокруг оси Z_i до совпадения направлений осей X_i-1 и X_i;

2) перемещения на величину S_i (i-1) — ой системы координат по оси Z_i до совпадения осей X_i-1 и X_i;

3) перемещения на величину a_i (i-1) — ой системы координат по оси X_i до совпадения начал координат (i-1) — ой и i-ой системы координат;

4) угла б_i поворота (i-1) — ой системы координат вокруг оси X_i до совпадения направлений осей Z_i и Z_i-1.

Значения этих постоянных параметров зависят, во-первых, от конкретной конструкции робота, а во-вторых, от принятого расположения систем координат.

Для описания кинематики робота целесообразно использовать специальную таблицу кинематических пар, в которой для конкретного робота проставляются определенные значения параметров И_i, S_i, a_i, б_i, а переменные параметры, являющиеся обобщенными координатами, отражаются буквой q_i.

Табл. 1. Таблица кинематических пар

1.2 Составление математической модели робота

После того как в лабораторно-практической работе № 1 определены параметры _i, S_i, а_i, _i и заполнена табл. 3, следует записать матрицы перехода для каждой кинематической пары в виде [3]

Подставляя действительные значения параметров _i, S_i, а_i и _i, а также значения обобщенных координат, соответствующие начальному положению манипулятора, и заменяя в зависимости от типа кинематической пары символы _i или S_i на обозначение обобщенной координаты q_i (символы С и S здесь означают тригонометрические функции cosinus и sinus).

Под математической моделью кинематики робота будем понимать перечень матричных формул, позволяющих определять координаты центров всех кинематических пар, начиная с 1-й, в инерциальной системе координат, которые в свою очередь дают возможность строить кинематическую схему робота при текущих значениях обобщенных координат.

Так как начала координат кинематических звеньев совпадают с центрами соответствующих им кинематических пар и с характерной точкой схвата, то положение центра i-й кинематической пары и ориентацию i-го звена в инерциальной системе координат будут определять наддиагональные элементы матрицы 4×4.

Для упрощения расчетов будем использовать математическую систему MathCAD.

Подставляя действительные значения параметров _i, S_i, а_i и _i, а также значения обобщенных координат в матрице перехода для каждого звена получаем:

Для определения положения любого промежуточногого звена робота относительно стойки надо перемножить соответствующее число первых слева матриц перехода.

Перемножая необходимое число матриц перехода для кинематических пар и, выделяя в конечной матрице наддиагональные элементы, записываем в табл. 2 координаты центров всех кинематических пар робота в его начальном положении, а также углы, определяющие ориентацию звеньев (схвата) робота.

Табл. 2. Координаты и ориентация звеньев манипулятора в начальном положении

1.3 Построение диаграмм относительных перемещений, скоростей, ускорений, кинетической мощности, диаграмм максимальных коэффициентов скоростей и ускорений

Диаграммы относительных перемещений ж (k), скоростей д (k), ускорений о (k) и кинетической мощности d (k) следует построить для всех пяти степеней подвижности (здесь k — относительный коэффициент времени, относительное время).

Вначале строится, по приведенным в исходных данных аналитическим зависимостям, диаграмма ж (k). Для построения диаграмм д (k) и о (k) необходимо продифференцировать соответствующее число раз зависимость ж (k).

Выбираем закон движения для каждой степени подвижности манипулятора [2]: Закон движения — Степенной закон движения (4−5-6−7)

ж= 35k⁴ -84k⁵ +70k⁶ -20k⁷

Построение диаграмм по относительным координатам

1.4 Построение диаграмм обобщенных координат, скоростей и ускорений

Для построения диаграмм обобщенных координат q (t), скоростей, ускорений следует воспользоваться зависимостями [2]:

q_i(t)= ж_i (k) · q_{и, i;} i =1,2,3 = д_i(k) · q_{и, i}/ t_u; i=1,2,3

= о_i(k) · q_{и, i} /t²_и; i=1,2,3

q_{и, i}= q^к _i — q^н _i; i=1,2,3 t = k · t_и,

где q^н _i и q^к _i — соответственно начальное и конечное значения i-й обобщенной координаты.

Табл. 3

Построение диаграмм по обобщенным координатам.

Первая степень подвижности.

Вторая степень подвижности

Третья степень подвижности

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

В робототехнике, есть две основные задачи кинематики: прямая и обратная.

Прямая задача — это вычисление положения (Xp, Yp, Zp) рабочего органа манипулятора по его кинематической схеме и значениях обобщенных координат (q₁, q₂… q_n), где n — число степеней свободы манипулятора, q — обобщенные координаты.

Обратная задача — это вычисление величин обобщенных координат (q₁, q₂… q_n) по заданному положению (Xp, Yp, Zp) рабочего органа при известной схеме кинематики робота.

Таким образом, решение прямой задачи говорит о том, где будет находиться рабочий орган робота, при заданных углах его суставов, а обратная задача — как нужно «вывернуться» роботу, чтобы его рабочий орган оказался в заданном положении.

Прямую и обратную задачи кинематики робота будем решать геометрически, для этого изобразим кинематическую схему робота, обобщенные координаты его звеньев q_n, их длины l_n и привяжем к манипулятору систему координат X, Y, Z, обозначив координаты рабочего органа Xp, Yp, Zp.

1.6 Построение траектории движения схвата

2. Динамическое исследование робота

Манипулятор представляет собой механизм с несколькими степенями свободы с голономными связями, потому воспользуемся уравнениями Лагранжа второго рода для составления уравнений движения.

Уравнения Лагранжа второго рода применительно к исследуемой манипуляционной системе примут вид [9]

(1)

Кинетическая энергия системы при неподвижном основании определится по формуле[9]:

T= T₁+T₂+ T₃₊ T₄ (2)

где T₁, T₂, T_3, T₄ — кинетические энергии звеньев 1, 2, 3, 4 соответственно, совершающих движение.

Составим расчетную схему для построения динамической модели, с изображенными силами действия приводов, силами трения и обобщенными координатами.

Введем следующие массы конструктивных элементов:

Так как звено 1 совершает вращательное движение по оси Z, то получаем:

(3)

Звено 2 совершает поступательное движение в плоскости ZX, то получаем

(4)

Звено 3 совершает пространственное поступательное движение по осям X, Y, Z, то получаем:

(5)

И звено 4 совершает вращательное движение по оси X, то получаем

(6)

Подставляя результаты (3), (4), (5), (6) в (2), получаем

T=0.5 (J₁+J₂+J₃+J₄) q₁'²+0,5 (J₂+J₃+J₄) q₂'²+0.5 (m₃+m₄) q₃'²+0.5J₄q₄'² (7)

Поочередно сообщая системе возможные приращения дq₁, дq₂, дq₃, дq₄ соответствующие обобщенным координатам q₁, q₂, q₃, q₄ определим по формуле (8) соответствующие обобщенные силы

[2] (8)

; (9)

;

Q2=

= (10)

;

Q3= (11)

;

Q4=

(12)

Где М₁, М₂, М₄-момент силы привода, действующий на звенья 1,2,4; М_Т1, М_Т3, М_Т4 момент сил трения, действующего на звенья 1,2,4. F₃ — сила привода, действующего на звено 3; F_Т3 — сила трения при движении по осям звена 3; G₂, G₃, G₄, G_гр — силы тяжести, действующие соответственно на звено 2, 3, 4 и груз.

Определим частные производные от кинетической энергии по обобщенным координатам и обобщенным скоростям:

(13)

(14)

=(m₃+m₄ (15)

= (16)

=0 (17)

Подставляя полученные значения (9), (10), (11), (12), (13), (14), (15), (16) в уравнения Лагранжа (1), получим

= М₁-М_T1

=

(m₃+m₄=

=

Если в задаче требуется найти движение системы, то интегрируют уравнения Лагранжа и определяют по начальным условиям произвольные постоянные интегрирования.

Если в задаче требуется определить неизвестные реакции, то после нахождения из уравнений Лагранжа следует применить принцип освобождаемости к соответствующим телам системы и воспользоваться основным уравнением динамики, либо принципом Даламбера, либо общим уравнением динамики.

3. Построение рабочей зоны мехатронного устройства

3.1 Рабочая зона мехатронного устройства

Рабочее пространство промышленного робота — пространство, в котором может находиться мехатронное устройство.

Рабочая зона мехатронного устройства — пространство, в котором может находиться рабочий орган (например, рука) при функционировании мехатронного устройства.

Рабочая зона ограничивается сложной поверхностью огибающая все возможные положения. Рабочая зона оценивается объёмом формы, которые определяют функциональные возможности манипулятора. Знание границ рабочей зоны необходимо для сравнительной оценки двигательных возможностей различных конечностей манипулятора.

Для выявления рабочей зоны необходимо:

1. Структурная компоновка схемы, то есть число, взаимно расположенных степеней подвижности.

2. Ограничение на перемещение по степеням подвижности.

3. Геометрические размеры звеньев кинематической цепи манипулятора.

3.2 Последовательность построения рабочей зоны исследуемого мехатронного устройства

Для построения рабочей зоны придадим перемещения по обобщенным координатам q₁, q₂, q₃ от крайних минимальных до крайних максимальных значений.

Если обобщенным координатам q₁ и q₂ придать фиксированные границы и минимальное значение (q₁=0°, q₂=1098 мм) а обобщенную координату q₃ изменять в пределах от минимального до максимального значений (от 18 мм до 780 мм), то мы получим границу A’B'.

Если обобщенным координатам q₁ и q₂ придать фиксированные границы и q₁ придать максимальное (240°), а q₂ минимальное значения (1098 мм), а обобщенную координату q₃ изменять в пределах от максимального до минимального значений (от 18 мм до 780 мм), то мы получим границу AB.

Если обобщенным координатам q₂ и q₃ придать фиксированные границы и q₂ минимальное значение (1098 мм), а q₃ максимальное значение (780 мм) и обобщенную координату q₁ изменять в пределах от минимального до максимального значений (от 0° до 270°), то мы получим границу BB'.

Если обобщенным координатам q₂ и q₃ придать фиксированные границы и q₂ минимальное значение (1098 мм), а q₃ минимальное значение (18 мм) и обобщенную координату q₁ изменять в пределах от минимального до максимального значений (от 0° до 240°), то мы получим границу AA'.

Если обобщенным координатам q₁ и q₃ придать фиксированные границы и максимальные значения (q₁=240°, q₃=780 мм), а обобщенную координату q₂ изменять в пределах от минимального до максимального значений (от 1098 мм до 1860 мм), то мы получим границу BD.

Если обобщенным координатам q₁ и q₃ придать фиксированные границы и q₁ максимальное значение (240°) q₃ минимальное значение (18 мм), а обобщенную координату q₂ изменять в пределах от минимального до максимального значений (от 1098 мм до 1860 мм), то мы получим границу АС.

Если обобщенным координатам q₁ и q₃ придать фиксированные границы и минимальные значения (q₁=0°, q₃=18 мм), а обобщенную координату q₂ изменять в пределах от минимального до максимального значений (от 1098 мм до 1860 мм), то мы получим границу А’С.

Если обобщенным координатам q₁ и q₃ придать фиксированные границы и q₁ минимальное значение (0°), q₃ максимальное значение (780 мм), а обобщенную координату q₂ изменять в пределах от минимального до максимального значений, то мы получим границу B’D.

4. Разработка структурной схемы микропроцессорной системы управления

4.1 Состав структурной схемы микропроцессорной системы управления

Структурная схема системы управления роботом включает:

— Персональный компьютер системы управления верхнего уровня;

— Технологическое оборудование.

4.2 Описания робота, как объекта управления

Основные характеристики:

— масса, кг: 590;

— число степеней подвижности: 4;

— габаритные размеры 1800×690×1860

— скорости линейных перемещений звеньев системы, м/с: 0,6;

— скорости угловых перемещений звеньев системы, ?/с: 35;

— время разгона / торможения линейного перемещения, с: 0,3;

— время разгона / торможения углового перемещения, с: 0,3;

— полная масса 1 звена m₁, кг: 340;

— полная масса 2 звена m₂, кг: 140;

— полная масса 3 звена m₃, кг: 80;

— полная масса 4 звена m₄, кг: 60;

— грузоподъемность m_г, кг: 50;

— напряжение питания трехфазное, В: ~380;

— рабочий диапазон температур,°С: 0−60;

— система управления: на базе рабочей станции;

— тип системы управления: контурная;

· Обобщённые координаты:

§ q1 — изменение положения первого звена, которое совершает вращательное движение вокруг оси Z (0°…135°),

§ q2 — изменение положения второго звена, которое совершает поступательное движение в цилиндрической системе координат (+1098 мм…+1860 мм),

§ q3 — изменение положения третьего звена, которое совершает поступательное движение (+50 мм…+780 мм),

§ q4- изменение положения четвертого звена, которое совершает вращательное движение вокруг совей оси (-120°…120°).

ФЭП: Encoder300 предназначен для контроля за перемещением, путем преобразования информации, поступающей от фотоэлектрических преобразователей серводвигателей, в цифровой код ЭВМ;

Конечные выключатели (SQ1 ц₁+, SQ2 ц₁-, SQ3 ц₂+, SQ4 ц₂-, SQ5 S+,

SQ6 S-, SQ7 ц₃+, SQ8 ц₃-): отвечают за предельные значения положения каждого звена манипулятора;

Датчики начала отсчета (SQ9 ц₁0, SQ10 ц₂0, SQ11 S0, SQ12 ц₃0):данные датчики определяют положение манипулятора в начальной системе отсчета;

Датчики рабочей зоны (SQ13 ц₁р₁, SQ14 ц₁р₂, SQ15 ц₂р₁, SQ16 ц₂р₂,

SQ17 Sр₁, SQ18 Sр₂, SQ19 ц₃р₁, SQ20 ц₃р₂): отвечают за значения каждого звена манипулятора;

Датчики схвата (SQ21, SQ22): определяют состояние схвата (зажим / разжим);

Датчик наличия детали в схвате SQ23;

Датчик давления в пневмосети SP1.

4.3 Назначение элементов системы управления

Используем промышленный компьютер «Корвет» фирмы TC-CKH с процессорной платой PCA-6184E2, предназначенную для управления производственными и технологическими процессами в масштабах производственного участка, цеха или завода, способную круглосуточно работать в условиях запыленности, больших перепадов температуры и влажности, вибрации.

Основные характеристики рабочей станции:

— Процессор: Intel Pentium 4 2.8GHz;

— Слоты расширения: 10xPCI, 2xISA;

— COM порты: 2xRS232;

— Чипсет: Intel 845E 400 MHz FSB;

— Оперативная память: 4 Gb SDRAM;

— Жесткий диск: ATA 80Gb;

— Видео: Ati Rage 128, AGP, 8 Mb SGRAM;

— LAN: 10/100 Base-T Ethernet;

— FDD, CD

— USB: 2xUSB 1.0

— уровень влажности — 5 ~ 85% RH @ 40° C,

— рабочая температура — 0 ~ 50° C,

— температура хранения -20 ~ 60° C.

4.4 Выбор периферийного оборудования

Выбор сервоприводов На основе проектировочного расчета мощностей приводов были выбраны серводвигатели серии HF-Sp фирмы Mitsubishi Electric:

· 7000 Вт, HF-SP702B

· 5000 Вт, HF-SP502B

Для данных серводвигателей были подобраны сервоусилители серии MR-J3−700A и MR-J3−500A,

MR-J3-A — это универсальный сервоусилитель с аналоговыми входами, импульсным интерфейсом по умолчанию; предназначен для традиционных систем регулирования скорости, положения и вращающего момента. Диапазон мощностей составляет от 100 Вт (MR-J3−10A) до 7 кВт (MR-J3−700A).

Выбор модулей Подключаемые модули выбираем с интерфейсом PCI и ISA, так как рабочая станция имеет шину PCI и ISA.

Encoder-300

ISA модуль трехкоординатного квадратурного шифратора используется для подключения Encoder300.

Encoder300 предназначен для контроля за перемещением, путем преобразования информации, поступающей от фотоэлектрических преобразователей серводвигателей, в цифровой код ЭВМ.

Таким данный модуль замыкает обратные связи по положению следящей системы приводов.

Серводвигатели имеют встроенный энкодер с разрешением 2048 имп/об и отдельно выведенными выходными сигналами A, B, Z. Данные выводы подключаются к модулю, и при подаче питания происходит определения положения вала двигателя.

Конструкция

· Конструкция: Адаптер ISA

Интерфейс

· Интерфейс: ISA

Количество контролируемых осей

· Координатных осей: 3

Импульсные входы шифратора

· Импульсных входов на координату: 3

· Входные сигналы: Фаза А, Фаза В, Метка (Z)

· Тип входов: Дифференциальный, КМОП

· Разрядность счетчика: 16 бит

· Максимальная входная частота: 1 МГц

· Режимы шифратора: Квадратурный, Больше / Меньше, Импульс / Направление

PCI-1710 фирмы Advantech

PCI модуль вывода управляющих сигналов Модуль вывода дискретных управляющих сигналов предназначен для формирования дискретных сигналов типа «вкл./выкл.» на исполнительные устройства или управляющих сигналов для приводов.

Манипулятор имеет пневмоцилиндр для зажимаразжима схвата, который имеет два канала дискретного управления, а так же в стойки силовой автоматики находится контактор, управляющий напряжением в сети, он имеет один канал дискетного управления.

Поэтому выбранный модуль вполне подходит для управления данными устройствами.

Конструкция

· Конструкция: Адаптер PCI

Интерфейс

· Интерфейс: PCI

Дискретные входы

· Кол-во каналов: 8

· Входные характеристики:

§ Низкий: 0.8 В макс.

§ Высокий: 2.0 В мин.

Дискретные выходы

· Кол-во каналов: 16

· Выходные характеристики:

§ Низкий: 0.8 В макс. @ 8.0 мА

§ Высокий: 2.0 В мин. @ -0.4 мА

PCI-720 фирмы Advantech

ISA модуль ввода дискретных сигналов Модуль вывода дискретных сигналов гальванически развязывает и согласует сигналы ЭВМ с сигналами, приходящими от различных датчиков технологического оборудования или приводов.

В нашей системе находится 19 датчиков, а также кнопка аварийного выключения.

Конструкция

· Конструкция: Адаптер ISA

Интерфейс

· Интерфейс: ISA

Дискретные входы

· Кол-во каналов: 32

· Гальваническая развязка: 2500 В

· Частота сигнала: до 10 кГц

· Работа по прерыванию

PCI-1721 фирмы Advantech

PCI модуль вывода аналоговых сигналов

Основные характеристики PCI-1721

· 4 канала, 12 разрядов

· Буфер FIFO на 1К отсчётов для каждого канала

· Диапазоны выходного сигнала PCI-1721: ±10, ±5, 0…10, 0…5 В

· Скорость выдачи данных PCI-1721: до 10 МГц

· 16 каналов цифрового ввода-вывода (TTL)

· Один 16-разрядный счётчик

· Автокалибровка PCI-1721

· Шина PCI-1721: PCI

PCI-1724 фирмы Advantech

PCI модуль вывода дискретных управляющих сигналов

Основные характеристики PCI-1724

· 32 канала, 14 разрядов

· Напряжение изоляции PCI-1724U: 1500 В

· Выходные сигналы PCI-1724U: ±10 В, 0…20 мА, 4…20 мА

· Время установления сигнала 60 мкс

· Режим синхронизации выходов PCI-1724U

· Функция сохранения значения выходного сигнала PCI-1724U при перезагрузке системы

PCI-1784 фирмы Advantech

PCI модуль измерительных преобразователей

Основные характеристики PCI-1784U

· 4 независимых канала для подключения энкодеров

· 32-разрядое разрешение для каждого канала

· Максимальная входная частота PCI-1784U: 2 МГц

· Цифровой фильтр 4-го порядка

· Режимы счета PCI-1784U: квадратурный, реверсивный, с заданием направления счета

· Напряжение изоляции PCI-1784U: 2500 В пост. тока

· 8-разрядный таймер

· 4 канала дискретного ввода и 4 канала дискретного вывода

· Шина PCI-1784U: Universal PCI

5. Расчет мощностей приводов

Приводы манипуляторов содержат силовые двигатели, передаточные механизмы к исполнительным звеньям, усилительно-преобразовательные устройства, воспринимающие сигналы системы управления и датчиков внешней и внутренней информации с целью формирования управляющих силовых воздействий, развивающих минимально необходимую мощность. Скорости перемещений конечного звена манипулятора при отработке отдельных степеней подвижности устанавливают в соответствии с требуемой производительностью.

В первом приближении пренебрежем силами трения и найдем из уравнений Лагранжа силы приводов F₁, F₂ и F₃ [9]:

F₁=(J₁+J₂+J₃+J₄)*q₁''

F₂=(J₂+J₃+J₄)*q₂''+ G₂+G₃+G₄+G_гр;

F₃=(m₃+m₄)*q₃'' +G₃+G₄+G_гр

F₄= J₄*q₄'+ G₄+G_гр

Максимальное ускорение будет происходить на участке: 0 — t_p,

где t_р — время разгона звена,

v_p — скорость линейных перемещений звеньев;

w_p — скорость угловых перемещений звеньев.

Соответственно прилагаемая сила привода будет максимальна, и мощность, расходуемая приводом тоже.

Рассчитаем ускорение, придаваемое звеньям 1 и 3 во время разгона [6]:

;

и ускорение, придаваемое звену 2 во время разгона [6]:

.

Приближенно рассчитаем мощность привода, пренебрегая типом привода, потерями мощностей в передачах и параметрами режима работы:

— для звена 2, 3, совершающего поступательное движение;

— для звена 1, и 4, совершающего вращательное движение [9],

где =1,2; =0,55.

Подставляя исходные данные в уравнение, получим:

P₁=(J₁+J₂+J₃+J₄) q₁''=() q₁''=6140.8 Вт

P₂=((J₂+J₃+J₄)*q₂''+G₂+G₃+G₄+G_гр)== 4195.7 Вт

P₃=((m₃+m₄+)=3994.22 Вт

P₄=(J₄*q₄'+G₄+G_гр)=(()*q₄)=3861.56 Вт Исполнительные двигатели, с одной стороны, определяют энергетические, свойства робота, а с другой — его динамические свойства. Дело в том, что никакие корректирующие устройства не смогут обеспечить требуемые вращающие моменты, скорости и ускорения нагрузки, если они не обеспечены энергетикой двигателя.

Для электрических следящих приводов в качестве исполнительных двигателей наиболее распространены двигатели постоянного тока с независимым возбуждением, управляемые от малогабаритных и малоинерционных тиристорных и транзисторных усилителей мощности.

Наиболее перспективны для роботов электродвигатели с печатным цилиндрическим и дисковым ротором и гладким ротором, которые имеют малый момент инерции и повышенную перегрузочную способность. Передача движения от двигателей к звеньям манипулятора обычно осуществляется с помощью различных редукторов.

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

Для выбранного двигателя из каталога нужно выписать следующие данные: номинальную угловую скорость вращения ротора; номинальный вращающий момент.

Для роботов с электрическими приводами используют, как правило, двигатели малой и средней мощности до нескольких киловатт. Для таких двигателей иногда пренебрегают электромагнитными процессами в цепи якоря по сравнению с электромеханическими процессами, связанными с разгоном вала двигателя.

Заключение

В выполненной выпускной квалификационной работе был исследован робот с четырьмя кинетическими парами с микропроцессорной системой централизованного контурного управления. Устройство предназначено для выполнения вспомогательных операций в машиностроении и обладает следующими показателями назначения:

— габаритные размеры, мм 1800×690×1860

— масса, кг 590 кг

— число степеней подвижности 4

— скорости линейных перемещений системы, м/с 0,6

— скорости угловых перемещений системы, ?/с 35

— время разгона / торможения линейного перемещения, м/с 0,3

— время разгона / торможения углового перемещения, рад/с 0,25

— напряжение питания трехфазное ~380 В

— рабочий диапазон температур 0−70° С

— система управления на базе промышленной станции

— тип системы управления: контурная

— тип концевых выключателей: контактные

— ЖКИ-монитор.

Библиографический список

1. Хомченко В. Г., Соломин В. Ю. Мехатронные и робототехнические системы. учеб. пособие — Омск: Изд-во ОмГТУ, 2008. — 160 с.

2. Хомченко В. Г., Соломин В. Ю. Исследование движений манипулятора промышленных роботов. метод. указания к практ. занятиям по дисциплине «Основы мехатроники» и УНИРС / ОмГТУ, 2007. - 18 с.

3. Хомченко В. Г., Соломин В. Ю. Автоматизированное решение прямой задачи кинематики манипуляторов роботов на ПЭВМ: метод. указания к лаб.-практ. работам по учеб. дисциплине «Мехатронные и робототехнические системы» для специальностей 220 301 и 220 401 / ОмГТУ, 2007. - 36 с.

4. Компанейц А. Н. Схемотехника систем управления. Методические указания для выполнения курсового проекта и СРС. - Омск: Изд-во ОмГТУ, 2007. — 52 с.

5. Компанейц А. Н. Микропроцессорные системы управления. Конспект лекций. — Омск: Изд-во ОмГТУ, 2007. — 88 с.

6. Компанейц А. Н. Схемотехника средств автоматизации. Конспект лекций. — Омск: Изд-во ОмГТУ, 2007. — 104 с.

7. Федотов А. В. Составление технического задания: Методические указания.-Омск: Изд-во ОмГТУ, 1999. — 24 с.

8. Козырев Ю. Г. Промышленные роботы: Справочник. — М.: Машиностроение, 1983.

9. Мальцев В. Г. Динамический анализ манипуляторов промышленных роботов. — ОмГТУ, 1998. — 20 с.

10. Тарг С. М. Краткий курс теоретической механики. — М.: Высшая школа, 1986.-416 с.