В. Г.

Хомченко

Робототехнические системы

Учебное пособие
_____________

Учебное пособие разработано в Омском государственном тех-

ническом университете

Омск, 2016
 УДК 621.865.8(075)
ББК 32.816.1я73
Х76
Рецензенты:
Брейдо И.В., д.т.н., профессор, заведующий кафедрой «Автоматизация
производственных процессов» Карагандинского государственного техниче-
ского университета, Казахстан
Воронов Е. А., д.т.н., профессор, профессор кафедры «Основы теории
механики и автоматического управления» Омского государственного техни-
ческого университета, Россия

В. Г. Хомченко
Робототехнические системы:
Учебное пособие
Омск 2016 г. – 195 стр.
Учебное пособие предназначено для изучения методов проектирования
роботов и робототехнических систем. Учебное пособие будет полезно при
исследованиях в области кинематики и динамики манипуляторов роботов, а
также в области разработки и анализа робототехнических систем. Большое
внимание в учебном пособии уделено решению прямой и обратной задач ки-
нематики манипуляторов роботов с последовательной кинематикой и реше-
нию обратной задачи кинематики манипуляторов с параллельной кинемати-
кой типа платформы Гауфа-Стюарта. В качестве математического аппарата
при решении названных задач используется, в основном, матричное исчисле-
ние. В учебном пособии рассмотрены вопросы моделирования взаимодей-
ствия роботов и технологического оборудования в составе робототехниче-
ских систем с использованием сетей Петри.

© Хомченко В. Г., 2016

2
 Аннотация
В настоящем учебном пособии основное внимание уделяется аспектам
изучения и исследования кинематических и динамических свойств манипу-
ляторов промышленных роботов, необходимых для выработки управляющих
силовых воздействий на звенья манипулятора робота, а также вопросам син-
теза оптимальных по тем или иным критериям траекторий движения схвата
манипулятора робота в составе робототехнических комплексов, конструиро-
ванию захватных устройств, изучению и моделированию робототехнических
систем.
Проведение практических и лабораторных работ реализуется с исполь-
зованием методических материалов и программного обеспечения, разрабо-
танных в ОмГТУ на основе программного пакета MathCAD и некоторых дру-
гих.
Полученные знания будут достаточны: для разработки структурных и
кинематических схем манипуляторов роботов, оптимальных по принятым
критериям; для решения прямых и обратных задач кинематики и динамики
роботов с использованием матричного исчисления; для решения траекторных
задач в соответствии с выполняемыми роботом производственными функци-
ями; для моделирования роботов и робототехнических комплексов в терми-
нах сетей Петри.
Предназначено для студентов, обучающихся по направлениям «Автома-
тизация технологических процессов и производств», «Управление в техниче-
ских системах» и «Мехатроника и робототехника».

3
 Оглавление

Раздел 1. Основные понятия и классификация роботов и манипуляционных

систем ....................................................................................................................... 8
Лекция 1. Введение. Области применения, классификация и технические
характеристики роботов ..................................................................................... 8
Введение ........................................................................................................... 8
1.1. Области применения роботов ............................................................... 10
1.2. Классификация промышленных роботов ............................................ 11
1.3. Технические характеристики промышленных роботов ..................... 13
Вопросы к лекции 1 ...................................................................................... 14
Лекция 2. Структурная и кинематическая классификация
манипуляционных устройств робототехнических систем ............................ 14
2.1. Основные понятия структуры и кинематики манипуляторов ........... 14
2.2. Понятие о структуре манипуляционных систем ................................ 16
2.3. Классификация кинематических пар манипуляционных
механизмов..................................................................................................... 17
2.4. Классификация переносных степеней подвижности манипулятора с
последовательной кинематикой .................................................................. 20
2.5. Классификация переносных степеней подвижности по системам
координат ....................................................................................................... 25
2.6. Классификация ориентирующих степеней подвижности.................. 26
Вопросы к лекции 2 ...................................................................................... 28
Раздел 2. Основы кинематики и динамики манипуляционных систем роботов
с последовательной кинематикой ........................................................................ 29
Лекция 3. Преобразования координат в манипуляционных системах ........ 29
3.1. Описание положения схвата в абсолютной системе координат.
Понятие о прямой и обратной задачах кинематики манипуляторов
роботов ........................................................................................................... 29
3.2. Однородные координаты в кинематике манипуляторов роботов.
Матрицы перехода 4×4 кинематических пар 5-го класса ......................... 31
Вопросы к лекции 3 ...................................................................................... 36
Лекция 4. Определение взаимного положения последовательно
соединенных звеньев манипуляционных систем........................................... 37
4.1. Специальные системы координат Денавита-Хартенберга ................ 37
4.2. Преобразования Денавита-Хартенберга .............................................. 43
4.3. Определение ориентации звеньев манипулятора с использованием
углов Эйлера .................................................................................................. 46
Вопросы к лекции 4 ...................................................................................... 49
4
Лекция 5. Прямая задача кинематики манипуляционных систем с
последовательной кинематикой ...................................................................... 50
5.1. Обобщенные координаты манипуляционных систем. Таблица
кинематических пар манипулятора ............................................................. 50
5.2. Расчет положения схвата в пространстве абсолютных координат ... 54
5.3. Определение взаиморасположений промежуточных звеньев
манипулятора ................................................................................................. 57
Вопросы к лекции 5 ...................................................................................... 58
Лекция 6. Решение прямой задачи кинематики при позиционном
управлении ......................................................................................................... 58
6.1. Синтез законов движения по обобщенным координатам
манипулятора (первая подзадача) ............................................................... 60
6.1.1. Синтез прямоугольного закона движения из физических
предпосылок .................................................................................................. 61
6.1.2. Синтез прямоугольного закона как сплайн-функции ..................... 63
6.1.3. Синтез синусоидального безударного закона движения ................ 65
6.1.4. Синтез безударного закона на основе сплайн-функций ................. 66
6.2. Расчет закона движения схвата в абсолютной системе координат
(вторая подзадача) ......................................................................................... 68
Вопросы к лекции 6 ...................................................................................... 69
Лекция 7. Определение абсолютных скоростей точек звеньев
манипулятора ..................................................................................................... 69
Вопросы к лекции 7 ...................................................................................... 73
Лекция 8. Обратная задача кинематики манипуляционных систем с
последовательной кинематикой при контурном управлении ...................... 74
8.1. Постановка обратной задачи кинематики манипуляционных
систем… ......................................................................................................... 74
8.2. Решение обратной задачи прямыми геометрическими методами .... 77
8.3. Решение обратной задачи кинематики манипуляторов на основе
нелинейного математического программирования ................................... 80
8.4. Решение обратной задачи кинематики манипуляционных систем при
управлении по скорости ............................................................................... 88
8.5. Метод обратных преобразований в решении обратной задачи
манипуляторов ............................................................................................... 95
Вопросы к лекции 8 ...................................................................................... 97
Лекция 9. Исследование динамики манипуляционных систем с
последовательной кинематикой на основе уравнений Лагранжа 2-го
рода…. ............................................................................................................... .99

5
 9.1. Постановка задачи динамического синтеза и анализа
манипуляционных систем ............................................................................ 99
9.2. Решение примера динамического синтеза и анализа
манипулятора….. ......................................................................................... 101
Вопросы к лекции 9 .................................................................................... 105
Лекция 10. Кинематика манипуляционных механизмов с параллельной
структурой. Решение обратной задачи ......................................................... 106
Вопросы к лекции 10 .................................................................................. 113
Раздел 3. Робототехнические комплексы ......................................................... 114
Лекция 11. Назначение, состав и классификация робототехнических
комплексов ....................................................................................................... 114
11.1. Назначение робототехнических комплексов .................................. 114
11.2. Состав и классификация робототехнических комплексов ............ 119
Вопросы к лекции 11 .................................................................................. 126
Лекция 12. Компоновка РТК и возможные траектории схвата
манипулятора ................................................................................................... 126
12.1. Компоновочные схемы РТК .............................................................. 126
12.2. Анализ местных (частных) траекторий схвата манипуляторов .... 130
Вопросы к лекции 12 .................................................................................. 135
Лекция 13. Использование нескольких роботов в одном РТК.
Межстаночные траектории схватов .............................................................. 135
13.1. Особенности использования нескольких роботов в одном РТК ... 135
13.2. Межстанционные траектории как функции числа схватов и
организации производственной сцены ..................................................... 138
Вопросы к лекции 13 .................................................................................. 143
Лекция 14. Общие требования к РТК и его компонентам .......................... 143
14.1. Применение робототизированных технологических комплексов в
механообрабатывающем производстве .................................................... 143
14.2. Требования к технологическим процессам, реализуемым в
РТК…….................................................................................................. …..145
14.3. Требования к деталям, обрабатываемым в РТК ............................. 146
14.4. Требования к технологическому оборудованию, используемому в
РТК ................................................................................................................ 149
14.5. Требования к промышленным роботам, включаемым в состав
РТК…............................................................................................................ 149
14.6. Требования к вспомогательному и транспортно-накопительному
оборудованию, включаемому в РТК ......................................................... 155
14.7. Требования к РТК в целом ................................................................ 158
14.8. Обшие характеристики и особенности РТК механообработки ..... 159
6
 Вопросы к лекции 14 .................................................................................. 160
Лекция 15. Планирование траекторий схвата манипулятора робота в
составе РТК на основе сплайн-функций ....................................................... 161
15.1. Общие требования к траекториям движения схвата манипуляторов
в составе РТК ............................................................................................... 161
15.2. Представление траектории движения схвата одним полиномом
(первый подход) .......................................................................................... 164
15.3. Представление траектории движения схвата сплайн-функциями
(второй подход) ........................................................................................... 167
15.4. Общие случаи планирования траекторий сплайн-функциями в
пространстве обобщенных координат ...................................................... 172
Вопросы к лекции 15 .................................................................................. 177
Лекция 16. Моделирование робототехнических систем в терминах сетей
Петри ................................................................................................................ 178
16.1. Основные понятия и терминология сетей Петри ........................... 178
16.2. Имитационные модели робототехнических систем на основе сетей
Петри ............................................................................................................ 185
16.2.1. Моделирование однопозиционного РТК сетями Петри ............. 185
16.2.2. Моделирование многопозиционного РТК в терминах сетей
Петри. ........................................................................................................... 189
Вопросы к лекции 16 .................................................................................. 194
Использованная литература ………………….………………………………194

7
 Раздел 1. Основные понятия и классификация роботов и
манипуляционных систем

Лекция 1. Введение. Области применения, классификация и

технические характеристики роботов

Введение
Роботы и создаваемые на их основе робототехнические системы явля-
ются достаточно сложными устройствами. Включаемые в робототехнические
системы роботы и обслуживаемое ими оборудование имеют разнообразные
связи между собой: информационные, кинематические, программные и мно-
гие другие.
Интенсивное развитие промышленной робототехники началось с сере-
дины прошлого века, когда первые из них начали применять для высвобож-
дения человека от монотонных, однообразных операций на конвейерах по
выпуску автомобилей.
В настоящее время роботы, в том числе и промышленные, применяются
в весьма широких областях человеческой деятельности: от выполнения про-
стейших операций по сборке изделий до изготовления высокоточных дета-
лей; от обслуживания оборудования в производственных помещениях до ра-
боты в экстремальных условиях, где нежелательно или недопустимо присут-
ствие человека.
В роботе для выполнения двига-
тельных функций используется мани-
пулятор, представляющий собой ряд
кинематических звеньев, соединенных
между собой кинематическими парами
(рис. 1.1).

Рисунок 1.1 – Манипулятор робота

8
 Одно из звеньев манипулятора является стойкой и оно неподвижно, а
другие могут совершать управляемые движения благодаря воздействию со
стороны приводов.
В манипуляторах роботов используются одноподвижные вращательные
или поступательные кинематические пары пятого класса.
Распространенность в манипуляторах роботов одноподвижных кинема-
тических пар пятого класса объясняется тем, что такие пары обеспечивают
движение образующих их кинематических звеньев относительно друг друга
по одной координате, а, следовательно, для перемещения одного звена по от-
ношению к другому требуется один привод.
Силовое воздействие приводов на звенья манипулятора осуществляется
в соответствии с управляющими сигналами, поступающими от системы
управления робота, которые в свою очередь формируются по требуемым (за-
данным) законам движения схвата, а также с учетом состояния робота и
окружающей технологической среды. Таким образом, под воздействием при-
водов робота звенья манипулятора и его схват будут совершать вполне опре-
деленные перемещения в пространстве.
Для роботов наиболее характерны два типа заданий на перемещение
схвата:
1. Перемещение от одной точки к другой за заданный период времени –
позиционное управление. В этом случае задаются координаты начальной,
промежуточных и конечной точек (рис. 1.2). Траектория движения схвата и
скорость его движения между точка-
ми не регламентируется. Понятно,
что число таких точек может быть
неограниченно большим. Суще-
ственным моментом является то, что
в каждой точке схват должен сделать
остановку. Значит, каждую пару
Рисунок 1.2 – Позиционное управление
9
соседних точек при исследовании движений робота можно условно рассмат-
ривать как начальную и конечную. Частным случаем позиционного управле-
ния является цикловое управление, когда схват должен совершать движение
между двумя точками. Примером позиционного и циклового управления мо-
жет быть движение от места хранения заготовки к приспособлению станка и
обратно.
2. Перемещение схвата по заданной траектории и заданному во времени
закону движения по этой траектории – контурное управление. В этом случае
задается закон движения схвата во времени, то есть задается закон движения
схвата по координатам x, y, z в виде: x = x(t); y = y(t); z = z(t), а также ориен-
тация схвата при движении по траектории в функции времени. Ориентация
схвата в пространстве может задаваться либо с использованием углов Эйле-
ра:  = (t),  = (t),  = (t), или с помощью направляющих косинусов (с
помощью углов между осями координат инерциальной системы координат и
осями координат схвата) x0^zn = f1(t), y0^zn = f2(t), x0^yn = f3(t).

1.1. Области применения роботов

Робот представляет собой техническое устройство, создаваемое на осно-

ве мехатронного подхода, состоящее из манипулятора и системы управления
и предназначенное для перемещения предметов труда в пространстве или
выполнения определенных технологических функций.
В качестве предметов труда, перемещаемых роботом, могут выступать:
 в машиностроении: заготовки, детали, инструмент, емкости с рас-
плавленным металлом и т. п.;
 в атомной промышленности: стержни радиоактивного материала,
крышки люков, приборы контроля и т. п.;
 в исследовательских (информационных) роботах: теле- и видеокаме-
ры, буровые инструменты, космические модули и т. п.;
10
  в роботах для экстремальных условий: специальные устройства по
обработке местности, навесные орудия для обработки земли, поверхности
зданий и т. д.
При использовании робота в качестве технологического оборудования
он может выполнять сборочные операции, операции по окраске и сварке из-
делий, раскрою материала и многие другие.

1.2. Классификация промышленных роботов

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

делят на три группы:
1. Человекоподобные (бытовые);
2. Информационные (исследовательские), предназначенные для сбо-
ра информации в средах опасных или не доступных для человека;
3. Промышленные, предназначенные для автоматизации технологи-
ческих процессов в различных отраслях производства.
В дальнейшем в курсе лекций основное внимание будет уделено про-
мышленным роботам и робототехническим системам.
Промышленные роботы (ПР) имеют большое число классификационных
признаков. Классификация по основным из них представлена на рисунке 1.3.

11
Рисунок 1.3 – Признаки и классификация промышленных роботов

12
 1.3. Технические характеристики промышленных роботов

К основным техническим характеристикам промышленных роботов от-

носятся показатели, приведенные на рисунке 1.4.

Рисунок 1.4 – Технические характеристики промышленных роботов

13
 Вопросы к лекции 1:
1. Назовите области применения роботов.
2. Назовите основные классификационные признаки промышленных ро-
ботов.
3. Проведите классификацию промышленных роботов по основным
классификационным признакам.
4. Каковы технические характеристики промышленных роботов?
5. Какое управление ПР называется позиционным?
6. Какое управление ПР называется цикловым?
7. Какое управление ПР называется контурным?

Лекция 2. Структурная и кинематическая классификация

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

2.1. Основные понятия структуры и кинематики манипуляторов

Манипулятор – это кинематическая цепь, образованная последователь-

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

14
 Кинематическое звено – совокупность жестко соединенных друг с дру-
гом тел, входящих в состав механизма, в данном случае в состав манипуля-
тора.
Кинематическая пара – подвижное соединение двух кинематических
звеньев, допускающее их вполне определенное движение относительно друг
друга.
Входное (входные) кинематическое (ие) звено (звенья) – это звено (зве-
нья), получающее(ие) независимое, заданное движение.
Кинематическая цепь – это совокупность кинематических звеньев, по-
движно соединенных друг с другом с помощью кинематических пар.
Если в кинематической цепи есть кинематические звенья, входящие в
одну кинематическую пару, то такая цепь называется разомкнутой (рис. 2.1),
а если же каждое звено входит как минимум в две кинематических пары, то
это замкнутая кинематическая цепь (рис.2.2).
Манипулятор может быть образован как на основе разомкнутой кинема-
тической цепи (рис. 2.1) с последовательным соединением звеньев (антропо-
морфные человекоподобные роботы) и на основе замкнутой кинематической
цепи с последовательно-параллельным или параллельным соединением (рис.
2.2) звеньев (роботы с параллельной кинематикой, в частности, гексаподы на
основе платформы Стюарта).

Рисунок 2.1 – Манипулятор на Рисунок 2.2 – Манипулятор с парал-

основе разомкнутой цепи лельной кинематикой
15
 2.2. Понятие о структуре манипуляционных систем

Итак, манипулятор – это механизм, представляющий собой разомкну-

тую или замкнутую кинематическую цепь, предназначенную для получения
требуемого движения схвата в пространстве.
Важной характеристикой манипулятора является число степеней его по-
движности – число степеней свободы.
Для произвольной пространственной кинематической цепи в общем
случае следует использовать формулу Сомова–Малышева:
i 5
W  6n  5p 5  4p 4  3p 3  2p 2  p1  6n   ip i ,
i 1

где pi – число кинематических пар i-го класса; n – число подвижных зве-

ньев.
Для манипуляторов с кинематическими парами 5- го класса
W  6n  5p5 .
Так как в манипуляторе с последовательной кинематикой каждому по-
движному звену соответствует одна кинематическая пара пятого класса, то
n = p5.
Следовательно,
W = 6n – 5n = n или W = p5,
то есть число степеней подвижности в таких манипуляторах равно чис-
лу подвижных звеньев и числу кинематических пар.
Использование в манипуляторах в основном одноподвижных враща-
тельных или поступательных пар 5-го класса связано с тем, что для опреде-
ленности движения одного звена относительно другого в случае, если они
подвижно соединены парой 5-го класса требуется задание одного перемеще-
ния (рис.2.3), что легко реализуется современными двигателями, которые
приводят в движение либо вал (электродвигатели), либо шток (пневмо- и
гидродвигатели).
16
 Рисунок 2.3 – Схема расположения приводов на звеньях манипулятора

2.3. Классификация кинематических пар манипуляционных

механизмов

Дадим характеристику кинематическим парам. Именно от характера ки-

нематических пар и от их взаимного расположения в манипуляторе во мно-
гом зависят законы преобразования движения.
Кинематические пары, как отмечалось, допускают вполне определенные
движения образующих их звеньев относительно друг друга. Эта определен-
ность достигается теми ограничениями, которые создают пары геометрией
своих элементов.
Пары классифицируют по классам, номер которого равен числу ограни-
чений (числу условий связи), накладываемых данной парой:
 одно ограничение (одно условие связи) – пара I класса, например,
шар на плоскости (рис. 2.4).

Рисунок 2.4 – Шар на плоскости

17
  два ограничения (два условия связи) – пара II класса, например, ци-
линдр на плоскости (рис. 2.5).

Рисунок 2.5 – Цилиндр на плоскости

 три ограничения (три условия связи) – пара III класса, например, при
соприкосновении двух плоскостей (рис. 2.6).

Рисунок 2.6 – Соприкосновение двух плоскостей

 четыре ограничения (четыре условия связи) – пара IV класса, напри-

мер, вал во втулке (рис. 2.7).

Рисунок 2.7 – Вал во втулке

 пять ограничений (пять условий связи) – пара V класса (пары пятого

класса могут быть поступательными (рис. 2.8) и вращательными (рис. 2.9)).

Рисунок 2.8 – Поступательная Рисунок 2.9 – Вращательная пара V

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

а) б)
Рисунок 2.10 – а) плоское изображение; б) пространственное
изображение

Вращательная пара, соединяющая неподвижное звено (стойку) с по-

движным (рис. 2.11).

а) б)
Рисунок 2.11 – а) плоское изображение; б) пространственное
изображение

Поступательная пара, соединяющая подвижные звенья (рис. 2.12).

а) б)
Рисунок 2.12 – а) плоское изображение; б) пространственное
изображение
19
 Поступательная пара, соединяющая неподвижное звено (стойку) с по-
движным (рис. 2.13).

а) б) в) г)
Рисунок 2.13 – а, б) плоское изображение; в, г) пространственное
изображение

2.4. Классификация переносных степеней подвижности

манипулятора с последовательной кинематикой

Для обеспечения пространственного движения схвата в общем случае

достаточно трех переносных степеней подвижности робота, расположен-
ных относительно друг друга определенным образом. Основными мини-
мально необходимыми условиями обеспечения пространственного движе-
ния схвата в манипуляторе, образованного парами 5-го класса, являются:
1) наличие двух вращательных пар с непараллельными осями
(обычно оси в этом случае перпендикулярны друг другу) и третьей враща-
тельной или поступательной пары, обеспечивающей изменение радиуса
сферы (рис. 2.14, а);
2) наличие двух вращательных пар с параллельными осями и тре-
тьей поступательной пары, направляющая которой неперпендикулярна
осям вращательных пар, или вращательной пары, ось которой непарал-
лельна осям предыдущих (рис. 2.14, б);
3) наличие двух поступательных пар с непараллельными направ-
ляющими и одной вращательной пары, ось которой неперпендикулярна
плоскости, образованной направляющими поступательных пар, или посту-
20
пательной пары, направляющая которой непараллельна названной плоско-
сти (обычно направляющие перпендикулярны друг другу, а ось враща-
тельной пары параллельна плоскости) (рис. 2.14, в).

а) б) в)
Рисунок 2.14 – Переносные степени подвижности манипулятора

Приведем основные манипуляционные системы, обеспечивающие пе-

реносные движения схвата манипулятора при различной последователь-
ности использования вращательных и поступательных кинематических пар
(рис. 2.15-2.22):

Рисунок 2.15 – Сочетание пар «Вращательная – вращательная – враща-

тельная» (схема робота немецкой фирмы KUKA)

21
Рисунок 2.16 – Сочетание пар «Поступательная – вращательная – вра-
щательная»

Рисунок 2.17 – Сочетание пар «Вращательная – поступательная – вра-

щательная»

22
 а) б)
Рисунок 2.18 – Сочетание пар «Вращательная – вращательная – поступа-
тельная»: а) схема робота японской фирмы «СКАРА»; б) схема робота аме-
риканской фирмы «ЮНИМЕЙТ»

Рисунок 2.19 – Сочетание пар «Поступательная – вращательная – по-

ступательная»

Рисунок 2.20 – Сочетание пар «Вращательная – поступательная – посту-

пательная»: схема робота американской фирмы «ВЕРСАТРАН»
23
 Рисунок 2.21 – Сочетание пар «Поступательная – поступательная – вра-
щательная»

Рисунок 2.22-– Сочетание пар «Поступательная – поступательная – по-

ступательная»

Не все приведенные схемы обеспечивают совершенно различные ра-

бочие зоны. В некоторых случаях перестановка поступательной и враща-
тельной пары не влияет на форму рабочей зоны, например, схемы, пред-
ставленные на рис. 2.16, 2.17 и 2.18 а, имеют одинаковые рабочие зоны.
Однако на динамику манипулятора это оказывает существенное влияние,
а, следовательно, и на характер управляющих воздействий. Более предпо-
чтительной по энергетическим затратам из трех упомянутых является схе-
ма, приведенная на рис. 2.18 а, так как для вертикального перемещения
груза в этой схеме не требуется перемещение промежуточных звеньев,
именно эта схема используется в роботах японской фирмы «СКАРА».
Схемы, представленные на рис. 2.15, 2.18 а, 2.18 б, 2.20 и 2.22, явля-
ются наиболее распространенными и по ним выполнено большинство

24
промышленных роботов. В частности, по схемам, приведенным на рис.
2.18 б и 2.20, выполнены первые промышленные роботы соответственно
«Юнимейт» и «Версатран».

2.5. Классификация переносных степеней подвижности по системам

координат

Переносные степени подвижности классифицируют по системам коор-

динат, которые они обеспечивают. Различают следующие системы коорди-
нат, используемые в робототехнике: цилиндрическая система координат (рис.
2.23), сферическая (рис. 2.24), прямоугольная (рис. 2.25) и угловая (ангуляр-
ная) (рис. 2.26).

Рисунок 2.23 – Цилиндрическая система координат

Рисунок 2.24 – Сферическая система координат

25
 Рисунок 2.25 – Прямоугольная система координат

Рисунок 2.26 – Угловая (ангулярная) система координат

2.6. Классификация ориентирующих степеней подвижности

Если в заданной точке рабочего пространства манипулятора его схват

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

26
 Приведем основные манипуляционные системы, обеспечивающие ори-
ентирующие движения схвата (рис. 2.27-2.29).

Рисунок 2.27 – Обеспечение полной пространственной

ориентации схвата

Рисунок 2.28 – Ротация с дополнительным пространственным

движением схвата

Рисунок 2.29 – Ротация схвата

4. Без ориентирующих степеней подвижности (в этом случае оборудо-

вание расставляется так, чтобы рука робота оказывалась в требуемом относи-
тельно него положении).

27
 Следует заметить, что по первой схеме выполнено примерно 10% ориен-
тирующих степеней подвижности роботов, по второй – примерно 25%, по
третьей – примерно 37%.

Вопросы к лекции 2:
1. Дайте определения основным понятиям структуры манипуляционных
систем: манипулятор, кинематическое звено, кинематическая пара, кинема-
тическая цепь, разомкнутая и замкнутая кинематические цепи.
2. Приведите классификацию кинематических пар по классам и типам
движения.
3. Приведите классификацию робототехнических систем по переносным
степеням подвижности.
4. Приведите классификацию робототехнических систем по ориентиру-
ющим степеням подвижности.
5. Какие системы координат используются при описании движения ро-
бота?
6. Приведите схемы роботов, работающих в наиболее используемых в
робототехнике системах координат.
7. Назовите наиболее распространенные в технике схемы манипуляторов
роботов.

28
 Раздел 2. Основы кинематики и динамики манипуляционных
систем роботов с последовательной структурой

Лекция 3. Преобразования координат в манипуляционных системах

3.1. Описание положения схвата в абсолютной системе координат.

Понятие о прямой и обратной задачах кинематики манипуляторов
роботов

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

робота необходимо вначале установить кинематические зависимости
между перемещениями звеньев манипулятора относительно друг друга при
работе приводов и положением и ориентацией всех звеньев манипулятора
в инерциальном пространстве.
Положение и ориентация схвата в пространстве определяется закона-
ми движения его характерной точки Аn (центра схвата) относительно абсо-
лютных (инерциальных) осей координат (рис. 3.1):
x0n = x(t), y0n = y(t), z0n = z(t)
и ориентацией n-го звена
x0^zn = f1(t), y0^zn = f2(t), x0^yn = f3(t),
где x0n, y0n, z0n – координаты характерной точки схвата (центра схвата
Аn), расположенной на последнем n-ом подвижном звене манипулятора, в
системе координат неподвижного О-го звена (стойки) манипулятора; x0^zn,
y0^zn, x0^yn – углы между соответствующими осями 0-го и n-го звеньев,
определяющие ориентацию звеньев в пространстве; t – время движения
схвата.

29
 Рисунок 3.1 – Положение схвата манипулятора в инерциальной
системе координат

В свою очередь, положение i-го звена относительно предыдущего (i-1)-

го (рис.3.2) устанавливается с помощью обобщенной координаты qi (i=1,.., n):
i - при вращательн ом движении i - го звена относитель но (i - 1) - го;
qi 
Si - при поступател ьном движении i - го звена относитель но (i - 1) - го.

а) б)
Рисунок 3.2 – Обобщенные координаты: а) вращательная кинематиче-
ская пара; б) поступательная кинематическая пара

30
 Следовательно, необходимо иметь математический аппарат, позволя-
ющий установить для манипулятора любой конфигурации математиче-
скую модель его кинематики, которую в общем виде можно представить
следующим образом:
- для прямой задачи кинематики:
x 0 n  x (q1 , q 2 ,...,q n ; t );
 y  y(q , q ,...,q ; t );
 0n 1 2 n
z 0 n  z(q1 , q 2 ,...,q n ; t );

x 0 ^ z n  f1 (q1 , q 2 ,...,q n ; t );
 y 0 ^ z n  f 2 (q1 , q 2 ,...,q n ; t );

x 0 ^ y n  f 3 (q1 , q 2 ,...,q n ; t ).
- для обратной задачи кинематики:
q1  q1 ( x 0n , y 0n , z 0n ; x 0 z n , y 0 z n , x 0 y n ; t );

q 2  q 2 ( x 0n , y 0n , z 0n ; x 0 z n , y 0 z n , x 0 y n ; t );

..................................................................;
   
q n  q n ( x 0n , y 0n , z 0n ; x 0 z n , y 0 z n , x 0 y n ; t )

Задачи подобного ряда сводятся к преобразованию координат. В об-

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

3.2. Однородные координаты в кинематике манипуляторов роботов.

Матрицы перехода 4×4 кинематических пар 5-го класса

При составлении математических моделей кинематики манипуляторов

наибольшее распространение получило матричное исчисление. Долгое вре-
мя для этой цели использовалось сочетание матриц поворота размером 3×3,
элементами которых были направляющие косинусы углов между осями (трех
31
осей одной системы координат относительно трех осей другой) и матриц пе-
реноса размером 3×1, элементами которых служили координаты по трем
осям начала соответствующей системы координат.
Наличие двух матриц разной размерности и разного назначения приво-
дило к необходимости использовать операции умножения и сложения мат-
риц, к усложнению алгоритма вычисления, а следовательно, к увеличению
машинного времени, что сказывается на отработке управляющих сигналов в
реальном времени и на управляемости робота.
В последние десятилетия стали использовать комплексные матрицы пе-
рехода размером 4×4, позволяющие осуществлять одновременно поворот и
перенос (смещение) одних координат по отношению к другим. В этом случае
для описания положения точки в пространстве используются однородные
координаты, в которых к обычным координатам добавляется четвертая, рав-
ная единице. То есть координатами точки будут (xi, yi zi, 1). Если известны
однородные координаты (xi, yi, zi, 1) вектора Ri некоторой точки Ai в «ста-
рой» i-ой системе координат, то однородные координаты (xi-1, yi-1, zi-1, 1) век-
тора Ri-1 этой точки Ai в «новой» (i-1)-й системе координат рассчитываются в
общем случае по известным формулам:

x i 1, i  C( x i 1 x i ) x i  C( x i 1 y i ) y i  C( x i 1 z i )z i  x iОi1, i ;

y i 1, i  C( y i 1 x i ) x i  C( y i 1 y i ) y i  C( y i 1 z i )z i  y iОi1, i ;
(3.1)
z i 1, i  C(z i 1 x i ) x i  C(z i 1 y i ) y i  C(z i 1 z i )z i  z iОi1, i ;
1  C90x i  C90y i  C90z i  1,
где C – символ, обозначающий тригонометрическую функцию
«cosinus», xi-1,i^xi,…, zi-1,i^zi – углы, образуемые осями «старой» i-й системы
координат с осями «новой» (i-1)-й системы так, что поворот определенной
оси (i-1)-й системы до совмещения с соответствующей осью i-й системы

O O O
должен видеться против часовой стрелки; x i i1,i , y i i1,i , z i i1,i - координаты

начала координат Оi i-й системы в системе координат O i 1X i 1Yi 1 Z i 1 . Три-

32
  
гонометрические функции C( x i1,i x i ),....,C(z i1,i z i ) называют направля-

ющими косинусами осей i-ой системы в (i-1)-ой.

Взаиморасположение i-й системы координат относительно (i-1)-й пред-
ставлено на рис. 3.3 и 3.4: на рис. 3.3 показаны координаты
  
x iOi1,i , y iOi1,i , z iOi1,i и xi-1, yi-1, zi-1; на рис. 3.4 углы x 0 z n , y 0 z n , x 0 y n ,

определяющие ориентацию i-го звена, относительно (i-1)-го.

Рисунок 3.3 – Расположение i-й системы координат относительно (i-1)-й

33
 Рисунок 3.4 – Ориентация i-й систем координат относительно (i-1)-й

Выражение (3.1) можно переписать в матричном виде:

x i1,i a 11 a 12 a 13 a 14 x i
y i1,i a 21 a 22 a 23 a 24 y i
 
z i1,i a 31 a 32 a 33 a 34 z i
1 0 0 0 1 1

или в векторном: R i1,i  i1,i  R i,i , (3.2)

где
a 11 a 12 a 13 a 14
a 21 a 22 a 23 a 24
i1,i  –
a 31 a 32 a 33 a 34
0 0 0 1
однородная матрица перехода от i-й к (i-1)-й системе координат.

34
 Матрицу i1,i можно представить как блочную матрицу:

 i1,i L i1
i1,i  ,
0 1
в которой матрица

a11 a12 a13 C( x i1 x i ) C( x i1 y i ) C( x i1 z i )

 i1,i  a 21 a 22 a 23  C( y i1 x i ) C( y i1 y i ) C( y i1 z i )
a 31 a 32 a 33 C(z i1 x i ) C(z i1 y i ) C(z i1 z i )

является матрицей поворота i-й системы координат относительно (i-1)-й и

содержит соответствующие направляющие косинусы.
Матрица L i 1, i является матрицей переноса начала координат i-й си-

стемы до совмещения с началом (i-1)-й системы координат:

a14 x iOi1,i
L i1,i  a 24  y iOi1,i .
a 34 z iOi1,i

Переход от одной системы координат к другой с помощью матричного

аппарата оказывается удобным средством описания кинематики манипулято-
ра.
Чтобы использовать матричный аппарат преобразования координат для
описания кинематики манипуляторов, необходимо связать с каждым i-м зве-
ном манипулятора систему координат, расположенную определенным обра-
зом в i-ой кинематической паре на i-м звене.
В этом случае переход от i-й системы координат к (i-1)-й с помощью
однородной матрицы перехода i1,i можно трактовать как пересчет извест-

ных координат x i , y i , z i ,1 точки А некоторого i-го звена в новую (i-1)-ю си-

стему координат, связанную с (i-1)-м звеном.
При переходе от i-ой системы координат к (i-1)-й полагают, что оси i-ой
системы «уходя» от (i-1)-й, из положения, когда они полностью совпадали с

35
(i-1)-й системой, в положение, которое они занимают, вращались против ча-
совой стрелки относительно соответствующей оси поворота.
Иногда удобно считать, что до совмещения с i-й системой должна пере-
мещаться (i-1)-я система координат до полного совпадения с i-й системой,
как бы повторяя перемещения, которые произвела i-я система, «уходя» от
(i-1)-й.
В общем случае, чтобы совместить «новое» (i-1)-е положение со «ста-
рым» i-м положением системы, используя движение «новой» системы к
«старой», необходимо, как отмечалось, шесть независимых перемещений от-
носительно трех осей координат.

Вопросы к лекции 3:
1. С помощью каких параметров определяется положение схвата мани-
пуляторов в инерциальной системе координат?
2. Какова постановка прямой задачи кинематики манипуляторов робо-
тов?
3. Какова постановка обратной задачи кинематики манипуляторов робо-
тов?
4. С какой целью в кинематике роботов используют однородные коор-
динаты?
5. Поясните составляющие системы формул для преобразования коор-
динат.
6. Каким образом осуществляется переход к матричному представлению
формул для преобразования координат?

36
 Лекция 4. Определение взаимного положения последовательно
соединенных звеньев манипуляционных систем

4.1. Специальные системы координат Денавита-Хартенберга

В тех случаях, когда в манипуляторах роботов используются только

одноподвижные вращательные и поступательные кинематические пары,
для определения положения систем координат, связанных со звеньями ма-
нипулятора, достаточно четырех специальных координат Денавита-
Хартенберга. При этом сами системы координат должны быть связаны со
звеньями и кинематическими парами манипулятора вполне определенным
образом.
Специальные системы координат манипуляторов были предложены
американскими учеными И. Денавитом и Р. Хартенбергом в 1955 – 1960 гг.
Вначале они предназначались для задания осей кинематических пар
рычажных пространственных механизмов с низшими парами. В последнее
время специальная координатная система была успешно применена к опи-
санию кинематики манипуляторов. Это связано с тем, что манипуляторы с
одноподвижными вращательными и поступательными парами обладают
рядом регулярных особенностей, хорошо согласующимися со свойствами
координатной системы Денавита-Хартенберга (рис. 4.1).

37
 Рисунок 4.1 – Специальные системы координат Денавита-Хартенберга

Для задания положения системы координат OiXiYiZi , связанной с i-м

звеном, в системе Oi-1Xi-1Yi-1Zi-1 координат (i-1)-го звена по Денавиту-
Хартенбергу необходимо вначале определить положение кратчайшего рас-
стояния Lz-1 Lz (рис. 4.1) между осями Zi-1 Zi . Положение системы коорди-
нат OiXiYiZi в системе координат Oi-1Xi-1Yi-1Zi-1 будет определено, если
установить параметры, фиксирующие это положение в результате движе-
ния определенным образом (i-1)-ой системы до положения, совпадающего
с i-й системой координат. Для этого:
1) повернем ось Xi-1 на угол θi до положения, в котором она парал-
лельна кратчайшему расстоянию Li-1 Li (перпендикулярно проекции оси Zi
на плоскость Oi-1Xi-1Yi-1Zi-1);
2) переместим повернутую систему координат Oi-1Xi-1Yi-1Zi-1 по оси Zi-1
на величину Si до совпадения начала координат этой системы с точкой Li-1
так, чтобы ось Oi-1Xi-1 совпала с кратчайшим расстоянием Li-1 Li ;
3) переместим параллельно самой себе (i-1)-ю систему координат на
величину аi так, чтобы начало координат этой системы совпало с точкой
пересечения Li кратчайшего расстояния Li-1 Li с осью Zi ;
38
 4) повернем (i-1)-ю систему вокруг оси X'i-1 на угол αi против часовой
стрелки до совпадения с осью Zi.
Понятно, что положение i-й системы координат в (i-1)-й будет полно-
стью определено четырьмя параметрами: θi , Si, аi и αi .
Введем ряд правил расположения осей и начал координат специаль-
ной системы координат относительно кинематических пар и звеньев манипу-
лятора.
Пронумеруем кинематические звенья от неподвижного звена до
наиболее удаленного, на котором закреплен схват, присвоив им соответ-
ственно номера от 0 до n (рис. 4.2), где n – число подвижных звеньев ма-
нипулятора.
Обозначим кинематические пары символом Аi, нижний индекс кото-
рого равен меньшему из номеров звеньев, образующих кинематическую
пару.
Например, кинематическая пара А1 соединяет кинематические звенья
1 и 2, а кинематическая пара А3 – кинематические звенья 3, 4 и т. д.
Введем понятие оси zi i-й кинематической пары. Осью zi i-й враща-
тельной кинематической пары, соединяющей i-ое звено с (i+1)-м является
ось шарнира кинематической пары. Эту ось будем считать принадлежащей
i-му звену и жестко с ним соединенной. Именно вокруг этой оси вращается
(i+1)-е звено относительно i-го.
Осью zi поступательной пары
является какая-либо из прямых, па-
раллельная направляющей данной
поступательной пары. Если ось zi не
параллельна оси zi-1, то ее рекомен-
дуется направлять так, чтобы она
пересекалась с этой осью.
Рисунок 4.2 – Обозначение кинема-
тических звеньев и пар манипулятора
39
 За положительное направление оси zi можно взять любое, в частности,
направления снизу вверх, слева направо, к наблюдателю от наблюдателя
или близкие к ним направления.
Важным моментом при расположении системы координат на i-м звене
манипулятора является выбор ее начала координат Оi и направление оси xi.
Введем соответствующие правила для различных случаев взаиморас-
положения осей zi и zi-1.
Оси zi и zi-1 перекрещиваются (рис. 4.3): начало координат распола-
гается в точке пересечения линии кратчайшего расстояния между осями zi
и zi-1 с осью zi. В этом случае ось хi направляется по линии кратчайшего
расстояния в сторону от оси zi-1 к оси zi. Это наиболее общий случай. Дру-
гие варианты взаиморасположения осей zi-1 и zi следует рассматривать как
частные рассмотренного.

Рисунок 4.3 – Перекрещивающиеся оси zi и zi-1

Оси zi и zi-1 параллельны (рис. 4.4): за начало координат может быть

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

40
 Рисунок 4.4 – Оси zi и zi-1 параллельны

Оси zi и zi-1 совпадают (рис. 4.5): начало Оi системы координат мо-

жет быть назначено в любой удобной по каким-либо дополнительным
условиям точке оси zi, а ось хi направлена перпендикулярно оси zi в произ-
вольном направлении (как правило, в направлении развития i-го звена, т.е.
по i-му звену).
Оси zi и zi-1 пересекаются (рис. 4.6): за начало Оi координат прини-
мается точка их пересечения, а ось хi направляется по общему перпенди-
куляру к осям zi и zi-1.
Во всех случаях ось уi направляется так, чтобы система координат бы-
ла правой.

Рисунок 4.5 – Оси zi и zi-1 Рисунок 4.6 – Оси zi и zi-1

совпадают пересекаются
41
 Эти правила не действуют в полной мере при выборе системы коор-
динат, связанной со стойкой (звено 0), так как отсутствует (i-1)–я кинема-
тическая пара, и системы координат, связанной с последним звеном, на ко-
тором закрепляется схват, так как это последнее звено не содержит кине-
матической пары для соединения со следующим звеном.
Начало О0 системы координат, связанной со стойкой, может быть рас-
положено в любой точке оси z0 , а направление оси x0 принимается произ-
вольно по дополнительным условиям (рис. 4.7).
Начало Оn системы координат, связанной с последним n-м звеном ма-
нипулятора (рис. 4.8), на котором закреплен схват, располагается в точке,
принимаемой за центр схвата (за характерную точку схвата), а ось хn
направляется перпендикулярно оси zn-1. Оси zn может быть назначено про-
извольное направление, например, по оси захватываемой детали или тех-
нологического инструмента или перпендикулярно ей.

Рисунок 4.7 – Система координат, Рисунок 4.8 – Система координат,

связанная с неподвижным звеном связанная со схватом

42
 4.2. Преобразования Денавита-Хартенберга

При использовании преобразований Денавита-Хартенберга используют

следующие элементарные перемещения одной системы координат, связанной
определенным образом со звеном манипулятора, относительно системы ко-
ординат, связанной с другим его звеном (здесь используется метод «ухода»
(i-1)-й системы координат от ее исходного положения до положения, совпа-
дающего с i-й системой координат).
1. Поворот системы (i-1) вокруг оси Zi-1 против часовой стрелки (если
смотреть со стороны оси Zi-1) на угол  i до положения, в котором ось Xi-1
окажется параллельной и однонаправленной с осью Xi.
2. Сдвиг повернутой (i-1)-й системы вдоль оси Zi-1 на величину Si до
совпадения оси Xi-1 с осью Xi .
3. Сдвиг системы (i-1) вдоль оси Xi на величину ai до совпадения начал
координат систем (i-1) и i;
4. Поворот (i-1)-й системы вокруг оси Xi против часовой стрелки (если
смотреть со стороны оси Xi) на угол αi до совмещения оси Zi-1 с осью Zi.
Перечисленные эволюции (i-1)-й системы координат при движении к i-й
применительно к звеньям манипулятора показаны на рис. 4.9.

43
 Рисунок 4.9 – Преобразования Денавита – Хартенберга

Каждое из упомянутых элементарных движений (i-1)-й системы коорди-

нат описывается соответствующей частной матрицей перехода:

1. Поворот системы (i-1) вокруг оси Zi-1 на угол Θi:

Cθ i  Sθ i 0 0
Sθ i Cθ i 0 0
1,i 
TiZθ ;
0 0 1 0
0 0 0 1

44
 2. Сдвиг по оси Zi-1 на величину Si:
1 0 0 0
0 1 0 0
1,i 
TiZS ;
0 0 1 Si
0 0 0 1

3. Сдвиг по оси Xi на величину ai:

1 0 0 ai
0 1 0 0
1,i 
TiXa ;
0 0 1 0
0 0 0 1

4. Поворот вокруг оси Xi на угол αi:

1 0 0 0
0 C i  S i 0
TiX1,i  ,
0 S i C i 0
0 0 0 1
где S есть обозначение тригонометрической функции «sinus».

Результирующая матрица перехода от i-й системы координат к (i-1)-й, то

есть матрица, осуществляющая преобразования системы координат i-го звена
в систему координат (i-1)-го звена, получается путем перемножения частных
матриц перехода:

Τ i 1, i  Τ iΖΘ ΖS
1, i  Τ i 1, i  Τ i 1, i  Τ i 1, i .
Xa Xα

Заметим, что параметры Θi, Si, аi, αi могут принимать и отрицательные

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

45
 Ci - Si C i S i S  i a i Сi
S i Ci S i - Ci S i a i S i
Ti1,i  . (4.1)
0 S i C i Si
0 0 0 1

Матрица Ti -1,i является матрицей перехода 4×4 к (i-1)-й кинематической

паре от i-й пары. Она позволяет найти по формуле (4.1) координаты xi−1, yi−1,
zi−1 некоторой точки Аi в системе (i-1) по известным координатам xi, yi, zi
этой точки в i-й системе координат и по известным параметрам Θi, Si, аi, αi, а
также эта матрица дает возможность определить ориентацию i-го звена отно-
сительно (i-1)-го. Для этого обычно используются наддиагональные элемен-
ты матрицы Ti -1,i :

x iO1,i  a i C i ; x i 1 z i  arccos(S i  S i );

y iO1,i  a i S i ; y i 1 z i  arccos( C i  S i );

z iO1,i  S i ; x i 1 y i  arccos( S i  C i ).

4.3. Определение ориентации звеньев манипулятора с

использованием углов Эйлера

Кроме направляющих косинусов, т.е. косинусов углов между осями ко-

ординат Xi-1, Zi; Yi-1, Zi и Xi-1, Yi при определении ориентации звеньев мани-
пулятора успешно используются углы Эйлера. В кинематике роботов исполь-
зуется система углов Эйлера, которая применяется в теории гироскопов и в
астрономии при описании движения космических тел (рис. 4.10):
- угол прецессии – угол ометания, движения впереди, преддвижения;
- угол нутации – угол колебания оси собственного вращения;
- угол собственного вращения – угол вращения вокруг собственной оси.

46
 При использовании этой системы углов Эйлера переход от (i-1)-й к i-й
системе осуществляется в результате следующей последовательности эволю-
ций (рис. 4.10):
1) поворот на угол прецессии i вокруг оси Zi-1;
2) поворот на угол нутации i вокруг повернутой оси OiXi;
3) поворот на угол собственного вращения i вокруг повернутой оси
OiZi.

Рисунок 4.10 – Углы Эйлера

Перечисленные эволюции i-й системы координат отражаются следую-

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

47
 Ψ, Θ,  XΘ  E Z 
E  E iZΨ  E
 1, i i  1, i i  1, i
i  1, i
Cψ i  Sψ i 0 0 1 0 0 0 C i  S i 0 0
Sψ i Cψ i 0 0 0 Cθ i  Sθ i 0 S i C i 0 0
   
0 0 1 0 0 Sθ i Cθ i 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
Cψ i Ci  Sψ i Cθ iSi  Cψ iSi  Sψ i Cθ iSi Sψ iSθ i 0
Sψ i Ci  Cψ i Cθ iSi  Sψ iSi  Cψ i Cθ i Ci  Cψ iSθ i 0
 .
Sθ iSi Sθ i Ci Cθ i 0
0 0 0 1

Для определения углов Эйлера можно использовать ранее изложенный

алгоритм решения прямой задачи кинематики с той разницей, что на заклю-
чительном этапе должны быть вычислены значения углов Эйлера из сопо-
ставления соответствующих элементов матриц Тi-1,i и Еi-1,, а именно:
1) Рассчитываем матрицу Тi-1,i, в результате становятся известными
численные значения ее элементов.

a11 a12 a13 a14 a11 a12 a13 a14

a 21 a 22 a 23 a 24 a 21 a 22 C( y i 1 z i ) a 24
Ti -1, i   ;
a 31 a 32 a 33 a 34 a 31 C(z i 1 y i ) C(z i 1 z i ) a 34
0 0 0 1 0 0 0 1

2) Сопоставим те элементы матриц Тi-1,i и Еi-1,i, которые наиболее про-

сто позволяют определить углы Эйлера, а именно:
a 33 C i ; i  arccosa 33 ;
a 23   cos  i sin i ; i  arccos(a 23 / sin i ) ;
a 32   sin i  cos i ; i  arccos(a 32 / sin i ) .

48
 Вопросы к лекции 4:
1. Каким образом соотносятся специальные системы координат Денави-
та-Хартенберга с исследованием кинематики манипуляционных систем?
2. Каким образом назначается номера кинематических звеньев и кинема-
тических пар в манипуляторе по правилам Денавита-Хартенберга?
3. Каким образом назначаются оси Zi и определяются начало координат
и направление оси абсцисс специальных систем координат Денавита-
Хартенберга для промежуточных и оконечных звеньев манипуляторов?
4. Что представляют собой преобразования Денавита-Хартенберга для
манипулятора?
5. Каким образом преобразования Денавита-Хартенберга записываются
в матричной формуле?
6. Приведите результирующую матрицу перехода от (i-1)-й кинематиче-
ской пары к i –й.
7. Каким образом выражается положение i-го звена в абсолютном про-
странстве через элементы результирующей матрицы?
8. Назовите углы Эйлера, определяющие ориентацию i –го звена в си-
стеме координат (i-1)-го звена.
9. С помощью каких элементов результирующей матрицы Эйлера целе-
сообразно определять ориентацию одного звена относительно другого?

49
 Лекция 5. Прямая задача кинематики манипуляционных систем с
последовательной кинематикой

5.1. Обобщенные координаты манипуляционных систем. Таблица

кинематических пар манипулятора

В принятых специальных системах координат ось Zi всегда направлена:

 во вращательной кинематической паре по оси вращения;
 в поступательной паре параллельно направляющей кинематической
пары.
Напомним также, что положение i-го звена относительно (i-1)-го опре-
деляется обобщенной координатой qi (i = 1,…, n).
Если два звена соединены вращательной парой (рис. 5.1, а), то при вра-
щении i-го звена относительно (i-1)-го из четырех параметров  i, Si, ai и i
переменным будет параметр  i, то есть во вращательной кинематической па-
ре: qi =  i, Si = const, ai = const, i = const.
Если два звена соединены поступательной парой (рис. 5.1, б), то при пе-
ремещении i-го звена относительно (i-1)-го из четырех параметров  i, Si, ai и
i переменным будет параметр Si, то есть в поступательной паре:
qi = Si,  i = const, ai = const, i = const.
Таким образом, из четырех параметров, ориентирующих i-ю систему ко-
ординат, а следовательно, и i-е звено относительно (i-1)-го при движении i-го
звена относительно (i-1)-го переменным будет один параметр  i или Si, а три
остальных – постоянны.

50
 а)

б)
Рисунок 5.1 – Обобщенные координаты манипулятора: а) вращательная;
б) поступательная кинематические пары
51
 Для описания кинематики манипулятора целесообразно использовать
специальную таблицу кинематических пар, в которой для конкретного мани-
пулятора проставляются определенные значения параметров  i, Si, ai, i, а
переменные параметры, являющиеся обобщенными координатами, отража-
ются буквой qi (i = 1,…, n).

Таблица кинематических пар манипулятора

Рассмотрим пример манипулятора, образованного последовательностью

кинематических пар: вращательная – поступательная – вращательная
(рис.5.2).

52
 Рисунок 5.2 – Специальные системы координат звеньев манипулятора

Обоснуем выбор систем координат звеньев манипулятора.

Система О0X0Y0Z0 выбрана произвольно при обеспечении направления
оси Z0 по оси кинематической пары А0.
В системе О1X1Y1Z1: ось Z1 направлена по направляющей кинематиче-
ской пары А1 и совмещена с осью Z0. Начало координат О1 может быть вы-
брано в любой точке оси Z1 – в нашем случае она совмещена с точкой О0.
Поэтому S1 = a1 = 0, оси Z0 и Z1 совпадают, значит 1=0. Ось О1X1 направлена
параллельно звену 2, поскольку так удобнее фиксировать поворот звена 2
совместно со звеном 1. Переменным является угол  1, так как звено 1 вра-
щается относительно звена 0, следовательно, q1=  1.
Система координат О2X2Y2Z2 выбрана по ранее изложенному правилу:
так как пара А1 поступательная (звено 2 перемещается относительно звена 1),

53
то расстояние S2 будет переменным, следовательно q2 = S2. Величины  2, а2
и 2 найдены по общему правилу:  2 = π, 2 = 0,5π, a3 = a3*.
Система О3X3Y3Z3 выбрана по правилу, действующего для n-го (по-
следнего) звена: начало О3 координат назначено в центре А3 схвата, ось Х3
направлена перпендикулярно оси Z2. Так как пара А2 вращательная, то пере-
менным параметром будет угол  3, следовательно, q3 =  3. Параметры S3, a3
и 3 определяются по общему правилу: S3 = 0 (так как после поворота оси Х2
на угол  3 оси X2 и X3 совпали), a3 = a3*, 3 = - 90o и являются постоянными.
Примечание: a2* и a3* – некоторые фиксированные значения параметров
a2 и a3 .
Заполним таблицу кинематических пар для данного манипулятора.

5.2. Расчет положения схвата в пространстве абсолютных координат

Прямая задача кинематики манипуляторов заключается, как отмечалось,

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

54
 Важным частным видом прямой задачи кинематики манипулятора явля-
ется определение положения его схвата, закрепленного на последнем n-м
звене манипулятора.
Положение схвата в неподвижной системе координат будет определено
полностью, если будут известны координаты его центра Аn и ориентация по-
следнего n-го звена в неподвижной системе координат. В нашем случае, ко-
гда в центр Аn схвата помещено начало n-й системы координат, для опреде-
ления положения и ориентации схвата достаточно определить координаты
начала n-й системы координат в системе координат, связанной с 0-м звеном.
Запишем формулу (3.2) для n звеньев,как бы «пятясь» от звена n к звену 0.
R n 1,n  Tn 1,n  R nn ,
R n 2,n  Tn 2,n 1  R n 1,n ,
........................................,
R 1,n  T1, 2  R 2 n ,
R 0,n  T0,1  R 1,n .
Подставив в последнее равенство последовательно все предыдущие, по-
лучим
R 0n  T01  T12 ...Tn 1,n  R nn

или в более общем виде

R 0n  T0n  R nn ,
(5.1)
где
T0n  T01  T12 ... Ti1,i ... Tn 1,n .
(5.2)
Каждый элемент матрицы Т0n содержит информацию о взаиморасполо-
жении системы координат ОnXnYnZn в неподвижной системе координат
О0X0Y0Z0:
0n 0n 0n 0n
a 11 a 12 a 13 a 14
a 021n a 022n a 023n a 024n
T0n  0n 0n 0n 0n
.
a 31 a 32 a 33 a 34
0 0 0 1
55
 Обратим внимание на важное обстоятельство: начало координат n-го
звена совпадает с центром схвата xnn = ynn = znn = 0. Следовательно:
R nn  colon 0 0 0 1 .

Таким образом, первые три элемента 4-го столбца матрицы T0n, а именно
элементы a 14
0n 0n представляют собой координаты центра схвата. Это
, a 024n , a 34
объяснятся еще и тем, что эти элементы являются координатами, которые
отражают смещение (перенос) начала координат n-ой системы относительно
0-й неподвижной системы координат.
В нашем же случае начало координат n-й системы и центр схвата An как
отмечалось, совпадают, что и подтверждают равенства:
х0n = a 14
0n
, y0n = a 024n , 0n .
z0n = a 34

Матрица T0n по структуре полностью аналогична любой матрице Тi-1,i

(4.1).
Значит, как и в матрице Тi-1,i, 1-й элемент 2-го столбца и первые два эле-
мента 3-го столбца будут являться направляющими косинусами осей zn и yn
относительно осей х0 и y0, а именно:
cosx 0 ^ z n   a13
0n
;

cosy 0 ^ z n   a 023n ;

cosx 0 ^ y n   a12
0n
.
Теперь можно определить углы между соответствующими осями:

x 0 zn  arccos a13
0n ;


y 0 zn  arccos a 023n ;


x 0 yn  arccos a12
0n .

Перепишем матрицу T0n, опустив верхние индексы:

a 11 a 12 a 13 a 14
a a a a (5.3)
T0n  21 22 23 24 .
a 31 a 32 a 33 a 34
0 0 0 1
56
 Заметим, что положение схвата в пространстве (координаты его центра
Аn и ориентацию n-го звена) мы определяем шестью наддиагональными эле-
ментами матрицы T0n. Таким образом, шесть наддиагональных элементов
матрицы T0n дают полную информацию о положении схвата в пространстве.
Следовательно, отпадает необходимость в использовании формулы
(5.1), а достаточно использовать выражение (5.3) в виде:
a 11 a 12 a 13 a 14
a 21 a 22 a 23 a 24 (5.4)
 T0,1  T1,2T2,3    Tn 1, n.
a 31 a 32 a 33 a 34
0 0 0 1

и воспользоваться наддиагональными элементами а12, а13, а23 и а14, а24,а34.

5.3. Определение взаиморасположений промежуточных звеньев

манипулятора

Для определения положения любого промежуточного i-го звена манипу-

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

 a 12 0i 0i
a 13 a 14 0i
 
0i 0i
a 23 a 24
T0,i   T01  T12    Ti 1,i.
  
0i
a 34
0 0 0 1
Наддиагональные элементы дадут искомое решение.
Можно также определить положение любого m-го звена относительно
k-го звена (k<m) по формуле:
Tk,m  Tk,k 1  Tk 1,k 2...Tm1,m .
Заметим, что в силу закона ассоциативности исходные матрицы –
сомножители, записанные в порядке возрастания номеров звеньев и пар ма-
нипулятора, можно перемножать как справа налево, так и слева направо.
57
 Перемножение справа налево более наглядно, т.к. последовательно ко-
ординаты схвата пересчитываются в предыдущие системы координат: «счет
пятясь». Так удобно умножать, когда определяется положение только схвата.
Перемножение слева направо позволяет попутно определить положения
всех промежуточных звеньев. Для этого достаточно лишь обеспечить в ходе
вычислительного процесса запоминание (сохранение) наддиагональных эле-
ментов матриц, получаемых как промежуточные при расчете.

Вопросы к лекции 5:
1. В каких случаях и какие параметры кинематических пар выступают в
роли обобщенных координат?
2. Каким образом составляется таблица кинематических пар манипуля-
тора?
3. Приведите последовательность расчета положения схвата в абсолют-
ном пространстве на основе матриц перехода 4х4.
4. С помощью каких элементов результирующей матрицы определяется
положение схватов в пространстве?
5. Каким образом можно определить положение в пространстве проме-
жуточных звеньев манипулятора относительно стойки?
6. Каким образом можно определить положение одного промежуточного
звена относительно другого промежуточного звена?

Лекция 6. Решение прямой задачи кинематики при позиционном

управлении

Позиционное управление обеспечивает движение схвата от одной фик-

сированной точки к другой с остановкой в каждой точке. Поэтому с теорети-
ческой точки зрения достаточно рассмотреть движение между двумя сосед-
58
ними точками, одну из которых можно считать начальной (точка, в которой
схват находится в данное время), а другую – конечной – куда схват должен
переместиться.
При позиционном управлении таких точек обычно более 2-х.
Цикловое управление является частным случаем позиционного. При
цикловом управлении задается две точки позиционирования, находящиеся,
как правило, на значительном расстоянии друг от друга: место хранения за-
готовок – рабочая зона станка. На данном этапе будем считать, что для реше-
ния прямой задачи при позиционном управлении известны координаты
начальной и конечной точек схвата в неподвижной системе координат, свя-
занной с неподвижным (0-м) звеном манипулятора. И главное, будем счи-
тать, что известны значения обобщенных координат, соответствующих
начальному и конечному положениям схвата. Например, для двухподвижно-
го манипулятора (рис. 6.1) должны быть известны значения:
q1н  1н ; q1к  1к ; qн2  н2 ; qк2  к2 .

Рисунок 6.1 – Двухподвижный манипулятор

59
 Прямая задача кинематики в этом случае разделяется на две подзадачи:
1-я подзадача: планирование траекторий в пространстве обобщенных
координат. Эта подзадача сводится к определению положения одного звена
относительно предшествующего ему звена, то есть к определению обобщен-
ных координат в функции времени:
qi  qi (t) , ( i  1,...,n ).
2-я подзадача заключается в определении траектории движения схвата и
его ориентации в пространстве (а при необходимости и всех других харак-
терных точек звеньев) при его движении от начальной точки к конечной. Эта
подзадача является, по сути, задачей анализа траектории схвата с целью вы-
яснения допустимости этой траектории по геометрическим, кинематическим
и динамическим параметрам.

6.1. Синтез законов движения по обобщенным координатам

манипулятора (первая подзадача)

Решение 1-й подзадачи начинается с выбора общего вида закона движе-

ния звеньев по обобщенной координате.
Наибольшее распространение получили два закона движения:
прямоугольный и синусоидальный законы движения (названия даны по виду
диаграмм ускорений).
Для прямоугольного закона характерно минимально возможные при
данной длительности интервалов разгона и торможения значения ускорений,
а, следовательно, и сил инерций при движении одного звена относительно
другого. Однако в начале и конце интервалов разгона и торможения
возникают так называемые «мягкие» удары, связанные с мгновенным
изменением в указанные моменты инерционных воздействий (сил или
моментов сил инерций).

60
 При движении i-го звена относительно (i-1)-го по прямоугольному
закону (рис. 6.2) i-е звено на интервале tр разгоняется под действием
прилагаемого усилия, развивающего постоянное ускорение q i . При

достижении скорости q iП ускорение принимает значение, равное 0, а усилие

привода тратится на преодоление сил трения.
На интервале торможения работают устройства торможения, которые
развивают силовое воздействие для обеспечения отрицательного ускорения
q iT .
Длительности интервалов разгона tрi, движения с постоянной скоростью
tПi и торможения tTi связаны зависимостью
t рi  t Пi  t Ti  T ,
где Т – заданное время движения от начальной точки к конечной. По-
этому произвольно можно назначать лишь длительности двух интервалов,
например: tрi и tTi. Для обеспечения наибольшего быстродействия робота сле-
дует принять
t pi  t Ti  0,5T .

В этом случае в первую половину интервала движение i-го звена будет

равно ускоренным, а во вторую – равно замедленным.

6.1.1. Синтез прямоугольного закона движения из физических

предпосылок

Так как в конце интервала разгона и вначале интервала торможения ско-

рость i-го звена одинакова, то

qip  t pi  qiT  t Ti ,

значит
qiT  qiР  t pi / t Ti . (6.1)

61
 При выбранных длительностях интервалов разгона и торможения необ-

ходимо найти такую величину ускорения q ip , при которой бы звено за задан-
ное время Т переместилось из начальной точки в конечную, т.е. прошло бы
заданный путь qiН.
По графику перемещения i-го звена (рис. 6.2) можно записать уравнение
связи:

Рисунок 6.2 – Закон движения – прямоугольное ускорение

0,5  qip  t 2pi  qip  t pi  t Пi  0,5  qiT  t Ti

2
 q iК  q iН , (i = 1,…,n).

Откуда с учетом зависимости (6.1) получим

qip  (q К  q Н ) /  0,5 t  t  0,5 t  t  .

i i  pi Пi Ti  pi 

После определения обобщенных ускорений q ip и q iT по известным зави-

симостям можно определить обобщенные скорости q i и обобщенные коор-
динаты i-го звена в любой момент времени:
62
  участок разгона (0 ≤ t ≤ tpi):

q i = q ip ∙ t;

q i  q iн  0,5  qip  t 2 ;

 участок движения с постоянной обобщенной скоростью

(tpi < t ≤ tpi + tПi):

q i = qip  t pi  const ;


q i  q iн  0,5  qip  t 2pi  qip  t pi  t  t pi ; 
 участок торможения (tpi + tПi < t ≤ T):

q i = qip  t pi  qiT  t  t pi  t Пi ;

q i  q iн  0,5  q ip  t 2pi  q ip  t pi  t Пi 

   
2
 q ip  t pi  t  t pi  t Пi  0,5  q iT  t  t pi  t Пi .

Итак, получены зависимости q i  q i ( t ) при 0 ≤ t ≤ T (i=1,…,n), подстав-

ляя которые в (5.4) можно определить траекторию схвата.

6.1.2. Синтез прямоугольного закона как сплайн-функции

Выше получен закон движения, исходя, как отмечалось, из физических

представлений. Подойдем к синтезу этого закона чисто формально.
Полученный закон движения представляет собой простейший пример
использования сплайн-функций для описания относительного движения
звеньев по обобщенной координате. Рассмотрим полученную функцию
именно как сплайн-функцию, то есть кусочно-непрерывную функцию,
составленную из нескольких отрезков некоторых непрерывных функций:
графики требуемой функции должны пройти через восемь фиксированных
точек (рис. 6.2), которые можно использовать в качестве условий
проектирования закона движения. Для их удовлетворения надо в
аналитическом выражении иметь восемь свободных коэффициентов. Тогда:
63
  для 1-го участка (0 ≤ t ≤ tp)

q ip ( t )  a 2 t 2  a1t  a 0 ;

 для 2-го участка (tp < t ≤ tp + tП)

q iП (t )  b1t  b 0 ;
 для 3-го участка (tp + tП < t ≤ T)
q iT (t )  c 2 t 2  c1t  c 0 .
Сформируем граничные условия:
t = 0: 1) q p (0)  q н ; 2) q p (0)  0 ;

t = tp: 3) q p ( t p )  q П ( t p ) ; 4) q p ( t p )  q П ( t p ) ;

t = tp + tП: 5) q П (t p  t П )  q T (t p  t П ) ; 6) q П (t p  t П )  q T (t p  t П ) ;

t = T: 7) q T (T)  q К ; 8) q T (T)  0 .
Подставляя значения обобщенных координат, скоростей и ускорений на
границах участков в полиномы, выражающие законы движения и в их произ-
водные, получим после преобразований и решения соответствующей систе-
мы уравнений:

П qк  qн
q  b1  ;
0,5  t p  t П  0,5  t T

b1 qк  qн
q p  2a 2   .
t p (0,5  t pi  t Пi  0,5  t Ti )  t pi

Из чисто формальных соображений получены те же самые основные за-

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

64
 6.1.3. Синтез синусоидального безударного закона движения

Для обеспечения более плавной безударной работы привода i-го звена

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

Рисунок 6.3 – Синусоидальный закон движения

Для установления зависимостей между длительностями интервалов, ве-

личинами обобщенных ускорений, скоростей и перемещений здесь удобно
использовать диаграмму обобщенных скоростей q i ( t ) :

65
  t 
0,5  q iП 1  cos  при 0  t  t pi ;
 t pi 

q i ( t )  q iП при t pi  t  t pi  t ni ;
 ( t  t pi  t Пi ) 
0,5  q in 1  cos  при t pi  t ni  t  T.
 T  t pi  t Пi 

Интегрируя эту зависимость от 0 до Т и приравнивая результат к пере-

мещению по обобщенной координате qi, равному q iК  q iН , находится посто-

янная интегрированная q iП  const , а после этого и зависимость qi(t) для каж-

дого участка движения.

Дифференцируя выражение для обобщенной скорости q i ( t ) , можно

определить обобщенные ускорения qi ( t ) .

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

6.1.4. Синтез безударного закона на основе сплайн-функций

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

ван закон движения, близкий по характеристикам к синусоидальному, но
представляющий собой полиномиальную сплайн-функцию.
Запишем граничные условия для 12-ти характерных точек этого закона
движения (рис.6.3):
t = 0: 1) q p (0)  q н ; 2) q p (0)  0 ; 3) q p (0)  0 ;

t = tp: 4) q p ( t p )  q П ( t p ) ; 5) q p ( t p )  q П ( t p ) ; 6) q p ( t p )  0 ;

66
 t = tp + tП: 7) q П (t p  t П )  q T (t p  t П ) ; 8) q П (t p  t П )  q T (t p  t П ) ;

9 9) q П (t p  t П )  q T (t p  t П ) ;

t = T: 10) q П (T)  q К ; 11) q П (T)  0 ; 12) q П (T)  0 .

В соответствии с распределением граничных условий по интервалам
движения можно определить требуемые степени полиномов, необходимые
для выполнения перечисленных граничных условий, а именно:
на 1-м и 3-м интервалах движения необходимы полиномы 4-й степени, а
на 2-м – полином 1-ой степени.
Представим упомянутые полиномы в следующем виде:
1-й участок (участок разгона):

q ip (t )  a 4 t 4  a 3 t 3  a 2 t 2  a1t  a 0 ;
2-й участок (участок движения с постоянной скоростью):
q iП (t )  b1t  b 0 ;
3-й участок (участок торможения):
q iT (t )  c 4 t 4  c 3 t 3  c 2 t 2  c1t  c 0 .
Как видно, сумма свободных коэффициентов 3-х представленных выше
полиномов равна числу граничных условий. Следовательно, свободные ко-
эффициенты а4,…, а0, b1, b0, c4,…c0 могут быть найдены из соответствующей
системы уравнений, составленной на основе граничных условий. Заметим,
что коэффициенты а0, а1 и а2 легко определяются по первым трем граничным
условиям при t = 0; a0 = aн; a1 = 0; a2 = 0.
Остальные девять свободных коэффициентов должны быть определены
для каждой степени подвижности из системы уравнений, полученных в соот-
ветствии с граничными условиями от 4-го до 12-го.

67
 6.2. Расчет закона движения схвата в абсолютной системе координат
(вторая подзадача)

Вторая подзадача решается с использованием зависимости (5.4) с учетом

того, что в каждой матрице Тi-1,i элементы являются функциями одной обоб-
щенной координаты qi:
θ i (t)  если пара вращательн ая;
q i (t) 
Si (t)  если пара поступател ьная.

Перепишем выражение (5.2) в виде

T0n (q1,...,q n ; t )  T01[q1 t ] T12[q 2 t ]...Tn 1, n [q n t ] ,

из которого в соответствии с (5.4) определим значения шести наддиаго-

нальных элементов.
 a 12 ( t ) a 13 ( t ) a 14 ( t )
  a 23 ( t ) a 24 ( t )
 T01 q1 ( t )  T12 q 2 ( t )...Tn 1,n q n ( t ).
   a 34 ( t )
0 0 0 1

Понятно, что каждый из наддиагональных элементов есть также функ-

ция обобщенных координат и времени, то есть
ak,1 = ak,1(q1,…, qn; t), k=1,2,3; l=2,3,4.
Таким образом, решение 2-ой подзадачи - есть решение основной пря-
мой задачи кинематики манипулятора и она решается по изложенному ранее
алгоритму при известных, как результат выполнения 1-й подзадачи, зависи-
мостях
qi = qi(t); 0 ≤ t ≤ T.

68
 Вопросы к лекции 6:
1. Получите прямоугольный (по диаграмме ускорений) закон движения
по обобщенным координатам из физических предпосылок.
2. Получите прямоугольный закон движения по обобщенным координа-
там как сплайн-функцию.
3.Синтезируйте синусоидальный закон движения по обобщенным коор-
динатам.
4. Синтезируйте полиномиальный безударный закон движения по обоб-
щенным координатам как сплайн-функцию.
5. Каким образом решается прямая задача кинематики – рассчитывается
закон движения схвата в инерциальной системе координат – по известным
законам движения по обобщенным координатам?

Лекция 7. Определение абсолютных скоростей точек звеньев

манипулятора

После того как принят закон изменения обобщенных координат qi(t),

можно в соответствии с изложенным ранее матричным методом определить
положение схвата и любого другого звена манипулятора в пространстве, т.е.
определить координаты их характерных точек и ориентацию как функцию
времени.
Запишем вновь выражение (5.1): R0n = T0n · Rnn.
Тогда

 0n  dR 0n  dT0n  R nn  T0n  dR nn .
R
dt dt dt

Так как
dR nn  0n  dT0n  R nn или R
 0 , то R  0n  T 0n  R nn .
dt dt

69
 С формальной точки зрения назначение вектора столбца
T
R nn  0 0 0 1 заключается в выделении из матрицы 4x4 подобного ему

вектора-столбца, в основе которого будет четвертый столбец матрицы T 0 n .

Поэтому можно записать с учетом того, что по четвертой дополнитель-
ной координате скорость равна 0.
a 11 a 12 a 13 x 0 n 0 x 0 n
a a 22 a 23 y 0 n 0 y 0 n
R 0n  21   .
a 11 a 11 a 11 z 0n 0 z 0 n
0 0 0 0 1 0
Таким образом, для определения линейных скоростей точек манипуля-
тора и, в частности схвата, достаточно взять производную по времени от со-
ответствующей матрицы перехода и выделить в ней четвертый столбец.
Найдем производную матрицы перехода как производную произведе-
ния:
dT0n   dq1  T  T ...T
T 01 12 23 i 1,i ...Tn 1, n 
dt dt
  dq 2  T ...T
 T01  T12 23 i 1,i ...Tn 1, n  ... 
dt
dq i (7.1)
 T01  T12  T23...T 
i 1,i  ...Tn 1, n 
dt
 dq n
 T12  T23  T34    Ti 1,i    T n 1, n  .
dt
Если бы имелись аналитические выражения для каждого элемента ре-
зультирующей матрицы перехода, то достаточно было бы продифференциро-
вать по времени эти элементы и получить абсолютные скорости по каждой
координате X,Y,Z. Однако обычно располагают только частными результи-
рующими матрицами перехода, перемножая которые определяют координа-
ты необходимых точек манипулятора и ориентацию его звеньев.
Если разрабатывается система управления для конкретного
манипулятора, то в некоторых случаях можно провести преобразования и
70
перейти к конкретным аналитическим выражениям. Но это должно
оцениваться в каждом конкретном случае: либо целесообразно сокращать
затраты времени проектировщиков, либо машинное время при управлении
роботом.
После того, как определены скорости по трем координатам, можно
рассчитать полную абсолютную скорость требуемых точек звеньев
манипулятора, и, в частности, центра схвата.

V0n  x 2 0n  y 2 0n  z 2 0n .
Так как при исследовании кинематики манипуляторов используются
специальные системы координат и перемещение i-го звена относительно
(i-1)-го всегда происходит по оси Zi-1 либо вокруг нее, то расчет производных
от исходных матриц перехода кинематических пар несколько упрощается:
чтобы продифференцировать матрицу перехода кинематической пары
достаточно ее умножить слева на матрицу дифференцирования i-1,i:

0 1 0 0
1 0 0 0
 если i - я кинетическ ая пара вращательн ая;
0 0 0 0
0 0 0 0
 i1,i 
0 0 0 0
0 0 0 0
 если i - я кинетическ ая пара поступател ьная,
0 0 0 1
0 0 0 0
то есть
dTi1,i dq i
  i1,i  Tii,i  .
dt dt
Тогда выражение (7.1) примет вид:

71
 dT0n dq
  01  T01  1  T12    Tn 1,n      
dt dt
dq
 T01  T12     i 1,i  Ti 1,i  i    Tn 1,n     
dt
dq
 T12  T23    Ti 1,i     n 1,n  Tn 1,n  n .
dt
Пример:
Пусть матрица перехода будет иметь вид (поворот вокруг оси Zi-1):
C i  S i 0 0
S i C i 0 0
TiZ1,i  .
0 0 1 0
0 0 0 1
Тогда по правилу дифференцирования матриц
 S i  C i 0 0
dTiZ1,i C i  S i 0 0 d i
  .
dt 0 0 0 0 dt
0 0 0 0
С использованием матрицы дифференцирования i-1,i для вращательной
кинематической пары:
0  1 0 0 CΘ i  SΘ i 0 0
dTiZΘ
1,i 1 0 0 0 SΘ i CΘ i 0 0 dΘ i
   
dt 0 0 0 0 0 0 1 0 dt
0 0 0 0 0 0 0 1
 SΘ i  CΘ i 0 0
CΘ i  SΘ i 0 0 dΘ i
  .
0 0 0 0 dt
0 0 0 0

Определим матрицу T i1,i , равную произведению i1,i  Ti1,i , для

вращательной и поступательной кинематических пар:

 вращательная кинематическая пара q i  i  var ia :

72
 0  1 0 0 С i  S  i C i S i S i a i C
1 0 0 0 S i C  i C i  C i S  i a i S i d i
T i1,i   i1,i  Ti1,i   
0 0 0 0 0 S i C i Si dt
0 0 0 0 0 0 0 1
 S i  C i C i C i S  i  a i S i
C i  S i C i S i S  i a i C i d i
  ;
0 0 0 0 dt
0 0 0 0

 поступательная кинематическая пара: q i  Si  var ia :

0 0 0 0 С i  S  i C i  S i S  i a i C
0 0 0 0 S i C i C  i  C i S  i a i S i
T i1,i   i1,i  Ti1,i   
0 0 0 1 0 S i C i Si
0 0 0 0 0 0 0 1
0 0 0 0
0 0 0 0 dSi
  .
0 0 0 1 dt
0 0 0 0
Зная аналитические выражения матриц скоростей, их можно
непосредственно подставлять в выражение (7.1).
Смысл использования оператора дифференцирования  i1,i , состоит в

сохранении матриц Ti 1,i , чтобы не переходить к другим аналитическим вы-

ражениям при составлении программ вычисления скоростей.

Вопросы к лекции 7:
1. Каким образом можно использовать результирующую матрицу поло-
жения схвата в пространстве для определения его абсолютных скоростей?
2. Запишите матрицы дифференцирования для вращательной и поступа-
тельной кинематических пар.

73
 3. Запишите итоговые формулы для расчета скоростей для вращательной
и поступательной кинематических пар.
4. Запишите формулу для расчета абсолютной линейной скорости схва-
та.

Лекция 8. Обратная задача кинематики манипуляционных систем с

последовательной кинематикой при контурном управлении

8.1. Постановка обратной задачи кинематики манипуляционных

систем

Обратная задача кинематики манипуляторов является одной из основ-

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


q1  q1 U; x 0n , y 0n , z 0n , x 0 /\ z n , y 0 /\ z n , x 0 /\ y n ; t ; 
..................................................................... 
 
q i  q i U; x 0n , y 0n , z 0n , x 0 /\ z n , y 0 /\ z n , x 0 /\ y n ; t ;.,
..................................................................... 


q n  q n U; x 0n , y 0n , z 0n , x 0 z n , y 0 z n , x 0 y n ; t 
/\ /\ /\


где U  (1 / S1 , a 1 , 1 ,..., i / Si , a i ,  i ,...,  n / S n , a n ,  n ).
Необходимо иметь в виду, что в вектор U параметров кинематических
пар для конкретного манипулятора необходимо включать параметр, не явля-

74
ющийся обобщенной координатой, т.е. либо угол поворота  i при поступа-
тельной кинематической паре, либо перемещение S i при вращательной ки-
нематической паре (в векторе U это отражено косой чертой).
При работе манипулятора положение схвата непрерывно меняется по задан-
ному закону движения. При этом центр схвата будет описывать требуемую тра-
екторию, а схват (звено n) будет ориентирован в пространстве вполне определен-
ным образом, то есть обратная задача решается по заданным зависимостям

x 0n  x 0n ( t ); y 0n  y 0n ( t ); z 0n  z 0n ( t );

x 0 /\ z n  f1 ( t ); y 0 /\ z n  f 2 ( t ); x 0 /\ y n  f 3 ( t ).
Примеры заданных траекторий:
 раскрой листового материала (рис. 8.1, а);
 сварка непрерывных швов на сложной пространственной поверхности
(рис. 8.1, б).

а) б)
Рисунок 8.1 – Движение схвата по заданной траектории

Для обеспечения требуемого (заданного) положения схвата в абсолютном

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

x 0n  x 0n (t ); y 0n  y 0n ( t ); z 0n  z 0n ( t ), а другие три – ориентирующие - за-

75
данную ориентацию схвата, закрепленного на n-м звене: x 0 /\ z n  f1 (t );

y 0 /\ z n  f 2 (t ); x 0 /\ y n  f 3 (t ).
Если число степеней подвижности манипулятора меньше шести, то
схват не сможет занять произвольное положение и на его положение и ори-
ентацию будут наложены ограничения.
Если число степеней подвижности больше шести или больше заданных
условий, то манипулятор приобретает свойство маневренности, в результате
которой схват может занять требуемое положение при различных положени-
ях промежуточных звеньев (рис.8.2).

Рисунок 8.2 – Возможные положения звеньев манипулятора при наличии из-

быточной степени подвижности

Избыточные степени подвижности можно использовать для удовлетворе-

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

76
 8.2. Решение обратной задачи прямыми геометрическими методами

Рассмотрим три примера простейших манипуляторов, в которых обрат-

ная задача кинематики может быть решена прямыми методами на основе
геометрических представлений.
Пример 1. Манипулятор с прямоугольной системой координат (рис. 8.3).

Рисунок 8.3 – Манипулятор с прямоугольной системой координат

Задано: n = 3; x03 (t); y03 (t); z03 (t).

Определить: q1(t); q2(t); q3(t).
Непосредственно по рис. 8.3 можно установить, что:
q1 (t )  z 0n (t ); q 2 (t )  y 0n (t ); q 3 (t )  x 0n (t ).

Равенство обобщенных координат требуемым координатам схвата явля-

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

77
 Пример 2. Манипулятор с цилиндрической системой координат (рис.
8.4).

Рисунок 8.4 – Манипулятор с цилиндрической системой координат

Задано: n = 3; x03 (t); y03 (t); z03 (t).

Определить: q1(t); q2(t); q3(t).
По рис. 8.4 можно получить:
q 2 ( t )  z 03 ( t );
q 3 ( t )  x 03
2
( t )  y 03
2
(t);
y 03 ( t )
q1 ( t )  arcsin .
q 3 (t)
Пример 3. Манипулятор с угловой (ангулярной) системой координат
(рис. 8.5).

78
 Рисунок 8.5 – Манипулятор с угловой (ангулярной) системой координат

Задано: x02(t), y02(t).

Определить: q1(t), q2(t).
Данную задачу можно решить, как и раньше, из чисто геометрических со-
ображений:

 2  b12  b 22
q 2 ( t )    arccos ;
2  b1  b 2
q1 ( t )    ,
где:
  x 02
2
( t )  y 02
2
(t);
x 02 ( t )
  arccos ;

b 22   2  b12
  arccos .
2    b1

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

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

79
 Запишем уравнения проекций характерной точки А2 схвата рассматри-
ваемого манипулятора на оси координат:
x 02 ( t )  b1  cos q1  b 2  cos(q1  q 2 );
y 02 ( t )  b1  sin q1  b 2  sin(q1  q 2 ).
Решая эту систему уравнений относительно q1 и q2, можно определить
требуемые законы движения по обобщенным координатам q1(t) и q2(t) уже в
определенной степени абстрагируясь от конкретной схемы манипулятора.
Два последних примера показывают, что даже для простейших манипу-
ляторов определение требуемых по заданной траектории движения схвата за-
конов изменения обобщенных координат связано с решением нелинейных
зависимостей и может представлять определенные трудности.

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

нелинейного математического программирования

К настоящему времени прямого решения обратной задачи для манипу-

ляторов общего вида не существует. В общем случае обратная задача кине-
матики манипуляторов решается алгоритмически численными методами.
Рассмотрим порядок решения обратной задачи с использованием мето-
дов нелинейного математического программирования, в частности, одного из
наиболее распространенных – градиентного метода.
Нелинейное математическое программирование имеет следующий алго-
ритм:
1. Составляется или определяется критериальная функция как функция
некоторых свободных параметров (в данном случае – как функция обобщен-
ных координат манипулятора).
2. Формируется штрафная функция, выражающая дополнительные
условия (ограничения) проектирования и также зависящая от свободных па-
раметров (от обобщенных координат).

80
 3. Составляется целевая функция, в которую входят определенным об-
разом критериальная и штрафная функции.
4. Выбирается метод нелинейного математического программирования
и в соответствии с ним разрабатывается алгоритм оптимизации критериаль-
ной функции как части целевой функции.
5. Создается расчетная программа, и производятся расчеты до выполне-
ния определенных условий.
Изложим последовательность решения обратной задачи кинематики
с использованием методов нелинейного математического программирова-
ния.
Вернемся к выражению (5.2):

T0n  T01  T12  ... Ti1,i  ... Tn 1,n .

Каждая матрица Ti 1,i является функцией одной обобщенной координаты q i ,

которая в свою очередь, есть функция времени, то есть
Ti 1,i  Ti 1,i q i (t ).
Тогда матрица Т0n есть функция всех обобщенных координат и времени:
T0Qn  T0Qn q1 , q 2 , q 3 ,...,q n ; t .
Следовательно, и каждый из шести наддиагональных элементов этой матри-
цы, определяющих положение схвата в пространстве абсолютных координат, так-
же является функцией всех обобщенных координат манипулятора

a Qjr  a Qjr (q1 , q 2 , q 3 ,...,q n ; t ) , ( j  1,2,3; r  2,3,4) .

Пусть задан закон движения схвата, то есть заданы законы изменения

его координат и углы ориентации:
x 0n  x 0n ( t ); y 0n  y 0n ( t ); z 0n  z 0n ( t )  
 (8.1)
x 0 /\ z n  f1 ( t ); y 0 /\ z n  f 2 ( t ); x 0 /\ y n  f 3 ( t )

Тогда можно записать матрицу - задатчик положений и ориентации схвата.

81
 П П П
 a 12 ( t ) a 13 (t) a 14 (t)
  aП П
23 ( t ) a 24 ( t )
T0Пn  П , (8.2)
   a 34 (t)
0 0 0 1
П П
где: a12 (t )  cos[x 0 /\ y n ]; a13 (t )  cos[x 0 /\ z n ]; a П23 (t )  cos[y 0 /\ z n ] ;

П
a 14 (t )  x 0n ( t ); a П П
24 ( t )  y 0 n ( t ); a 34 ( t )  z 0 n ( t ).

Положим, что в некоторый k-й момент времени tk (k=0,…, K) заданное по-

П, k П, k П, k
ложение схвата: a 12 (t k ), a 13 ,...,a 34 (t k ) совпадает с фактическим его по-

ложением (рис. 8.6), обеспечиваемым текущими значениями q ik обобщенных ко-

ординат (К – число заданных точек, не включая 0-ю).
Тогда
T0Пn, k (t k )  T0Qn, k (q1k ,...,q kn ; t k )  0 , (i = 1,…n) (8.3)
то есть
П,k П,k П,k
a12 (t )  a12
Q,k
 0, a13 (t )  a13
Q,k
 0,...,a 34 (t )  a 34
Q,k
 0.
В следующий (k+1)-й момент времени tk+1 элементы матрицы – задатчика (8.2)
П, k 1 П, k 1 П, k 1
примут новые значения a 12 (t ), a 13 (t ),...,a 34 (t ) , рассчитанные по зависи-
мостям (8.1). Для этого момента времени матрица-задатчик в общем виде может быть
представлена как T0Пn,k 1 (t k 1 ) .

Подставив эти новые значения в матрицу T0Пn,k 1 выражения (8.3), получим

T0Пn,k 1 (t k 1 )  T0Qn,k (q1k ,...,q kn ; t k )  0 (8.4)

Неравенство матриц T0Пn,k 1 и T0Qn,k объясняется тем, что обобщенные коор-

динаты в матрице T0Qn,k остались теми же, что были в момент tk.
Решение обратной задачи кинематики манипуляторов для общего случая за-
ключается в том, чтобы определить численными методами, в частности, методами
нелинейного математического программирования, такие новые значения обоб-

82
щенных координат в матрице T0Qn , при которых бы неравенство (8.4) преврати-
лось в равенство (8.3).

Рисунок 8.6 – Заданная траектория схвата

Значения обобщенных координат, при которых обеспечивается равенство мат-

риц T0Пn и T0Qn , принимаются за значения q ik 1 , соответствующие моменту времени
tk+1.
После этого (k+1)-е положение заменяется на k-е и задается очередное новое
положение манипулятора, то есть в полученное равенство вновь вносится рассо-
гласование, которое должно быть устранено после определения очередных значе-
ний обобщенных координат. Процесс продолжается пока не будут определены зна-
чения обобщенных координат для всех требуемых К положений манипулятора на
заданной траектории.
Сформируем критериальную функцию. Так как целью решения являет-
ся поиск таких значений обобщенных координат, при которых разность между за-
данным положением схвата и его фактическим положением равнялась нулю, то в
качестве критерия R следует принять параметр, отражающий эту разность.
Например:

   a 
2 2
k 1 k 1
R  a 12 ( t )  a 12 (q 1m ,...,q m
n ) 13 ( t )  a 13 (q 1m ,...,q m
n ) 

 a )  a )
2 2
k 1 k 1
14 ( t )  a 14 (q 1m ,...,q m
n 23 ( t )  a 23 (q 1m ,...,q m
n 

 a )  a )
2 2
k 1 k 1
24 ( t )  a 24 (q 1m ,...,q m
n 34 ( t )  a 34 (q 1m ,...,q m
n ,

где q im значение i-й обобщенной координаты на шаге m вычислительного

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

Рисунок 8.7 – Гипотетическая траектория вычислительного процесса

(штриховая линия)

Обобщенные координаты qi не могут принимать совершенно произвольные

значения, так как перемещение по каждой степени подвижности может быть толь-

ко в определенных границах (рис. 8.8): q imin  q i  q imax (i=1,…,n).

Рисунок 8.8 – Ограничения на движения звеньев манипулятора

по обобщенным координатам

84
 В связи с этим для автоматического обеспечения возможного диапазона
изменений обобщенных координат вводятся штрафные функции в виде сле-
дующих ограничений на значения qi:

0, если q i  q imin  0;
F1,i 
W1,i (q imin  q i ), если q i  q imin  0,

0, если q imax  q i  0;
F2,i 
W2,i (q i  q imax ), если q imax  q i  0,

где W1,i , W2,i - весовые коэффициенты штрафных функций, которыми

можно регулировать их крутизну. Кроме указанных могут быть и другие

ограничения.
В качестве целевой функции можно использовать функцию, явля-
ющуюся суммой критериальной и частных штрафных функций:
in in
Z(q1 ,...,q n )  R   F1,i   F2,i .
i 1 i 1
Примем в качестве метода поиска новых значений обобщенных координат qi
градиентный метод, выражающийся следующей зависимостью:

Z(q1m ,...,q im  q i ,...,q m

n )  Z(q1 ,...,q i ,...,q n )
m m m
q im 1  q im  hi  ,
q i
(i  1,...,n ),
где h i - шаг по i-й обобщенной координате; q i - малое приращение i-й
обобщенной координаты, используемое при определении частной производной
по qi.
Важно отметить, что в качестве первого приближения q im (m  1) использу-

ется полученное на предыдущем шаге значение q ik , то есть в начальный мо-

мент полагают q1i  q ik .

85
 Вычислительный процесс приближения к значениям q ik 1 может быть пре-
кращен по любому используемому в нелинейном программировании признаку. В

частности, его можно закончить по условию q im1  q im   i , (здесь  i - допус-

каемая по точности воспроизведения траектории величина отклонений i-й

обобщенной координаты) или по достижению заданного числа итераций.
Тогда в качестве окончательного значения обобщенной координаты для
(k+1)-го положения характерной точки схвата следует принять значение

q ik 1  0,5  (q im1  q im ) .
Отметим, что (m+1)-й шаг к (k+1)-й точке в процессе вычислений может осу-
ществляться по различным алгоритмам, свойственным методам нелинейного
программирования. При использовании собственно градиентного метода
(m+1)-й шаг должен осуществляться одновременно по всем координатам после
определения направления движения по антиградиенту.
Полученные значения q ik 1 обобщенных координат соотносятся с моментом
времени tk+1 и запоминаются. После этого в целевую функцию Z вместо значений
k 1 k 1
a 12 ,...,a 34 подставляются значения наддиагональных элементов, соответству-
k 1 k 1
ющие моменту времени tk+2, которые и принимаются за a 12 ,...,a 34 . Затем
вновь запускается вычислительный процесс, который заканчивается, когда будут
определены значения обобщенных координат для всех назначенных реперных то-
чек k (k=0,..., K). В результате получается таблица значений обобщенных коор-

динат q i (i  1,...,n; k  0,...,K) , которую можно трактовать как функции

k

 
q i  q i x 0n , y 0n , z 0n , x 0 /\ z n , y 0 /\ z n , x 0 /\ y n ; t . Таким образом, решение обрат-
ной задачи кинематики манипулятора можно представить таблицей следующе-
го вида:

86
 При выборе количества К реперных (опорных) точек на заданной траек-
тории возникает следующее противоречие: для более точного воспроизведе-
ния траектории желательно назначать как можно больше таких точек, но это
потребует и большего машинного времени для решения обратной задачи.
При редком задании точек схват может отклоняться от заданной траектории
на недопустимую величину.
Таким образом, время, через которое следует назначать опорные точки,
есть функция требуемой точности воспроизведения заданной траектории.
После определения в табличном виде функций qi = qi(t) можно численно
их продифференцировать и найти обобщенные скорости и ускорения, возникаю-
щие в каждой степени подвижности при реализации заданной траектории дви-
жения схвата. Будем использовать для этого центральную разность.
Тогда:

q ik 1  q ik 1
q ik  ;
2  t

q ik 1  2  q ik  q ik 1
qik  .
t 2

Таким образом, будут получены функции q ik , q ik так же в табличном виде.

Чтобы формировать управляющее воздействие в виде непрерывных функций,
а не табличных целесообразно аппроксимировать табличные значения обоб-
87
щенных координат, скоростей и ускорений. Для этого можно воспользоваться,
например, интерполяционной формулой Лагранжа:
( t  t 1 )  ( t  t 2 )  ...  ( t  t K ) ( t  t 0 )  ( t  t 2 )  ...  ( t  t K )
q i ( t )  q i0   q1i  
( t 0  t 1 )  ( t 0  t 2 )  ...  ( t 0  t K ) ( t 1  t 0 )  ( t 1  t 2 )  ...  ( t 1  t K )
( t  t 0 )  ( t  t 1 )  ...  ( t  t K ) ( t  t 0 )  ( t  t 1 )  ...  ( t  t K 1 )
 q i2   ...  q iK  .
( t 2  t 0 )  ( t 2  t 1 )  ...  ( t 2  t K ) ( t K  t 0 )  ( t K  t 1 )  ...  ( t K  t K 1 )
(i=1,…, n)
В результате будет получена непрерывная функция qi(t), которая в фикси-
рованные моменты времени k гарантированно проходит через точки q ik .
Пример.
Пусть при t0 = 0 с; t1 = 2 с; t2 = 4 с соответственно: q 30  50 мм;

q13  60 мм; q 32  40 мм ; t  2 c .
Тогда:

( t  2)  ( t  4)c 2 ( t  0)  ( t  4)c 2
q 3 ( t )  50мм  60мм 
(0  2)  (0  4)c 2 (2  0)  (2  4)c 2
( t  0)  ( t  2)c 2 50мм
 40мм  ( t 2  2  t  4  t  8)c 2 
(4  0)  (4  2)c 2
8с 2

60мм 40мм
 2
( t 2  0  t  4  t  0  4)c 2  2
( t 2  0  t  2  t  0  2)c 2 
4с 8с
 50 60 40  2  300 
    t    60  10   t  50.
 8 4 8   8 

Окончательно: q 3 (t )   3,75t 2  12,5t  50 мм . 

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

систем при управлении по скорости

Как известно, положение схвата манипулятора однозначно определяется

его обобщенными координатами, а именно
X = X[Q(t)], (8.5)

88
где: X = [x(t), y(t), z(t), α(t), β(t), γ(t)] – вектор абсолютных координат схвата;
Q = [q1(t), q2(t), …, qn(t)] – вектор обобщенных координат манипулятора;
n – число степеней подвижности манипулятора;
t – время.
Дифференцируя (8.5) по времени, получим
X ,
  J(Q)Q (8.6)
где J(Q) – матрица Якоби размерностью 6×n для преобразования (8.6).
В терминах рассматриваемой нами обратной задачи кинематики мани-
пуляционных систем матрица Якоби имеет вид:
 x x x 
 q 
q 2 q n 
 1 
 y y

y 
 q 1 q 2 q n 
 z z y 
  
q q 2 q n 
J (Q )   1 .
    
 q 
q 2 q n 
 1 
  

 
 q 1 q 2 q n 
    
  
 q 1 q 2 q n 
Зависимость (8.6) более подробно можно представить следующим обра-
зом:
 dx   dq1 
 t   dt 
 dy   dq 
   J (Q)  2 
 t   dt  (8.7)
     
 d   dq n 
 t   dt 
Зависимости (8.6) и (8.7) показывают, что между абсолютными скоро-
 существует линейная связь, однако,
 и обобщенными скоростями Q
стями X
коэффициенты в этой линейной связи непостоянные, в связи с тем, что эле-

89
 x x  
менты матрицы Якоби , , , , , которые образуют эти ко-
q1 q 2 q n 1 q n
эффициенты в различных сочетаниях, есть величины переменные.
Выражение (8.6) представляет собой прямую скоростную задачу и её
решение при известных (заданных) функциях q1 (t ), q 2 (t ),, q n (t ) не
представляет собой принципиальных трудностей.
Решим зависимость (8.6) относительно обобщенных скоростей Q , а имен-
но
  J 1 (Q)X
Q  (8.8)
Эта зависимость и есть решение обратной задачи при управлении по
скорости, которая и используется часто для управления манипуляционным
роботом в режиме on-line.
При этом вектор обобщенных координат Q является неизвестным и зна-
чения q1 , q 2 , , q n приходится для данного момента времени (рассчитывае-
мого момента реального времени) брать с датчиков обратной связи, фикси-
рующих текущее положение i-го звена относительно (i-1)-го, то есть значе-
ние qi.
В выражении (8.8) J 1 (Q) есть обратная матрица по отношению к мат-
рице Якоби J(Q) .
Рассмотрим более подробно последовательность решения прямой и об-
ратной скоростных задач на примере простого манипулятора с двумя степе-
нями подвижности (рис. 8.9).

90
 Рисунок 8.9 – Манипулятор с двумя степенями подвижности

Прямая задача о положения:

x ( t )  (l 2  q 2 ) cos q1 ;
 (8.9)
y( t )  (l 2  q 2 ) sin q1. 
При этом: q1 = q1(t), q2 = q2(t).
Обратная задача о положении:
y( t )
q1 ( t )  arctan , q 2 (t )  x 2 (t )  y 2 (t )  l 2 . (8.10)
x(t)
Даже для столь простого манипулятора решение обратной задачи пред-
ставляет собой нелинейные зависимости.
Для более сложных манипуляторов найти зависимость Q = Q(X) в явном
виде, как правило, не представляется возможным.
А именно зависимость Q = Q[X(t)] и необходима для управления мани-
пуляционным роботом, так как требуемое движение схвата обеспечивается
соответствующими движениями звеньев манипулятора по обобщенным ко-
ординатам: qi = qi(t), (i = 1, …, n).
В то же время, как было указано ранее (см. зависимость (8.8)), между
обобщенными скоростями q i и абсолютными скоростями x i ; y i ; z i ;  i ;  i ;  i
существует линейная связь с переменными коэффициентами. Именно поэто-
му часто и переходят к управлению по скоростям.

91
 Получим требуемые зависимости между обобщенными и абсолютными
скоростями для рассматриваемого нами двухзвенного манипулятора, исполь-
зуя вначале общий подход, не прибегая пока к обратной матрице Якоби.
Пример решается с целью продемонстрировать порядок получения ана-
литических зависимостей для управления по скоростям, считая это решение
обратной задачи в явном виде (подобно выражениям (8.10)) невозможным
или нецелесообразным из-за сложности.
Поэтому начнём решение с дифференцирования формул (8.9) по време-
ни
x  (l 2  q 2 ) sin q1  q 1  cos q1  q 2 
 (8.11)
y  (l 2  q 2 ) cos q1  q 1  sin q1  q 2 

Введем обозначения:
a 11  (l 2  q 2 ) sin q1 ; a 12  cos q1 

a 21  (l 2  q 2 ) cos q1 ; a 22  sin q1 

Тогда зависимость (8.11) примет вид:

x  a 11q 1  a 12 q 2 ;
(8.12)
y  a 21q 1  a 22 q 2 .
Решим зависимость (8.12) относительно обобщенных скоростей q 1 и q 2 .
Получим вначале явную зависимость от x ( t ) и y ( t ) для обобщенной
скорости q 1 . Для этого умножим первую из зависимостей (8.12) на a22, а вто-
рую на a12:
a 12 a 22 q 1  a 12 a 22 q 2  x a 22 ;
a 21a12 q 1  a 22 a 12 q 2  y a 12 .
Вычтем из первого выражения второе: (a 11a 22  a 21a 12 )q 1  x a 22  y a 12 .
Следовательно:
a 22 a 12
q 1 ( t )  x  y . (8.13)
a 11a 22  a 21a 12 a 11a 22  a 21a 12
92
 Для получения явной зависимости относительно q 2 ( t ) умножим первое
из выражений (8.12) на a21, а второе на a11. Тогда:
a11a 21q 1  a12 a 21q 2  x a 21 ;
a 21a11q 1  a 22 a11q 2  y a11.
Вычитая из первого выражения второе, получим
(a 12 a 21  a 22 a 11 )q 2  x a 21  y a 11 .
Откуда
a 21 a 11
q 2 ( t )  x  y . (8.14)
a 12 a 21  a 22 a 11 a 12 a 21  a 22 a 11
Упростим выражения (8.13) и (8.14). Вначале преобразуем знаменатель
дроби перед x и y ,
(a11a 22  a 21a12 )  (l 2  q 2 ) sin q1 sin q1 
 (l 2  q 2 ) cos q1 cos q1  (l 2  q 2 ).
Теперь выражения (8.13) и (8.14) можно записать в окончательном виде:
sin q1 ( t ) cos q1 ( t )
q 1 ( t )   x ( t )  y ( t );
l2  q 2 l2  q 2 т(8.15)
В матричной q 2 ( t )  cos q1 ( t ) x ( t )  sin q1 ( t ) y ( t ).
форме выражения (8.15) имеют вид
 sin q1 cos q1 
 q 1    x 
q    l 2  q 2 l2  q 2   . (8.16)
 y
 2
 cos q1 sin q1   
Что и требовалось получить.
Выражения для обобщенных скоростей в форме (8.15) и (8.16) выше по-
лучены обычным путем алгебраических преобразований. Для сложных ма-
нипуляторных систем такой подход будет связан с громоздкими преобразо-
ваниями.
Для решения рассматриваемой задачи имеется более рациональный под-
ход с использованием обратной матрицы Якоби.
Представим производные (8.11) в форме матриц:

93
 x   (l 2  q 2 ) sin q1 cos q1   q 1 
 y    (l  q ) cos q   q  (8.17)
   2 2 1 sin q 1  2

Матрица, являющаяся первым сомножителем в правой части выражения

(8.17), есть матрица Якоби.
Следовательно, выражение (8.17) можно записать в виде, аналогичном
(8.6).
Убедимся, что первый сомножитель в правой части выражения (8.17)
есть матрица Якоби для рассматриваемого манипулятора.
Действительно, беря частные производные по q1 и q2 от правых частей
зависимостей (8.9), получим:
 x x 
 q q 2   (l 2  q 2 ) sin q1 cos q1 
J ( Q)   1 
y   (l 2  q 2 ) cos q1 sin q1 
.
 y
 q1 q 2 
Данное выражение полностью совпадает с соответствующей матрицей
выражения (8.17).
Получим обратную матрицу Якоби в следующей последовательности.
1. Матрица алгебраических дополнений исходной матрицы Якоби:
 sin q1  (l 2  q 2 ) cos q1 
JD  
 (l 2  q 2 ) sin q1 
.
 cos q1
2. Присоединенная матрица - транспонированная матрица алгебраиче-
ских дополнений:
 sin q1  cos q1 
Jp  
 (l 2  q 2 ) sin q1 
.
 (l 2  q 2 ) cos q1
3. Определитель исходной матрицы Якоби – Якобиан:
det J(q)    (l 2  q 2 ) sin q1 sin q1 
 (l 2  q 2 ) cos q1 cos q1  (l 2  q 2 )
4. Обратная матрица Якоби

94
  sin q 1 cos q1 
Jp 
J 1 (Q)    l2  q2 l2  q2  .
  
 cos q 1 sin q1 
Как видно, полученное выражение полностью совпадает с первым
сомножителем правой части зависимости (8.16) и, следовательно, выражение
(8.8) полностью обосновано для рассмотренного примера.

8.5. Метод обратных преобразований в решении обратной задачи

манипуляторов

Как было показано ранее, матрица T 0 n , определяющая положение и ори-

ентацию схвата, имеет вид
T0n  T0,1T1,2 ...Ti1,i ...Tn 1,n , (8.18)

где Ti 1,i (q i ) - матрица перехода от i-й к (i-1)-й системе координат мани-

пулятора.
Тогда, умножая соотношение (8.18) слева на T0,11 , имеем

T0,11 (q i )T0n  T1,2 ...Tn 1,n . (8.19)

В силу того, что матрица T0n известна, удается разрешить соотношение

(8.19) относительно q l . Если структура (8.19) такова, что можно найти q 1 , то
этот процесс повторяем для q 2 , q 3 ,…, q n .
П р и м е р . Пусть механизм представляет собой трехстепенной кардан-
ный подвес, ориентация которого задана тремя углами Эйлера:
C  S 0 C 0 S C   S 0
T03  R Z, R Y, R Z,  S C 0 0 1 0  S C 0 . (8.20)
0 0 1  S 0 C 0 0 1
Требуется решить обратную задачу для этого механизма, т.е. найти углы
ψ, θ, φ по заданной матрице Т03.
Умножая слева выражение (8.20) на матрицу,

95
 C S 0
R Z1,   S C 0,
0 0 1

обратную матрице R Z, , получим

R Z1, T03  R Y, R Z, .

или после перемножения матриц:

x x C   x y S y x C   y y S z x C   z y S
 x x S  x y C   y x S  y y C   z x S  z y C  
xz yz zz
CC  C S S (8.21)
 S C 0 .
 S C  SS C

Приравнивая в (8.21) элементы второй строки третьего столбца обеих

матриц, находим
 z x S  z y C  0,

откуда
φ = atan2(zy, zx). (8.22)
Напомним, что функция atan2 учитывает принадлежность аргументов
одному из четырех квадрантов:

 a
 arctg , b  0,
 b
 a
a tan 2(a , b)  arctg  , b  0, a  0,
 b
arctg a  , b  0, a  0;
 b
   a tan 2(a , b)  


96
 Приравнивая элементы второй строки первого и второго столбцов в вы-
ражении (8.21), получаем
S   x x S  x y C  ,
C    y x S  y y C  ;
откуда следует, что
  a tan 2(x x S  x y C ,  y x S  y y C ). (8.23)

Далее, приравнивая элементы первой строки третьего столбца, а также

третьей строки третьего столбца, находим
S  z x C   z y S ,
C  z z ,
следовательно,
  atan2(z x C  z yS , z z ). (8.24)

Таким образом, соотношения (8.22), (8.23), (8.24) решают обратную по-

зиционную задачу кинематики манипуляторов роботов.
Следует обратить внимание, что в данном случае удалось решить обрат-
ную задачу, не прибегая к последовательному домножению матрицы Т03 на
матрицы R Y1, и R Z1, .

Вопросы к лекции 8:
1. Какова постановка и каковы исходные данные для решения обратной
задачи кинематики манипулятора?
2. Поясните понятие мобильность манипулятора.
3. Поясните порядок решения обратной задачи кинематики прямыми
геометрическими методами.
4. Сформируйте алгоритм решения обратной задачи кинематики мето-
дом нелинейного математического программирования.
5. Поясните понятия критериальной, штрафной и целевой функций.
97
 6. Поясните порядок формирования критериальных функции в обратной
задаче кинематики роботов.
7. Поясните порядок формирования штрафной функции в обратной за-
даче кинематики роботов.
8. Поясните порядок формирования целевой функции в обратной задаче
кинематики роботов.
9. Запишите формулу и поясните порядок поиска значений обобщенных
координат градиентным методом нелинейного программирования.
10. Каковы признаки прекращения поиска можно использовать в нели-
нейном математическом программировании?
11. Запишите формулы для определения численными методами скоро-
стей и ускорений схвата с использованием центральной разностной схемы.
12. Поясните порядок использования интерполяционной формулы Ла-
гранжа для представления законов движения звеньев по обобщенным коор-
динатам в непрерывной форме.
13. Каков порядок решения обратной задачи кинематики роботов при
управлении по скорости?
14. Поясните порядок получения матрицы Якоби в решении обратной
задачи.
15. В чем заключается метод обратных преобразований в обратной зада-
че кинематики манипуляционных систем?

98
 Лекция 9. Исследование динамики манипуляционных систем с
последовательной кинематикой на основе уравнений Лагранжа 2-го рода

9.1. Постановка задачи динамического синтеза и анализа

манипуляционных систем

Динамический синтез (обратная задача динамики) манипуляционных

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

d  L  L
   Fi , (i = 1,…, n),
dt  q i  q i
где L – функция Лагранжа, вычисляемая по формуле L=К-П, здесь: К и
П – соответственно полные кинетическая и потенциальная энергии подвиж-
ных звеньев манипулятора в данный момент времени, Fi – обобщенная сила,
действующая в i-й степени подвижности.
Исходными данными для динамического синтеза манипулятора являют-
ся линейные и угловые скорости соответствующих точек и звеньев манипу-
лятора, определяемые в ходе решения прямой или обратной задач кинемати-
ки, моменты инерции и массы звеньев, а также некоторые другие параметры.
В соответствии с приведенным уравнением Лагранжа 2-го рода алго-
ритм определения обобщенных сил сводится к последовательному выполне-
нию следующих операций:
99
 1. Определение кинетической энергии подвижных звеньев манипуля-
тора;
2. Определение потенциальной энергии подвижных звеньев манипулято-
ра;
3. Определение функции Лагранжа L;
4. Почленное определение составляющих уравнения Лагранжа 2-го ро-
да путем дифференцирования функции Лагранжа по обобщенным скоростям
и по времени, а затем – по обобщенным координатам.
В результате выполнения этого алгоритма будут получены зависимости
между обобщенными силами и обобщенными ускорениями, скоростями и
координатами, которые (зависимости) можно в общем виде представить сле-
дующим образом:
F1 q1 , q 1 , q1 ; q 2 , q 2 , q 2 ; ...; q n , q n , q n ; t   F1 ( t );
F2 q1 , q 1 , q1 ; q 2 , q 2 , q 2 ; ...; q n , q n , q n ; t   F2 ( t );
.........................................................................
Fn q1 , q 1 , q1 ; q 2 , q 2 , q 2 ; ...; q n , q n , q n ; t   Fn ( t ).

Полученные n дифференциальных уравнений можно использовать как

для динамического анализа, так и для динамического синтеза манипулятора.
При динамическом синтезе обобщенные силы определяются непосредствен-
но по приведенным уравнениям путем прямых расчетов, так как все парамет-
ры в левых частях уравнений оказываются известными, а при решении задач
динамического анализа, когда известны обобщенные силы Fi(t), но неизвест-
ны обобщенные координаты и их первые и вторые производные по времени
приходится приведенные уравнения рассматривать как систему n обыкно-
венных дифференциальных уравнений второго порядка и решать ее (систе-
му) тем или иным численным методом, например, методом Рунге-Кутта. Ре-
зультатом решения этой системы дифференциальных уравнений будут зако-
ны движения q i ( t ) , q i ( t ) и q i ( t ) всех подвижных звеньев манипулятора по
обобщенным координатам.
100
 9.2. Решение примера динамического синтеза и анализа
манипулятора

Поясним решение задач динамики на примере простого манипулятора с

двумя степенями подвижности, работающего в ангулярной (угловой) системе
координат.
При динамическом анализе и синтезе данного манипулятора (рис.9.1)
будем считать известными кинематические размеры манипулятора (длина b1
звена 1; расстояния а1 и а2 до центров масс), моменты инерции J1, J2 и массы
m1, m2 звеньев.

Рисунок 9.1 – Манипулятор с двумя степенями подвижности

В соответствии с приведенным ранее алгоритмом расчета обобщенных

сил определим вначале кинетическую и потенциальную энергии подвижных
звеньев манипулятора.
Определим зависимости между абсолютными и обобщенными скоро-
стями манипулятора. Линейные скорости V1 и V2 центров масс звеньев 1 и 2
равны:

101
 V1  a1  q 1 ; V2  x 02
2
 y 02
2
,

где x 02 и y 02 - проекции скорости V2 на оси координат x0 и y0.

Так как
x 02  b1 cos q1  a 2 cosq1  q 2 
и
y 02  b1 sin q1  a 2 sin q1  q 2 ,
то:
x 02  b1q 1 sin q1  a 2 q 1  q 2 sin q1  q 2 ;
y 02  b1q 1 cos q1  a 2 q 1  q 2 cosq1  q 2 .
Тогда

V2  [b12 q 12 sin 2 q1  2b1a 2 q 1 q 1  q 2 sin q1 sin q1  q 2  

 a 22 q 1  q 2 2 sin 2 q1  q 2   b12 q 12 cos2 q1 
 2b1a 2 q 1 q 1  q 2  cos q1 cosq1  q 2   a 22 q 1  q 2 2 cos2 q1  q 2 ]0,5 
 [b12 q 12  a 22 q 1  q 2 2  2b1a 2 q 1 q 1  q 2  cos q 2 ]0,5 .
Определим полную кинетическую энергию манипулятора:

K  0,5[m1V12  J1q 12  m 2 V22  J 2 q 1  q 2 2 ]  0,5{m1a 12 q 12  J1q 12 

 m 2 [b12 q 12  a 22 q 1  q 2 2  2b1a 2 q 1 q 1  q 2  cos q 2 ]  J 2 q 1  q 2 2 }.
Перегруппируем слагаемые кинетической энергии по обобщенным скоро-
стям:

K  0,5J 1 (q 2 )q 12  J 12 (q 2 )q 1q 2  0,5J  2 q 2 q 2 2 ,

где: J 1  J1  J 2  m1a 12  m 2 (b12  a 22  2b1a 2 cos q 2 ) ;

J 12  J 2  m 2 a 22  m 2 b1a 2 cos q 2 ;

J  2  J 2  m 2 a 22 .
Определим полную потенциальную энергию манипулятора:
П  m1ga1 sin q1  m2g[b1 sin q1  a 2 sin(q1  q 2 )] ,
где g – ускорение свободного падения.

102
 Запишем уравнение Лагранжа 2-го рода для каждой степени подвижно-
сти рассматриваемого манипулятора:
d  L  L
   F1 ;
dt  q 1  q1
d  L  L
    F2 .
dt  q 2  q 2

Найдем выражение составляющих уравнений Лагранжа 2-го рода. Так

как потенциальная энергия манипулятора не зависит от обобщенных скоро-
стей, то:
L K
  J 1 (q 2 )q 1  J 12 (q 2 )q 2 ;
q 1 q 1
L K
  J 12 (q 2 )q 1  J  2 q 2 .
q 2 q 2

d  L  d  K  d
     J 1 (q 2 )q 1  J 12 (q 2 )q 1  
dt  q 1  dt  q 1  dt
 2m 2 b1a 2 q 1q 1 sin q 2  J 1q1  m 2 b1a 2 q 12 sin q 2  J 12 (q 2 )q 2 
 J 1q1  J 12 q 2  m 2 b1a 2 (2q 1q 1  q 12 ) sin q 2 ;

d  L  d  K  d
     J 12 (q 2 )q 1  J  2 q 2  
dt  q 2  dt  q 2  dt
 J 12 q1  J  2 q 2  m 2 b1a 2 q 1q 2 sin q 2 .
Из выражения для определения полной кинетической энергии манипу-
лятора видно, что кинетическая энергия манипулятора не зависит от обоб-
щенной координаты q1, поэтому
L (K  П)  (П)
   m1ga 1 cos q1 
q1 q1 q1
 m 2 g[b1 cos q1  a 2 cos(q1  q 2 )].
При выводе предыдущей формулы надо иметь в виду, что

sin(q1  q 2 )   sin q1 cos q 2  cos q1 sin q 2  
q1 q1
 cos q1 cos q 2  sin q1 sin q 2  cos(q1  q 2 ).
103
 Определим последнюю из составляющих уравнений Лагранжа 2-го рода.
L (K  П)
  m 2 b1a 2 q 1 sin q 2 
q 2 q 2
 m 2 b1a 2 q 1q 2 sin q 2  m 2 ga 2 cos(q1  q 2 ).
Собирая полученные выражения в зависимости, выражающие уравнение
Лагранжа 2-го рода, после некоторых преобразований, получим:

J 1q1  J 12 q 2  m 2 b1a 2 (2q 1q 2  q 12 ) sin q 2  m1ga 1 cos q1 

 m 2 g[b1 cos q1  a 2 cos(q1  q 2 )]  F1 ;

J 12 q1  J  2 q 2  m 2 a 2 [b1q 12 sin q 2  g cos(q1  q 2 )]  F2 .

При решении задач динамического анализа (прямая задача динамики)
эти уравнения следует, как отмечалось, рассматривать в качестве системы
дифференциальных уравнений и, интегрируя их численно, определять при
известных обобщенных силах F1 и F2 законы движения q1(t) и q2(t) по обоб-
щенным координатам и их первые и вторые производные q 1 ( t ) , q 2 ( t ) и
q1 ( t ) , q 2 ( t ) , являющиеся обобщенными скоростями и ускорениями.
Для решения задач динамического синтеза (обратная задача динамики)
достаточно по известным q1 ( t ) , q 2 ( t ) , q 1 ( t ) , q 2 ( t ) и q1 ( t ) , q 2 ( t ) и другим па-
раметрам прямым способом вычислить обобщенные силы F1 и F2 .
Рассчитав из каких-либо условий, например, из условия реализации за-
данной траектории путем решения обратной задачи кинематики законы q i (t),
q i (t) и q i (t), можно решить задачу динамического синтеза манипулятора, то
есть определить требуемые при известных массах и моментах инерции зве-
ньев силовые воздействия привода (рис.9.2) в функции времени Fi(t) по каж-
дой из степеней подвижности.

104
 Рисунок 9.2 – Пример графика функции Fi(t)

При проектировании манипуляционных систем промышленных роботов

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

Вопросы к лекции 9:
1. Поясните алгоритм решения задач динамики манипуляторов на ос-
нове уравнения Лагранжа 2-го ряда.
2. Поясните порядок решения примера динамического анализа и син-
теза двухзвенного шарнирного манипулятора.
105
 Лекция 10. Кинематика манипуляционных механизмов с
параллельной структурой. Решение обратной задачи

В последнее время все большее распространение получают, так называ-

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

Рисунок 10.1 – Обобщенная схема n-пода

106
 В манипуляторах с параллельной кинематикой неподвижное основание
А соединено с подвижной платформой В в общем случае несколькими (не
менее трех) стержнями переменной длины (рис. 10.1).
Концы стержней соединяются с неподвижной А и подвижной В плат-
формами в зависимости от принятой структуры механизма различными (ча-
сто сферическими) кинематическими парами.
При анализе и синтезе механизмов параллельной структуры различают
прямую и обратную задачи кинематики.
Прямая задача кинематики заключается в определении положения вы-
ходного звена (выходной платформы В) с закрепленным на нем предметом
манипулирования по известным длинам стержней (приводных звеньев). Ре-
шение этой задачи для механизмов с параллельной структурой является до-
статочно сложной. Необходимость в ней возникает в весьма редких случаях.
Наиболее содержательной, с нашей точки зрения, является обратная за-
дача кинематики манипуляторов с параллельной структурой (задача синтеза),
когда по заданному закону движения схвата, закрепленному на подвижной
платформе, требуется определить законы изменения длин приводных звень-
ев, являющихся обобщенными координатами qi (i=3,..., n; здесь: n – число
степеней подвижности – число приводных звеньев манипулятора). Именно
обратная задача кинематики должна быть решена для определения управля-
ющих воздействий на приводы входных звеньев-стержней АiBi с изменяю-
щейся длиной.
Решим обратную задачу кинематики для общего случая, т.е. для мани-
пулятора платформенного типа с любым наперед заданным числом n степе-
ней подвижности.
Введем две основные системы координат, а именно:
- O0X0Y0Z0 – систему координат, связанную со стойкой А и являющуюся
инерциальной системой координат;
- OСXСYСZС – систему координат, жестко связанную с подвижной плат-
формой В так, что ее начало расположено в центре (в характерной точке)
107
схвата ОС (в центре предмета манипулирования, измерительного инструмен-
та и т.п.). Оси координат этой системы в начальном положении параллельны
и однонаправленны с соответствующими осями координат системы
O0X0Y0Z0.
Положение схвата манипулятора в пространстве абсолютных координат
O0X0Y0Z0 задается как функция времени t координатами его (схвата) харак-
терной точки OС, а именно, координатами x0С(t); y0С(t); z0С(t).
Для задания ориентации схвата в пространстве абсолютных координат
будем использовать углы x0^zC(t), y0^zC(t) и x0^yC(t), определяющие соответ-
ственно положение оси ZС схвата относительно осей Х0 и Y0 и оси YС отно-
сительно оси Х0 основания (рис. 10.2).

Рисунок 10.2 – Задание ориентации схвата в инерциальном пространстве

углами x0^zC(t), y0^zC(t), x0^yC(t)

Для решения обратной задачи кинематики необходимо также задать в

неподвижной инерциальной системе координат O0X0Y0Z0 координаты xA1,
yA1, zA1;…; xAn, yAn, zAn центров А1,…, Аn сферических шарниров, соединяю-
108
щих приводные стержни со стойкой А, и координаты xB1, yB1, zB1;…; xBn, yBn,
zBn центров шарниров В1,…, Вn, соединяющих эти звенья с подвижной плат-
формой В, в системе координат подвижной платформы OСXСYСZС.
Таким образом, обобщенные координаты манипулятора можно предста-
вить в виде функции:
qi = qi(G; X(t)), (i=3,…, n)
где: G = (xA1, yA1, zA1;…; xAn, yAn, zAn; xB1, yB1, zB1;…; xBn, yBn, zBn) – вектор
назначаемых параметров, неизменяемых в ходе решения задачи; X(t)= (x0С(t);
y0С(t); z0С(t); x0^zC(t); y0^zC(t); x0^yC(t)) – вектор параметров, задающих требу-
емый закон движения схвата манипулятора в абсолютном пространстве.
Углы x0^zC(t), y0^zC(t) и x0^yC(t) являются, наряду с углами Эйлера,
наиболее естественным средством для однозначного задания ориентации
схвата в пространстве абсолютных координат (рис. 10.2), однако непосред-
ственное использование их для решения обратной задачи кинематики n-пода
затруднено. Решение этой задачи существенно упрощается, если воспользо-
ваться некоторыми виртуальными (мнимыми) поворотами.
Будем полагать, что заданная углами x0^zC(t), y0^zC(t) и x0^yC(t) ориен-
тация схвата и в целом подвижной платформы В обеспечивается за счет трех
виртуальных поворотов системы координат OСXСYСZС относительно осей
OСXС, OСYС и OСZС соответственно на углы x(t), y(t), z(t) в строго указан-
ной последовательности. Поворот на углы x(t), y(t) и z(t) должен происхо-
дить против часовой стрелки вокруг соответствующих осей координат.
Переход от углов x0^zC(t), y0^zC(t) и x0^yC(t), задающих положение схвата
и платформы в абсолютной системе координат O0X0Y0Z0, к виртуальным
углам поворота x(t), y(t), z(t) позволяет корректным образом использовать
матричный аппарат вычислений для решения обратной задачи кинематики
манипуляторов платформенного типа.
Как известно, направляющие косинусы углов x0^zC(t), y0^zC(t) и x0^yC(t)
являются наддиагональными элементами блочной матрицы поворота 3*3 в
результирующей матрице преобразования координат 4*4 (соответственно
109
первыми и вторыми элементами третьего столбца и первым элементом вто-
рого столбца).
Получим для принятой нами последовательности виртуальных поворо-
тов системы OСXСYСZС на углы x(t), y(t) и z(t) необходимые наддиаго-
нальные элементы путем перемножения соответствующих матриц поворота
3*3 m01, m12 и m23, а именно:
m 03  m 01  m12  m 23 
C y  C z - C y  S z S y
,
 C x  S z  C z  S x  S y C x  C z - S x  S y  S z - C y  S x
S x  S z - C x  C z  S y C z  S x  C x  S y  S z C x  C y

где:
1 0 0 C y 0 S y
m 01  0 C x - S x ; m12  0 1 0 ;
0 S x C x - S y 0 C y

C z - S z 0
m 23  S z C z 0.
0 0 1
(Символы С и S в матрицах означают тригонометрические функции со-
ответственно «cosinus» и «sinus»).
Сопоставив наддиагональные элементы матрицы поворота m03 (первый
и второй элементы третьего столбца и первый элемент второго столбца) с со-
ответствующими элементами блочной матрицы 3*3, рассчитаем требуемые
для обеспечения заданной ориентации схвата значения виртуальных углов
поворота x(t), y(t) и z(t) как функций углов x0^zC(t), y0^zC(t) и x0^yC(t):
 y (t)  asin cosx 0 ^ z C (t );

 - cosy 0 ^ z C ( t )    - cosx 0 ^ y C ( t )  
 x (t)  asin  ;  z (t)  asin  .
 cos  ( t )   cos  ( t ) 
 y   y 

110
 Понятно, что при движении центра схвата OС в соответствии с заданны-
ми законами x0С(t); y0С(t); z0С(t) и ориентацией платформы, выраженной те-
перь углами x(t), y(t), z(t), положения точек центров шарниров В1,…, Вn
будут в разные моменты времени различными в инерциальной системе коор-
динат.
Решение обратной задачи кинематики параллельных манипуляторов за-
ключается, по сути, в определении расстояний А1В1,…, АnВn между центрами
шарниров соответствующих приводных стержней в функции времени, то
есть:

q i (t)  A i Bi (t)  x Ai  
2
 
2
2
 x 0Bi (t)  y Ai  y 0Bi (t)  z Ai  z 0Bi (t) ,
(i=3,…, n) (10.1)
где: x 0Bi (t) , y 0Bi (t) , z 0Bi (t) – координаты точки Вi в инерциальной системе
координат.
Определим координаты точек В1,..., Вi,..., Вn в инерциальной системе
координат O0X0Y0Z0. Для этого расположим в каждой точке Вi подвижной
платформы дополнительные системы координат BiXiYiZi (i=3,..., n), парал-
лельные и однонаправленные по отношению к системе OСXСYСZС (рис.10.1).
Переходя к однородным координатам xi, yi, zi, 1 точек Вi (i=3,…, n),
можно произвести пересчет этих координат в систему координат O0X0Y0Z0
путем перемножения пяти матриц:
w0i=w00w01w12w23w3i,
где:
a 11 a 12 a 13 x Bi (t)
a 21 a 22 a 23 y Bi (t)
w 0i  
a 31 a 32 a 33 z Bi (t)
0 0 0 1
– результирующая матрица перехода от системы координат BiXiYiZi к
системе координат O0X0Y0Z0 для точки Вi (i=3,…, n); a11,…,a33 – направля-
ющие косинусы матрицы w0i (при решении данной задачи не используются);
111
 1 0 0 x 0C (t)
0 1 0 y 0C (t)
w 00  
0 0 1 z 0C (t)
0 0 0 1
– матрица перехода от характерной точки схвата OС (центра схвата) к
инерциальной системе координат O0X0Y0Z0 (напомним, что координаты цен-
тра схвата x0С(t), y0С(t), z0С(t) являются заданными по условию задачи);
1 0 0 0
0 C x (t) - S x (t) 0
w 01  
0 S x (t) C x (t) 0
0 0 0 1
– матрица поворота системы OСXСYСZС вокруг оси OСXС на виртуаль-
ный угол x(t);
C y (t) 0 S y (t) 0
0 1 0 0
w 12  
- S y (t) 0 C y (t) 0
0 0 0 1
– матрица поворота системы OСXСYСZС вокруг оси OСYС на виртуаль-
ный угол y(t);
C z (t) - S z (t) 0 0
S z (t) C z (t) 0 0
w 23  
0 0 1 0
0 0 0 1
– матрица поворота системы OСXСYСZС вокруг оси OСZС на виртуаль-
ный угол z(t);
1 0 0 x Bi
0 1 0 y Bi
w 3i  
0 0 1 z Bi
0 0 0 1
–матрица перехода от системы координат BiXiYiZi к системе координат
OСXСYСZС (i = 3,…, n).
112
 Понятно, что первые три элемента четвертого столбца матрицы w0i и
являются искомыми координатами x 0Bi , y 0Bi , z 0Bi (i = 3,…, n) центров шарни-
ров Вi подвижной платформы в инерциальной системе координат. После
определения координат центров шарниров Bi в системе O0X0Y0Z0 обобщен-
ные координаты qi(t) определяются по формуле (10.1).
Рассмотренный метод виртуальных поворотов позволяет за счет перехо-
да к матричному исчислению существенным образом упростить решение об-
ратной задачи кинематики манипуляторов платформенного типа и дает воз-
можность при разработке программного обеспечения использовать типовые
алгоритмы.

Вопросы к лекции 10:

1. Каковы особенности манипуляторов с параллельной кинематикой?
2. Каков порядок назначения систем координат, связанных со схватом и
неподвижной платформой?
3. Каким образом реализуются степени подвижности в манипуляторах с
параллельной кинематикой?
4. Поясните кинематический смысл каждой из пяти матриц перехода,
используемых для расчета центров шарниров подвижной платформы.

113
 Раздел 3. Робототехнические комплексы

Лекция 11. Назначение, состав и классификация робототехнических

комплексов

11.1. Назначение робототехнических комплексов

Вся деятельность человека, в конечном счете, направлена на удовлетво-

рение потребностей, которая в нашем случае сводится к обеспечению выпус-
ка на промышленном предприятии предметов потребления.
В общем случае мы должны при этом знать ответы на три вопроса:
1. Что изготавливать (т.е. что делать, что найдет (может найти) рынок сбы-
та).
2. Сколько изготавливать (программа выпуска) по количеству, по сроку и по
длительности изготовления.
3. Как изготавливать (каким образом, какими силами и средствами).
Ответ на 1-й вопрос регламентирует предмет выпуска.
Ответ на 2-й вопрос определяет программу выпуска и срок изготовления
изделий, то есть в конечном счете, стабильность или наоборот неустойчи-
вость, гибкость производства. Или как принято говорить – тип производства:
единичный, серийный, массовый.
Ответы на 1-й и 2-й вопросы выходит за рамки данного курса и опреде-
ляется состоянием соответствующего сегмента рынка. Далее будем иметь в
виду изделия машиностроительного профиля, считая, что задание на их изго-
товление формируется некоторыми директивными органами планового или
маркетингового характера.
Ответ на 3-й вопрос находится в нашей компетенции. В укрупнен-
ном виде с точки зрения степени автоматизации на него можно ответить так.
Изготовление может быть: ручным, механизированным, автоматизиро-
ванным и автоматическим.
114
 Рисунок 11.1 – Обобщенная схема промышленного производства

Напомним содержание понятий механизация и автоматизация.

Механизация – освобождение человека от участия в энергетическом по-
токе обработки изделий.
Автоматизация – освобождение человека от участия в энергетическом и
информационном потоках обработки изделий.
Каждый из типов производства может выполняться с любой степенью
автоматизации.
Полярными можно считать: единичное, ручное производство и массовое
автоматическое производство на автоматических станках и линиях с жесткой
программой работы.
При единичным ручном производстве применяют универсальные метал-
лообрабатывающие станки с обслуживающим их станочником высокой
квалификации или универсальные станки с ЧПУ по принципу: сколько стан-

115
ков - столько рабочих. Для этого типа производства характерна большая уни-
версальность, но низкая производительность. Такое производство сейчас ис-
пользуется в ремонтных организациях, при выпуске исследовательского уни-
кального оборудования.
Массовое автоматическое производство на жестких автоматических ли-
ниях и на станках-автоматах обеспечивает безлюдное высокопроизводитель-
ное производство, однако является специальным и не может быть использо-
вано при смене продукции. Такое производство широко используется,
например, в подшипниковой промышленности.
В общем объеме промышленного производства единичное и массовое
производство занимают около 20%. Остальные 80% занимает серийное про-
изводство, когда в год на той или иной единице оборудования выпускают от
2 до 100 - 200 наименований партиями в 20 - 200 штук.
Именно серийное производство (крупносерийное, среднесерийное и
мелкосерийное) и является экономически наиболее выгодной сферой приме-
нения гибких автоматизированных производств (ГАП) и их основной состав-
ляющей – роботизированных технологических комплексов.
Понятно, что серийное производство не является единственным типом
производства, в котором целесообразно использовать робототехнические
комплексы (РК): они используются в массовом, а иногда и в единичном про-
изводствах.
Рассмотрим место применения РК и выполняемые ими функции при
различных уровнях автоматизации.
Необходимо отметить, что автоматизация технологических процессов
имеет целью улучшение экономических и социальных факторов.
Экономические факторы автоматизации: увеличение производительно-
сти труда; повышение качества продукции; снижение себестоимости изго-
товления.
Социальные факторы: улучшение условий труда и безопасности челове-
ка, практически почти полное исключение его из производственного процес-
116
са и сведение его роли к наладке оборудования и к наблюдению за его рабо-
той.
В классическом варианте повышение уровня автоматизации решало все
вышеуказанные задачи, но резко снижалась универсальность автоматических
производств, что и привело к необходимости создания гибких автоматизиро-
ванных производств.
В процессе развития средств автоматизации на автоматический режим
выполнения переводились различные этапы и операции технологических
процессов.
Первый уровень автоматизации - это автоматизация цикла обработки.
Он сводится к автоматическому управлению последовательностью и харак-
тером движений рабочего инструмента в целях получения заданной формы,
размеров и качества поверхности обрабатываемой детали.
Наиболее полное воплощение автоматизация этого уровня нашла в стан-
ках с ЧПУ. При этом обеспечивается возможность осуществлять управление
практически для неограниченной номенклатуры деталей, то есть такие стан-
ки фактически являются универсальными с автоматической обработкой де-
талей.
Применение таких станков повышает производительность труда в 2-4
раза. Существенно повышается также качество продукции. Загрузка – раз-
грузка таких станков, однако, производится вручную, и они относятся к кате-
гории станков – полуавтоматов.
Второй уровень автоматизации - это автоматизация загрузки – разгрузки
станков-автоматов, в том числе и станков с ЧПУ. Наибольшей универсально-
стью и быстротой переналадки обладают промышленные роботы (ПР), ис-
пользуемые в качестве загрузочно – разгрузочных устройств.
По мере снижения требований к быстроте переналадки загрузочных
устройств и увеличения размера партии обрабатываемых деталей упрощают-
ся средства загрузки - разгрузки деталей в рабочую зону основного техноло-

117
гического оборудования (ОТО). На многоцелевых обрабатывающих центрах
такими средствами часто служат автооператоры.
Второй уровень автоматизации обеспечивается с помощью роботизиро-
ванных технологических комплексов (РТК), в которых ПР обслуживает еди-
ницы или группу ОТО.
Третий уровень автоматизации - автоматизация контроля обрабатывае-
мых деталей, состояния инструмента, состояния станков, а также контроля и
подналадки технологического процесса.
При таком типе автоматизации возможна длительная работа оборудова-
ния (в течение одной - двух смен) без участия человека.
Третий уровень автоматизации обеспечивается созданием адаптивных
РК, а также гибких производственных модулей, представляющий собой ком-
плекс, состоящий из многооперационного станка (обрабатывающего центра),
устройств приема и перемещения спутников (паллет), ПР (или автооперато-
ров), устройств контроля, диагностирования и других вспомогательных ме-
ханизмов и устройств, управляемых от общей системы автоматизированного
управления.
Четвертый уровень автоматизации - автоматическая переналадка обору-
дования с выпуска одного изделия на другое.
На существующем оборудовании переналадка пока осуществляется
вручную и занимает значительную часть календарного времени (от несколь-
ких часов до целой смены и больше). То есть этот этап производства до
настоящего времени не автоматизирован и является слабым звеном в цепи
средств автоматизации (автоматизированного производства).
Пятый уровень автоматизации - гибкие производственные системы
(ГПС), представляющие собой совокупность в различных сочетаниях обору-
дования с ЧПУ, РТК, гибкие производственные модули (ГПМ), отдельных
единиц ОТО и систем обеспечения их функционирования в автоматическом
режиме в течение заданного интервала времени и обладающие свойством ав-

118
томатизированной переналадки при производстве изделий произвольной но-
менклатуры в установленных пределах их характеристик.
При быстрой переналадке ГПС с выпуска одного изделия на другое (пе-
реналадка вспомогательного технологического оборудования (ВТО), инстру-
мента, замена управляющей программ) они должны обеспечивать производи-
тельность, близкую к той, что обеспечивается в современном массовом про-
изводстве при изготовлении деталей одного наименования.
Необходимо отметить, что повышение уровня автоматизации техноло-
гического оборудования (ТО) тесно связано с ростом уровня организации
всего производства на данном предприятии.
Изолированный станок с ЧПУ, ПР, ГПМ или РТК при одиночном ис-
пользовании на предприятии, где не применяется в достаточно широких
масштабах такое оборудование, не эффективен, так как в таких случаях, как
правило, вся организация производства на таком предприятии не соответ-
ствует требованиям, предъявляемым новой высокопроизводительной и нуж-
дающейся в высококвалифицированном обслуживании техникой.
Таким образом, наиболее приемлемыми уровнями автоматизации, обес-
печиваемыми непосредственно РТК, являются 2-й и 3-й.

11.2. Состав и классификация робототехнических комплексов

Робототехнический комплекс - это автономно действующая сово-

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

119
  по функциональному признаку,
 по области применения,
 по структурному признаку,
 по компоновочному признаку,
 по типу производственного подразделения.
По функциональному признаку различают роботизированный техно-
логический комплекс (РТК) и роботизированный производственный ком-
плекс (РПК).
Роботизированный технологический комплекс – это автономно дей-
ствующая совокупность технологических средств производства, включаю-
щая единицу или группу технологического полуавтоматического оборудова-
ния, взаимодействующего с одним или несколькими ПР и набор вспомога-
тельного оборудования, обеспечивающая полностью автоматический цикл
работы внутри комплекса и его связь с входными и выходными потоками
остального производства.
Роботизированный производственный комплекс - это автономно дей-
ствующая совокупность технологических средств производства, включаю-
щая как минимум один промышленный робот, выполняющий основные опе-
рации технологического процесса (сборку, сварку, окраску и т. п.) и набор
вспомогательного оборудования, обеспечивающая полностью автоматиче-
ский цикл выполнения технологических операций внутри комплекса и его
связь с входными и выходными потоками остального производства. При этом
автоматизация вспомогательных операций внутри комплекса может выпол-
няться с помощью других ПР.
По области применения различают роботизированные комплексы: ме-
ханообработки; холодной штамповки; ковки; литья; прессования пластмасс;
термической обработки и гальванопокрытий; сварки; окраски; транспортиро-
вания; контроля и испытаний; сборки.
По структурному признаку различают:

120
  однопозиционные РТК, включающие один ПР в комплекте с едини-
цей технологического оборудования станок - робот, пресс – робот, то есть
"оборудование - робот" (рис. 11.2).
 групповые РТК, включающие один ПР, обслуживающий группу од-
нотипного или разнотипного технологического оборудования (рис. 11.3);

Рисунок 11.2 – Однопозиционные РТК

Рисунок 11.3 – Групповые РТК

 многопозиционные РК (роботизированные центры РТЦ или РПУ),

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

121
 Рисунок 11.4 – Многопозиционные РТК

По компоновочному признаку различают 6 типовых схем. Тип компо-

новки комплекса зависит от конструктивно - кинематического исполнения ПР,
а именно: от типа основных (переносных) координатных перемещений ПР,
определяющих характер его рабочей зоны, а также от схемы расположения тех-
нологического оборудования.
1-я компоновочная схема РТК (рис. 11.5) – включает комплексы, характе-
ризующиеся линейным расположением ОТО и ВТО. Такой тип компоновки
создается на основе ПР, работающих в плоской прямоугольной системе
координат, он применяется в основном в механообрабатывающем производстве
для однопозиционных комплексов «станок - робот».

Рисунок 11.5 – Первая компоновочная схема РТК

2-я компоновочная схема РТК (рис. 11.6) характеризует линейно – парал-

лельным расположением ОТО и ВТО. Она создается на базе ПР тельферного
(портального) типа с плечелоктевой конструкцией манипулятора. Применя-
ется в основном в механообработке для комплексов группового типа (до 6-ти
станков).
122
 Рисунок 11.6 – Вторая компоновочная схема РТК

3-я компоновочная схема РТК включает комплексы (рис. 11.7), созданные

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

Рисунок 11.7 – Третья компоновочная схема РТК

4-я компоновочная схема РТК (рис. 11.8) создается на базе ПР, работаю-
щих в цилиндрической системе координат с вертикальной осью вращения, и ха-
рактеризуется круговым расположением ОТО и ВТО. Применяется в основном в
кузнечнопрессовом производстве при создании технологических комплексов
«пресс - робот», а также в механообработке при создании групповых комплексов
«группа станков - робот» (до 3-х станков).

123
 Рисунок 11.8 – Четвертая компоновочная схема РТК

5 - я компоновочная схема РТК (рис. 11.9) создается на базе ПР, работаю-

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

Рисунок 11.9 – Пятая компоновочная схема РТК

6 - я компоновочная схема РТК - смешанная. Используется при созда-

нии многопозиционных комплексов литейного, сборочного, иногда кузнечно-
прессового производства. В таких комплексах применяются, как правило, не-
сколько ПР с различными конструктивно - компоновочными исполнениями.
По типу производительного подразделения различают:
 роботизированные технологические ячейки (РТЯ);
124
  роботизированные технологические участки (РТУ);
 роботизированные технологические цеха (РТЦ).
Здесь классификационным признаком служит количество выполняе-
мых в РК технологических операций.
РТЯ – в ней выполняется одна основная технологическая операция. Количе-
ство единиц ТО и ПР в составе РТЯ не регламентируется. В РТЯ может совсем
отсутствовать ТО, когда основную технологическую операцию выполняет
непосредственно ПР, или, наоборот, могут отсутствовать как самостоя-
тельные ПР, когда они конструктивно объединены с ТО.
РТУ – здесь выполняются несколько основных технологических опера-
ций, которые объединены технологически, конструктивно (оборудованием)
или организационно (управлением). Операции могут быть одинаковыми или
разными.
РТЛ – это разновидность РТУ, в которой разные операции связаны друг с
другом технологически.
В РТУ операции могут быть объединены по различным признакам,
например, по принадлежности к одному виду технологического процесса, по
выполнению на однотипном оборудовании и т.д.
РТУ не есть простое соединение РТЯ и может не иметь их совсем, как
обособленных структурных единиц. Например, РТУ может включать несколь-
ко единиц ТО, обслуживаемых одним ПР. В простейших РТУ может быть
несколько ПР, последовательно выполняющих основные операции, например,
сборку одного изделия.
Развитые РТУ содержат несколько единиц ТО и несколько единиц ПР.
РТЦ – это РТК, состоящий из нескольких РТУ, объединенных транспортной
системой, межцеховым автоматизированным складом, системой управления и
календарного планирования. Кроме того, РТУ оснащаются системами контроля
качества продукции.

125
 Вопросы к лекции 11:
1. Каково назначение робототехнических комплексов в промышленно-
сти?
2. Каковы уровни автоматизации машиностроительного производства?
3. Какие уровни автоматизации целесообразно обеспечивать на основе
использования робототехнических комплексов?
4. Поясните понятие робототехнический комплекс.
5. Приведите классификацию РК по функциональному признаку.
6. Приведите классификацию РК по области применения.
7. Приведите классификацию РК по структурному признаку.
8. Приведите классификацию РК по компоновочному признаку.
9. Приведите классификацию РК по типу производственного подразде-
ления.

Лекция 12. Компоновка РТК и возможные траектории схвата

манипулятора

12.1. Компоновочные схемы РТК

Компоновка РТК и состав его оборудования являются наиболее

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

126
 1.1. ПР из входного накопителя подает заготовки в штамп (рис. 12.1а), а
после изготовления детали она сдувается сжатым воздухом, сталкивается
дополнительным приспособлением или забирается другим роботом.
1.2. Робот снимает деталь после обработки на токарном станке при ис-
пользовании в качестве заготовки пруткового материала.

а) б)
Рисунок 12.1 – РТК с объединенным входом и выходом

1.3. Робот забирает заготовку с тактового стола, ставит ее в приспо-

собление станка, а на освободившееся место кладет деталь, вынесенную при
обратном движении из зоны станка (рис. 12.1б).
В этом случае траектории схвата в прямом и обратном направлениях
совпадают.
2. Робот обслуживает РТК, в котором входной и выходной накопители
(или позиции захвата заготовки и разгрузки детали) расположены на
небольшом расстоянии друг от друга.
Примеры:
2.1. Заготовка берется с одного транспортера, а деталь укладывается
на другой, расположенный рядом (рис. 12.2 а). Ситуация вызвана тем, что
деталь после существенного изменения ее формы в процессе обработки или с
целью сохранения чистоты обработки поверхности не может быть уложена в
транспортер заготовок.

127
 2.2. Робот с одним схватом (рис. 12.2 б) приносит из ячейки кассеты
заготовки на столик у рабочей зоны станка, берет деталь в станке, ставит ее
на столик рядом с заготовкой, загружает станок заготовкой, берет деталь и
транспортирует ее в освободившуюся ячейку. В такой производственной
ситуации траектории прямого и обратного перемещения близки друг к другу
и могут быть приняты одинаковыми на значительном протяжении с
различием в непосредственной близости от соответствующего оборудования.
3. Робот обслуживает РТК, в котором по условиям общей компоновки
ГПС и планирования транспортных путей в цехе входные и выходные
позиции разнесены на значительные расстояния (рис. 12.3). Обычно такая
производственная ситуация возникает при обслуживании роботом
нескольких единиц технологического оборудования (от 2-х до 6-ти),
расположенных в последовательности технологического процесса.

а) б)
Рисунок 12.2 – РТК с близко расположенными входными и выходными
накопителями

128
 Рисунок 12.3 – РТК с удаленными входными и выходными накопителями

Многостаночное обслуживание роботом обычно используется при

значительной продолжительности технологических операций, например, при
механообработке на токарных или фрезерных станках.
Это наиболее типичный случай, включающий в себя как частные два
предыдущих. Именно в таких производственных сценах РТК вопрос
планирования траекторий является наиболее содержательным.
Заметим, что в РПК, когда робот является основным технологическим
оборудованием (сварка, окраска и т. д.), возникают производственные
ситуации либо аналогичные рассмотренным, либо траектория полностью
диктуется технологическим процессом, как, например, это имеет место при
заданной конфигурации сварочного шва, или когда заготовку, заданной
формы следует вырезать из листового материала. В последних случаях
траектория не подлежит планированию, а задача сводится к обеспечению
наиболее точного воспроизведения заданной траектории за счет определения
требуемых законов изменения обобщенных координат методами решения
обратной задачи кинематики. В дальнейшем будем рассматривать 3-ий тип
производственной сцены, к которому могут быть сведены многие другие, за
исключением случаев, когда траектория и ориентация схвата строго заданы
на всем протяжении.
Заметим, что оборудование с целью сокращения времени и затрат на
транспортирование деталей роботом должно устанавливаться на минимально

129
возможном расстоянии, с расположением мест обслуживания по
возможности на одном уровне и на одной прямой или на одной дуге
окружности (рис. 12.4).

Рисунок 12.4 – Рекомендуемые схемы расположения оборудования в РТК

12.2. Анализ местных (частных) траекторий схвата манипуляторов

Планирование траекторий движения схвата начинается с анализа

местных траекторий манипулятора, то есть траекторий перемещения схвата
вблизи рабочей зоны определенного оборудования или соседнего
оборудования. На местной траектории манипулирования выделяют
следующие характерные участки:
1. Сопряжение схвата с изделием и съем схвата с изделия;
2. Установка и съем изделия с оборудования;
3. Вход и выход схвата из рабочей зоны ТО;
4. Перемещение схвата от одного оборудования к другому: подход,
уход, движение мимо оборудования;
5. Перемещения, связанные со сменой схвата;
Некоторые участки в реальном РТК могут отсутствовать.
При рассмотрении производственных сцен РТК используют системы
координат, связанные с технологическим оборудованием и с промышленным
роботом (рис. 12.5).

130
 Рисунок 12.5 – Системы координат ТО и ПР

Ось ZТО технологического оборудования направляется вверх, ось ХТО –

по направлению к лицевой стороне ТО, тогда ось YТО ориентируется по
направлению от j-го оборудования к (j+1)-му (слева направо) по
направлению технологического процесса. Инерциальная система координат
робота OpXpYpZp связывается с неподвижным звеном 0 робота и
ориентируется по ранее изложенным правилам.
Рекомендуется четыре варианта расположения ТО в системе координат
робота, при которых углы между осями ОТОХТО и ОРХР составляют 0º, 90º,
180º и 270º. Это наиболее естественное расположение, обеспечивающее,
кроме того, определенную простоту пересчета координат. Однако при
необходимости эти системы координат могут располагаться произвольно по
отношению друг к другу.
1. Сопряжение схвата с изделием и съем схвата с изделия.
По характеру движения относительно изделия схваты делят на два вида:
Боковые: схват снимается с изделия или одевается на него
перпендикулярно направлению съема изделия с оборудования (рис. 12.6а).
131
Такие схваты используются чаще, т.к. они позволяют совместить движение
съема схвата с изделия с движением выхода из рабочей зоны.
Торцевые: схват снимается с изделия в том же направлении, что и само
изделие с оборудования (рис. 12.6 б). Такие схваты применяют, когда захват
деталей за боковые поверхности невозможен из-за их малых размеров,
неудобной формы или препятствия со стороны ТО, а также при захвате за
внутренние поверхности детали.

а) б)
Рисунок 12.6 – Боковые (а) и торцевые (б) схваты

2. Установка и съем изделия с оборудования.

Для большинства типов технологического оборудования характерны три
вида ориентации траектории схвата при установке и съеме изделия на/с
оборудование:
 по оси Xто: печи, окрасочные камеры, прессы горячей штамповки и
т.д;
 по оси Yто: токарные станки;
 по оси Zто: вертикально-фрезерные, плоскошлифовальные,
зубофрезерные станки, операции укладки изделий в тару, магазины,
загрузочные устройства.

132
 Ориентация траекторий съема – установки схвата с/на изделия могут
быть и более разнообразными: в зоне положительных и отрицательных
значений осей Xj и Yj, но всегда в положительной части оси Zj.
3. Ориентация траектории выхода/входа схвата из рабочей зоны.
Ориентация траектории выхода/входа схвата из рабочей зоны может
быть по всем трем осям:
 выход/вход по оси Xто является наиболее естественным, так как такое

направление совпадает с направлением движения, выполняемым оператором

при неавтоматизированном обслуживании. Однако при этом зона оператора
оказывается занятой.
 выход/вход по оси Yто, а также в отрицательном направлении осей Xj

и Yj осуществляется реже, т.к. конструкцией оборудования, как правило, не

предусмотрено его обслуживание с этих сторон. К преимуществам выхода по
оси Yj и в отрицательном направлении оси Xj относится свободный подход
оператора к рабочей зоне оборудования для его настройки, а также при
загрузке – разгрузке вручную при отказе робота.
 выход/вход по оси Zто применяется при подвесной установке робота

на портале. При напольной установке ПР такой выход может оказаться

целесообразным из-за возможного сокращения траекторий, поскольку в этом
направлении размеры препятствий обычно невелики.
 выход/вход в произвольном направлении, несовпадающим с
координатными осями используется при обслуживании ТО несколькими ПР,
при применении двуруких роботов, роботов со сферической или сложной
полярной системой координат, при малых размерах ПР по сравнению с
обслуживаемым ТО. Обычно в этом случае отклонение этих траекторий от
естественных осей оборудования незначительно и на первых этапах
проектирования такой выход или вход можно считать совпадающим с осями
координат ТО.
4. Ориентация траекторий движения схвата от предыдущего
оборудования к следующему.
133
 Ориентация траекторий движения схвата от предыдущего оборудования
к следующему по техпроцессу осуществляется в общем случае по всем
направлениям: при напольной установке ПР чаще используются
перемещения по четырем направлениям: в положительном и отрицательном
направлениях осей Xj и Yj, т.е. уход и подход от одного ТО к другому обычно
в таком случае осуществляется в горизонтальной плоскости; при портальной
компоновке ПР чаще перемещение ухода – подхода выполняются в
вертикальной плоскости – в положительном и отрицательном направлениях
оси Zj.
Ориентация движения схвата между оборудованием однозначно
определяет ориентацию переносных степеней подвижности ПР, которые
выполняют это движение, а следовательно, и ориентацию робота
относительно технологического оборудования, то есть ориентацию
инерциальной системы координат робота относительно системы координат
оборудования.
Как правило, те оси неподвижной системы координат ПР, которые
оказываются в горизонтальной плоскости, располагаются либо
перпендикулярно либо параллельно оси Xj оборудования, то есть под углами
00, 900, 1800 или 2700.
При проектировании РТК целесообразно рассматривать различные ва-
рианты местных траекторий и выбирать наиболее оптимальные по ряду кри-
териев, например, по протяженности траектории, по величине перемещений
по обобщенным координатам, по времени перемещения, по числу степеней
подвижности, участвующих в реализации данной траектории, по удобству
обслуживания оборудования оператором и наладчиком и так далее.
5. Перемещения, связанные со сменой схвата, определяются, в основ-
ном, компоновкой рабочей сцены РТК с учетом его производственного
назначения.

134
 Вопросы к лекции 12:
1. Приведите основные типы производственных ситуаций.
2. Какие частные траектории движения схвата можно выделить при об-
служивании роботом технологического оборудования?
3. Какие варианты расположения оборудования рекомендуются в РТК?
4. Каковы характерные виды ориентации траектории схвата при уста-
новке и съеме изделия на/с оборудования?

Лекция 13. Использование нескольких роботов в одном РТК.

Межстаночные траектории схватов

13.1. Особенности использования нескольких роботов в одном РТК

Два и более ПР используются в одном РТК в следующих случаях:

1. Один робот не успевает обслуживать оборудование за требуемое
время, т.е. ПР не укладывается в заданный такт выпуска деталей.
2. Один ПР не может обеспечить съем и транспортировку детали,
например, длинный вал, крыло самолета, корпусные кольца турбин и т.д.
3. Величины ходов одного ПР не достаточно для обслуживания всего
РТК, а модернизация ПР с целью увеличения его зоны обслуживания
нецелесообразна.
Возможны различные стратегии обслуживания ТО роботами:
 каждый из роботов может обслуживать по мере необходимости
любое оборудование. Это наиболее гибкая стратегия, но реализация
достаточно сложна и на конструктивно – компоновочном и на программно –
алгоритмическом уровнях.

135
  обычно на практике используют более простые РТК, в которых все
оборудование разбивается на несколько групп так, что каждую из групп
может обслуживать один робот. При такой организации РТК передача
изделия между участками может осуществляться следующим образом:
1. Непосредственно из схвата одного ПР в схват другого.
2. Через технологическое оборудование: один робот транспортирует
изделие на технологическое оборудование – другой от технологического
оборудования.
3. На дополнительной позиции передачи.
Первый способ используется редко, так как требует достаточно точного
взаимного позиционирования схватов роботов и кроме того при этом должен
быть обеспечен захват за различные поверхности изделия, что не всегда
возможно.
Второй способ используется чаще других. При этом загрузка ТО
производится одним ПР, а разгрузка – другим с последующей загрузкой этим
роботом (j+1)-го оборудования (рис. 13.1).

Рисунок 13.1 – РТК с транспортированием изделия через оборудование

Третий способ используется при особо больших расстояниях между ТО

(рис. 13.2), а также в случае, если изделие при передаче с одного ТО на
другое должно изменить ориентацию (поворот, кантование, смена
технологических баз и т.д.).

136
 Рисунок 13.2 – РТК с дополнительной позицией передачи

Время обработки изделия на различном ТО обычно различается друг от

друга. Из-за этого могут возникать простои как ТО, так и ПР. При простоях
ПР он должен находиться некоторое время в позиции ожидания конца
обработки изделия. При планировании траекторий нескольких ПР в
пространстве и во времени следует максимально синхронизировать их
работу, ориентируясь на более длительную технологическую операцию. В
некоторых случаях это позволяет либо заметно сократить число ПР, либо
организовать их синхронную работу по единой управляющей программе
(рис. 13.3). Возможна также механическая синхронизация, когда руки ПР
монтируются как единое целое, либо жестко соединяются друг с другом (рис.
13.4).

Рисунок 13.3 – Синхронная работа роботов

137
 Рисунок 13.4 – Механическая синхронизация манипуляторов

13.2. Межстанционные траектории как функции числа схватов и

организации производственной сцены

При многостаночном обслуживании наиболее часто в РТК возникают

следующие производственные сцены:
1. Промышленный робот оснащен одним схватом.
2. ПР оснащен одним схватом; в составе РТК имеются позиции
промежуточного хранения предмета манипулирования.
3. ПР оснащен двумя схватами, закрепленными на одной руке.
Первый случай. В этом случае цикл начинается с разгрузки последнего
по технологическому процессу оборудования с тем, чтобы обеспечить
возможность разгрузки, предшествующего ТО, т.е. обслуживание ТО идет в
последовательности обратной последовательности технологического
процесса (рис. 13.5).

138
 Рисунок 13.5 – Обслуживание ТО роботом с одним схватом:

– разгрузка, – загрузка

Приведенный рисунок, выполненный в соответствии с компоновкой

РТК и в масштабе, дает возможность представить достаточно точно
требуемую траекторию схвата. Однако временное представление здесь
затруднено.
Наглядное представление о последовательности работы ПР во времени
дает диаграмма перемещений схвата, которая является граф–схемой
переходов, вершины которой соответствуют выделенным (учитываемым)
состояниям РТК (рис. 13.6). При этом используются “распрямленные”
траектории, т.е. условные плоские траектории, длина которых равна длине
действительных траекторий.

139
 Рисунок 13.6 – Граф-схема перемещений предмета манипулирования по
«распрямленной» траектории при наличии одного схвата

На рисунке 13.6 использованы следующие условные обозначения:

- движение схвата с изделием (с заготовкой или деталью);

- движение пустого схвата;
- время ожидания робота (простой);
- работа робота в рабочей зоне ТО;
- время работы ТО.

Работа РТК по возможности должна быть организована так, чтобы к

моменту подхода схвата к рабочей зоне ТО оно заканчивало обработку и при
необходимости останавливалось. В первом случае простой оборудования
неоправданно велик.

140
 Второй случай. В этом случае, когда имеется позиция промежуточного
хранения (рис. 13.7), общая длина траектории существенно меньше (рис.
13.8), а, следовательно, меньше время на обслуживание ТО и в целом время
цикла. Здесь заметно сокращается время простоя технологического
оборудования (рис.13.8).

Рисунок 13.7 – РТК с позициями промежуточного хранения

Рисунок 13.8 – Граф-схема «распрямленной» траектории в РТК с

позицией промежуточного хранения
141
 Третий случай. Такую организацию производственной сцены (рис.
13.9) можно отнести к наиболее оптимальному варианту, так как длина тра-
ектории схватов сведена к минимуму (рис. 13.10). Смена заготовки на деталь
в схвате и детали на заготовку в станке происходит непосредственно в рабо-
чей зоне станка.

Рисунок 13.9 – Обслуживание ТО роботом с двумя схватами

Рисунок 13.10 – Граф-схема «распрямленной» траектории для робота с двумя

схватами

142
 Вопросы к лекции 13:
1. Каковы особенности использования нескольких роботов в одном
АТК?
2. Каковы наиболее распространенные производственные сцены при
многостаночном обслуживании ТО роботом?
3. Каков порядок и каковы преимущества и недостатки обслуживания
ТО роботом с одним схватом?
4. Каковы особенности обслуживания роботом ТО с позициями проме-
жуточного хранения предмета манипулирования?
5. Каковы особенности и преимущества робота с двумя схватами на руке
при многостаночном обслуживании?

Лекция 14. Общие требования к РТК и его компонентам

14.1. Применение робототизированных технологических комплексов

в механообрабатывающем производстве

Механообрабатывающее производство – одно из основных отраслей

машиностроения, где находят широкое применение РТК. Здесь роль ПP
заключается, как правило, в загрузке-разгрузке металлообрабатывающих
станков. В качестве TO здесь используются станки: токарные, фрезерные,
сверлильные, зубообрабатывающие, шлифовальные и другие.
Вследствие значительного времени механообработки здесь нашло
широкое применение обслуживание одним ПР нескольких станков. В
простейшем случае для обслуживания станков используют ПР с
цикловым управлением. Наиболее общим случаем является применение
позиционных ПР. Длительность цикла работы таких ПР – единицы минут.
Рассмотрим простейшую PTЯ (рис. 14.1). Деталь, которую следует
обработать, ПР берет из левого магазина, где детали находятся в ориен-
143
тированном положении и организована их поштучная выдача. После
окончания обработки ПР снимает деталь и кладет ее в правый магазин. Из
таких PTЯ собирают участки. При последовательном соединении таких
PTЯ все последующие ячейки получают на входе ориентированные дета-
ли с предшествующей ячейки.

Рисунок 14.1 – Роботизированная ячейка

Здесь возникает, однако, проблема предварительного размещения де-

талей в левом магазине самой первой ячейки, так как детали в общем
случае приходят в таре навалом. Возможны следующие пути решения
этой задачи:
 загрузка магазина вручную;
 применение вместо магазина специального ориентирующего при-
способления, вибробункеров, устройств ориентации за счет магнитного
поля и т. п.;
 использование для загрузки магазина адаптивного ПР, например,
очувствленного или оснащенного техническим зрением, способного брать
детали из навала.
Однако к настоящему времени такие роботы находятся в стадии
научно – технических разработок и не имеют достаточно широкого рас-
пространения. Они дороги. Адаптивный ПР может работать в двух
режимах: загружать магазин, который затем подается к станку, либо
непосредственно загружать станок, беря детали из навала. В последнем
случае магазин на первой левой позиции не нужен.

144
 В некоторых случаях приходится прибегать к первому варианту –
загрузке вручную, что, к сожалению, имеет место довольно часто. Такое
решение не обеспечивает полностью автоматического режима.
Из всех перечисленных способов наиболее приемлемым в настоятцее
время следует считать второй способ с ориентированием деталей специ-
альными устройствами, особенно в серийном производстве.

14.2. Требования к технологическим процессам, реализуемым в РТК

Технологические процессы, рекомендуемые для реализации в РТК, долж-

ны отвечать следующим требованиям:
1. Объединение однотипных деталей по группам и разработка техно-
логического процесса их обработки по методике групповой технологии.
2. Разработка управляющих программ для станков с ЧПУ и ПP, ориен-
тированных на обработку деталей-представителей (комплексных деталей).
3. Необходимость изменения (доработки) техпроцесса в целях его при-
способления к имеющемуся (или приобретаемому) РТК.
4. Необходимость модернизации TO, ПР и технологической оснастки
при реализации техпроцесса.
5. Максимально возможная концентрация операций на станках с ЧПУ,
что сокращает число перестановок деталей, повышает точность обработки, со-
кращает время производственного цикла.
6. Оснащение станков легкопереналаживаемой широкодиапазонной
технологической оснасткой.
7. В РТК рекомендуется выполнять только хорошо отработанные тех-
нологические операции и техпроцессы.
8. Состав ТО должен по возможности сохранять постоянным
ориентацию оси детали при транспортировании и обработке (предпочтитель-

145
но горизонтальную или вертикальную), что дает возможность использования
ПР с меньшим числом степеней подвижности.
9. Заготовки деталей должны отвечать повышенным требованиям пo
точности, припуску на обработку, отсутствию заусенцев.
10. Необходима тщательная подготовка технологических баз, которая
может производиться как внутри, так и вне РТК.

14.3. Требования к деталям, обрабатываемым в РТК

Номенклатура деталей, обработка которых технологически возможна и

целесообразна в РТК, определяется следующими факторами:
 конструктивными параметрами деталей (геометрической формой, вза-
иморасположением элементов деталей);
 видом и состоянием заготовки, поступающей в РТК;
 технологическими требованиями, предъявляемыми к детали;
 габаритами и массой детали.
При выборе состава деталей необходимо учитывать, что процесс обра-
ботки в РТК проходит без участия человека.
Конструктивно-технологические параметры деталей, предназначенных
для обработки в РТК, должны иметь:
 однородные пo форме и расположению поверхности для захвата, поз-
воляющие без дополнительной выверки устанавливать их на TO с использова-
нием, например, центров, патронов, пневмотисков и т.п.;
 ясно выраженные технологические базы и признаки ориентирования,
позволяющие организовывать их транспортирование и складирование в ори-
ентированном виде с использованием стандартизированной вспомогатель-
ной оснастки типа кассет, поддонов, ячеек и т.п.;
 возможность унификации процессов обработки и типов TO с целью
применения группового метода обработки на серийно выпускаемом ТО.
146
 Выбор номенклатуры и типоразмеров деталей для РТК должен произво-
диться с учетом следующих факторов:
 номенклатуры деталей общемашиностроительного применения, приве-
денной в классификаторе промышленной и сельскохозяйственной продукции;
 анализа номенклатуры деталей, обрабатываемых и выпускаемых на
производственных участках;
 возможных вариантов захвата деталей различных геометрических
форм захватными устройствами ПР;
 ограничительных требований к размерам и весовым характеристикам
детaлей;
 номенклатуры и технологических характеристик TO, используемого
в машиностроении и подлежащего освоению.
Наиболее объективным и стабильным классификационным признаком
является геометрическая форма деталей. Вторичными признаками являются
конструктивные характеристики отдельных элементов деталей, их взаимное
расположение, наименование детали, ее параметрический признак, выполняе-
мые ею функции.
По геометрической форме все детали, применяемые в машиностроении,
разделены на два класса:
 класс 40 – детали типа тел вращения;
 класс 50 – детали “кроме тел вращения”.
Параметрический признак используется для деления деталей на под-
классы. Например, отношение L/D позволяет разделить класс 40 на подклас-
сы: “длинные детали” (оси, валы, пальцы) и “короткие детали” (кольца, диски,
фланцы).
Наименование деталей определяет их характерные признаки (шестерни,
рейки, рычаги и т.п.), что позволяет разделить детали на группы.
Расположение отдельных элементов деталей определяет их виды
(главный вал, ступица и т.п.).

147
 Классификационная сетка деталей позволяет в соответствии с техноло-
гическим классификатором деталей установить типовой технологический
процесс для заданной детали и выбрать TO.
Исходя из указанных требований и технических параметров современных
ПР и ТО, для обработки в РТК рекомендуется следующая номенклатура дета-
лей:
 по классу 40 – «длинные детали»: гладкие и ступенчатые прямоосные и
эксцентриковые валы с диаметром до 160 мм и длиной до 2000 мм; «короткие
детали»: диски, фланцы, кольца, гильзы, втулки с диаметром до 500 мм и дли-
ной до 300 мм;
 по классу 50 – плоские и объемные детали простейшей формы (планки,
крышки, шпонки, угольники, коробчатые детали и т.п.) размерами до
1000х1000x1000 мм.
Массовые характеристики деталей ограничены в пределах до 500 кг.
Для обработки в РТК не рекомендуется включать:
 по классу 40 – детали с элементами не тел вращения (мальтийские кре-
сты, крыльчатки) и детали, изогнутые из листов, полос, лент, крепежные дета-
ли, шкалы, лимбы;
 по классу 50 – детали, изогнутые из листов, труб, балки, решетки,
профильные детали, пружины, рессоры, ручки, то есть детали, не имею-
щие определенной геометрической формы и не обладающие единством базо-
вых поверхностей.
Ограничения по форме деталей диктуются не столько ПР, сколько труд-
ностями транспортирования деталей при использовании стандартной тары
и приемо-передающих механизмов. Однако эти типы деталей могут быть
включены в РТК при их массовом производстве, где можно использовать спе-
циальные захваты и оснастку.

148
 14.4. Требования к технологическому оборудованию, используемому
в РТК

Основным критерием, определяющим возможность включения станков в

состав РТК, является степень их автоматизации, позволяющая без серьезных
конструктивных изменений перевести их на работу в автоматическом режиме
совместно с ПР и возможность быстрой переналадки станка. Этим требовани-
ям отвечают станки с полностью автоматизированным циклом работы: пере-
ключение скоростей и подач, зажим изделий, смена инструмента, выполнение
контрольных операций, отвод и подвод заграждений, вывод стружки и т. п.
Обычно для существующего оборудования перед включением его в РТК
необходима его модернизация с целью автоматизации указанных операций,
если на станке это нe предусмотрено. Кроме того, необходимо автоматизиро-
вать:
 для станков с горизонтальными столами и для вертикальных токарных
– очистку базовых поверхностей, установочных поверхностей приспособле-
ний и стола станков;
 для токарных станков с горизонтальной осью шпинделя – поджим за-
готовки к торцу патрона;
 для станков фрезерно-сверлильной группы – поджим заготовки к
опорной поверхности установочного приспособления;
 для станков токарной группы – оснащение станков устройством для
дробления стружки;
 для круглошлифовальных станков – самодействующими поводковыми
патронами.
Кроме того, необходима модернизация электросхемы станков для обес-
печения их связи с другим оборудованием РТК.
В РТК рекомендуется включать, прежде всего, серийно выпускаемое TO.
Выбор TO производится из следующих предпосылок:

149
  возможность реализации заданного техпроцесса обработки
типоразмерных рядов изделий;
 распространенности и перспективности данного типа ТО;
 приспособленности TO к совместной работе с освоенной номенклату-
рой ПР;
 технико-экономической целесообразности автоматизации данного TO
посредством ПР.
При выборе TO необходимо учитывать, что большинство TO
выпускалось для условий обслуживания человеком, что предопределяет их
модернизацию при обслживании ПР в составе РТК. Работа TO совместно с
ПP создает дополнительную опасность возникновения аварийных ситуа-
ций, что приводит к необходимости разработки мероприятий пo обеспече-
нию техники безопасности, учитывающих специфику РТК.
Обычно РТК создаются на базе станков средней размерной группы, пред-
назначенных для обработки изделий массой до 500 кг, такие, как:
 центровые (токарные, круглошлифовальные, центровально-фрезерные
и др.) с диаметром обрабатываемого изделия до 320 мм и расстоянием между
центрами до 2000 мм;
 токарные патронные, лобовые, внутришлифовальные, зубообрабатывающие
с диаметром до 630 мм;
 фрезерно – сверлильно – расточные и плоскошлифовальные с
пpямоугольными сторонами размером до 630x600 мм2;
 станки с круглыми столами диаметром до 2000 мм.
В состав РТК в первую очередь включаются станки с ЧПУ и станки –
полуавтоматы.
При выборе ТО, включаемого в РТК, необходимо учитывать особенности
зон загрузки станков.
Под зоной загрузки станков понимается пространство рабочей зоны стан-
ков, в которое поступает извне заготовка перед загрузкой ее в зажимное при-
способление станка и где происходит ее закрепление.
150
 При включении станка в состав РТК его зона загрузки имеет большое
значение, предопределяющее выбор типа ПР. Именно в зону загрузки станка
должна войти рука ПР и переместиться вместе с заготовкой (деталью) к
зажимному устройству (либо совершить движение в обратной последователь-
ности).
Имеющиеся зоны загрузки станков можно классифицировать на 12
групп (табл. 14.1):
Принадлежность к той или иной группе определя ют направления
подачи заготовок в зону загрузки станка (сверху, сбоку, спереди, сза-
ди) и схему манипуляционных перемещений схвата ПР.
Для осущствления схемы загрузки имеют значения только форма и
взаимное расположение ограничительных поверхностей, образующих зо-
ну загрузки.
С увеличением номера схемы зоны загрузки возможность входа в зо-
ну все более ограничивается.
Зона загрузки в самом общем случае рассматривается как куб, име-
ющий возможность входа в него с пяти сторон no трем осям координат (х,
у, z), точка пересечения которых должна быть привязана к оси симметрии
установочного приспособления станка, а ось х условно направлена
перпендикулярно к передней стороне станка (по ходу руки робота).
Первая зона (индекс 10) имеет неограниченный подход пo осям со
всех сторон, что характерно для отдельных столов, на которые уста-
навливаются спутники.
По мере появления в зоне загрузки ограничительных плоскостей,
пересекающих одну из осей, количество возможностей входа в зону со-
кращается сначала по одной, а потом и пo двум осям, в результате на по-
следних схемах (тип 100 и 120) вход в зону возможен только пo одной из
осей с одной стороны.

151
 Таблица 14.1
Группы зон загрузки станков

152
 Наибольшее количество станков (до 30%) имеют зоку загрузки типа
“60” с возможностью загрузки спереди и сверху, 25% - зону загрузки типа
“30” с возможностью загрузки сверху, спереди и с боков.
Процесс загрузки станков ПР можно разделить на три типа переме-
щений:
 транспортирование заготовки от места хранения к станку (за-
висит от компоновки комплекса и конструкции ПР;
 перемещение заготовки в рабочую зону (зону загрузки) станка (за-
висит от формы и взаимного расположения ограничительных плоскостей
зоны);
 перемещение (ввод) заготовки в базирующее (установочное) при-
способление станка (зависит от расположения приспособления на од-
ной из ограничительных плоскостей зоны и принципа действия сам о-
го приспособления).
Первые два типа перемещения реализуются переносными степенями
подвижности ПР, а третий – ориентирующими.

14.5. Требования к промышленным роботам, включаемым в состав

РТК

ПР должны обеспечить выполнение вспомогательных функций: уста-

новку заранее ориентированных заготовок в приспособление станка,
снятие детали со станка и раскладку их в тару или укладку в магазин
(транспортер), кантование деталей на 90 о, 180о, выдачу технологических
команд, межстаночное транспортирование.
ПР как средства автоматизации должны иметь:
 конструктивно-технологические параметры, соответствующие
техническим параметрам ТО: грузоподъемность, скорость перемещения,
точность позиционирования, размеры рабочей зоны, тип системы
программного управления;
153
  возможность улучшать технико-экономические показатели ТО:
производительность не менее, чем на 20%, повышать коэффициент за-
грузки TO в 2-2,5 раза и т.д.;
 минимальное число степеней подвижности при условии
обеспечения требуемых перемещений;
 достаточную степень универсальности для обеспечения
возможности перехода оборудования с выпуска одного изделия на другое с
минимальными затратами времени;
 высокую надежность, жесткость, виброустойчивость всех рабочих ор-
ганов;
 зону, обеспечивающую возможность наблюдения за процессом
обработки и вмешательства в процесс в случае аварийной ситуации с со-
блюдением при этом условий безопасности обслуживающего персонала.
Роботы, вкодящие в состав РТК, должны дополнитеиьно обеспечивать:
1. Совместную работу всех устройств, входящих в РТК, на основе меха-
нических и электрических связей (ЧПУ, ОТО, средств оснащения, устройств
управления ПР и микропроцессоров исполнительных механизмов), согласова-
ние взаимных команд, а также автоматизированное или автоматическое пере-
программирование);
2. Свободный доступ в зону установки и снятия деталей со станка, в
зону перемещения захватного устройства, технологического оснащения и дру-
гих систем, а также возможность манипулирования предметами труда между
машинами и механизмами РТК;
3. Автоматизированную или автоматическую смену инструмента, оснаст-
ки и рабочих органов ПР.
Применение ПР как средств автоматизации металлорежущих станков
может осуществляться в двух направлениях:
1. Создание однопозиционных РТК, где робот обслуживает один станок.
При этом ПР может быть автономным либо встроенным в станок. Автономные
ПР более универсальны и могут обслуживать гамму станков со схожими зо-
154
нами загрузки. Встроенные ПР создаются, как правило, для определенной
модели TO и крепятся к какой-либо части корпуса TO (на передней бабке
токарных станков – “Электроника НЦ-ТМ-01”, сзади рабочей зоны станка
ТПК-125В – робот РП-901 и накопитель на 20 позиций).
2. Создание многопозиционных и групповых технологических комплек-
сов на основе ПР, обслуживающих группу станков (от 2 до 6). В таких РТК
ПP, кроме операций загрузки TO выполняет межстаночное транспортирование
деталей, их переориентацию, а также функции управления (согласование
последовательности работы) станками. Групповые комплексы создаются на
основе ПР с ЧПУ, обладающими большим объемом памяти и способных
обслуживать разнотипные станки, имеющих, однако, подобные схемы загруз-
ки и характеристики обрабатываемых деталей.

14.6. Требования к вспомогательному и транспортно-

накопительному оборудованию, включаемому в РТК

Вспомогательное и транспортно-накопительное оборудование должно

обеспечить непрерывное действие РТК в автоматическом режиме в течение
заданного времени.
Функции транспортно-накопительного оборудования (ТНО):
 накопление ориентированных заготовок на входной позиции РТК;
 поштучная выдача заготовок (деталей) в определенную точку для взя-
тия их схватом ПР;
 транспортирование изделий внутри РТК с сохранением ориентации,
передачи их на последующие участки;
 переориентация изделий между станками РТК;
 хранение межоперационного задела и задела между РТК.
Требования к вспомогательному оборудованию определяются:
 типом РТК;
155
  типом, формой, материалом и размером деталей;
 составом станков;
 серийностью производства и штучным временем обработки на станках.
Тип РТК и состав станков определяют:
 функции, которые должны выполняться вспомогательным оборудова-
нием (ВО): хранение, непрерывное транспортирование, шаговая подача и т.п.;
 положение оси изделия при хранении и транспортировке;
 конструктивное исполнение вспомогательного оборудования: магазин,
тактовый транспортер и др.
Тип и размеры деталей определяют форму и размеры ложемента (призмы,
стол, штыри, отверстия и т.д.).
Серийность и штучное время определяют емкость ВО, то есть
количественный запас деталей, который должен быть обеспечен в единицу
времени.
ВО должно быть быстропереналаживаемым и иметь широкую гамму
унифицированных элементов.
При выборе и разработке ТНО для РТК требуется:
 сопряжение ТНО с общезаводскими и цеховыми средствами
транспортирования;
 выбор способа ориентации и комплектации заготовок на первона-
чальной позиции РТК;
 выбор типа и емкости накопительных устройств.
В качестве накопительных устройств в РТК могут использоваться лотки
(скаты, склизы), шаговые транспортеры (реечные, пильчатые, с управляемыми
собачками), цепные транспортеры (горизонтальные, вертикальные), круговые
накопительные устройства, тупиковые накопительные устройства, транспор-
теры роликовые, тактовые столы и многоместная тара.
При разработке ТНО требуется предварительно решить вопрос транспор-
тировки изделия – поштучно либо в таре.

156
 При жесткой связи между TO в РТК транспортирование может осу-
ществляться поштучно проходным шаговым транепортером или тактовым
столом.
При гибкой связи между TO в РТК транспортирование может осу-
ществляться либо поштучно самим ПР, либо специальными транспорти-
рующими устройствами, либо автоматизированной транспортной тележкой
(робокар, трансробот).
Вспомогательное оборудование, входящее в состав РТК, не имеет
между собой, как правило, ни конструктивных, ни информационных свя-
зей, получая все команды от TO или ПР и давая им ответные сигналы.
Требования к станочной оснастке:
При создании PTK выбор станочной оснастки осуществляется исходя
из следующих положений:
 ПP сам пo себе не обеспечивает окончательную точность базирова-
ния детали в приспособлении. Требования к ПР ограничиваются
возможностью ввода заготовки в зону базирующего приспособления стан-
ка с зазором, гарантированном допусками нa сопрягаемые поверхности ба-
зирующего приспособления и детали;
 технологическая оснастка должна обеспечивать возможность уста-
новки детали заданной моделью ПР, требуемую точность базирования и
надежность закрепления и удержания детали в процессе обработки;
 в целях гарантии правильности положения детали в
приспосоолении станка в PTK желательно предусмотреть систему кон-
трольных датчиков, фиксирующих положение детали перед обработкой.
Датчики могут находиться как на схвате ПР, так и нa самом ПР.
Для применения в составе PTK без дополнительных доработок можно
рекомендовать:
 для токарных станков: центра, поводковые патроны с плавающим
центром, торцевые поводковые и caмоцентрирующиеся 3-х кулачковые па-
троны;
157
  для фрезерно-сверлильно-центровальных и протяжных станков:
самозажимные тиски, приспособления с угловой фиксацией детали.

14.7. Требования к РТК в целом

Можно выделить следующие основные требования, обязательные для

РТК:
 планировка PTK должна обеспечивать свободный, удобный и без-
опасный доступ обслуживающего персонала к основному и вспомогатель-
ному оборудованию и органам управления PTK;
 планировка PTK должна исключать пересечение трасс следования
ПР и оператора в процессе работы ПP пo программе;
 РТК должен быть обеспечен средствами защиты от возможного
несанкционированного проникновения человека в зону действия ПР
(светозащита, ограждения, звуковая сигнализация, защитные сетки, настил
с датчиками).Должно быть применено параллельно 2-3 автономно дей-
ствующие защитные системы;
 размещение средств защиты не должно ограничивать технологиче-
ские возможности основного TO, ПР и удобства их обслуживания, а
также препятствовать визуальному наблюдению оператора за ходом
техпроцесса;
 размещение средств управления РТК должно обеспечивать сво-
бодный и быстрый доступ к органам аварийного отключения ПР и
безопасность при управлении ПР в наладочном режиме.
Стойки систем управления ПP, TO и РТК в целом рекомендуется
располагать вне их рабочей зоны.
Выше сформулированы требования к основным компонентам РТК
применительно к механообработке, однако некоторые требования,
например к ПP и РТК можно рассматривать шире.
158
 14.8. Обшие характеристики и особенности РТК механообработки

Механообработка является завершающим этапом производственного

процесса перед сборкой. Механическую обработку проходят практически
все детали машиностроительного производства. Механообработке
подвергаются заготовки и полуфабрикаты, полученные прокатом, штам-
повкой, литьем, сварные детали и т.д. Механообработка имеет ряд при-
сущих именно этому виду обработки характеристик и особенностей.
1. Многономенклатурность и преобладание мелкосерийного и се-
рийного производств; широкие возможности, универсальность ТО, высо-
кие качество и точность обработки; относительная простота переналадки.
Это способствует закреплению за единицей TO большого числа
типоразмеров деталей серийного и мелкосерийного производств и требу-
ет при построении РТК использовать ПР и ВО, способные работать с до-
статочно большой группой однотипных деталей при обеспечении быстрой
переналадки на новую деталь данного типоразмера.
2. Наличие сложной и точной оснастки. Наиболее перспективно ис-
пользование самоцентрирующих автоматических устройств для зажима
деталей, так как это позволяет применять ПР со сравнительно низкой
точностью позиционирования (±0,3...0,5 мм). При разработке оснастки
следует учитывать ее совместную работу с ПР и обеспечивать по возмож-
ности простоту обслуживания TO и ВО промышленным роботом.
3. Быстрое изнашивание инструмента, являющееся одний из
причин обеспечения постоянного контроля за процессом обработки и
подналадки. Контроль может производиться либо на измерительных ма-
шинах, либо с помощью ПР.
4. Большое количество разнотипной стружки, так как процесс реза-
ния сопровождается, как правило, интенсивным стружкообразованием.
Стружка может быть сливной или стружкой скалывания. В РТК должен

159
быть решен вопрос дробления сливной стружки и отвода любой стружки
из зоны обработки, а особенно с базовых поверхностей приспособлений.
5. Разнообразие типов металлорежущего оборудования в одном
технологическом потоке: токарные, фрезерные, сверлильные, расточные,
шлифовальные и др. станки. Это требует, в случае, если ПP обслуживает
разнотипные станки, его достаточную универсальность.

Вопросы к лекции 14:

1. Каковы особенности применения РТК в механообрабатывающем про-
изводстве?
2. Каковы требования к технологическим процессам, реализуемым в
РТК?
3. Каковы требования к деталям, обрабатываемым в ТРК?
4. Какие детали относятся к деталям класса 40 и класса 50?
5. Какие детали класса 40 рекомендуется и какие не рекомендуется об-
рабатывать в РТК?
6. Какие детали класса 50 рекомендуется и какие не рекомендуется об-
рабатывать в РТК?
7. Каковы требования к технологическому оборудованию, используемо-
му в РТК?
8. Поясните особенности характерных зон загрузки станков промыш-
ленными роботами.
9. Каковы требования к промышленным роботам, включаемым в состав
РТК?
10. Каковы требования к РТК в целом применительно к машинострои-
тельному производству?
11. Каковы общие характеристики и особенности РТК механообработ-
ки?

160
 Лекция 15. Планирование траекторий схвата манипулятора робота
в составе РТК на основе сплайн-функций

15.1. Общие требования к траекториям движения схвата

манипуляторов в составе РТК

Наиболее общим случаем при планировании траектории является рас-

смотрение траектории движения схвата из рабочей зоны одного оборудова-
ния в рабочую зону другого. При определении траектории должны быть
учтены ограничения на саму траекторию и возможные препятствия на пути
схвата.
В качестве обязательных требований обычно выступают следующие.
1. В момент снятия объекта манипулирования движение схвата должно
быть направлено перпендикулярно опорной поверхности ТО до тех пор, пока
схват не уйдет на безопасное расстояние. Траектория от начальной точки AH
до точки AУ, находящейся на безопасном расстоянии, называется траектори-
ей ухода, а сама точка AУ – точкой ухода (рис. 15.1).
2. В момент постановки объекта манипулирования на ТО схват, начиная
с некоторого безопасного расстояния должен подходить перпендикулярно к
опорной поверхности ТО. Точка AП, находящаяся на безопасном расстоянии
при подходе к ТО, называется точкой подхода, а траектория от этой точки до
конечной точки AК – траекторией подхода (рис. 15.1).
В общем случае точки ухода и подхода, относящиеся к одному и тому
же оборудованию могут не совпадать из–за наличия или отсутствия объекта
манипулирования в схвате, различных габаритов и условий транспортирова-
ния заготовок, деталей и т. д.
3. Между точками ухода и подхода схват движется в крейсерском режи-
ме по траектории оптимальной в том или ином отношении: по быстродей-
ствию; по затратам энергии; по условиям, обеспечивающим щадящий режим

161
транспортирования объекта манипулирования. Например, могут быть огра-
ничения на максимальные значения абсолютных скоростей и ускорений.
Таким образом, в качестве наиболее общего случая будем рассматривать
частную траекторию движения схвата от одной остановки до другой при его
перемещении между соседними единицами ТО с выделением на ней трех ха-
рактерных участков (участок ухода AНAУ; участок крейсерского перемеще-
ния AУAП; участок подхода AПAК) и четырех характерных точек: AН, AУ, AП,
AК – начальной, ухода, подхода и конечной. Координаты этих точек первона-
чально должны быть заданы в системе координат OjXjYjZj j-го ТО.
После привязки систем координат робота к системе координат ТО коор-
динаты точек AН, AУ, AП и AК должны быть пересчитаны в инерциальную си-
стему OpXpYpZp робота.

Рисунок 15.1 – Производственная сцена при планировании траектории

Планирование траектории манипулятора надо вести как в инерциальной

системе координат робота, так и в системе его обобщенных координат. Учи-
тывая, что управление манипулятором ведется в обобщенных координатах
qi, то и окончательное планирование траекторий целесообразно вести именно
в пространстве обобщенных координат. Следовательно, перед планировани-
ем траектории в обобщенных координатах робота должна быть решена об-
ратная задача кинематики и по известным координатам точек AН, AУ, AП, AК
162
должны быть определены соответствующие им значения обобщенных коор-
динат. В результате будут получены четыре опорные точки в системе обоб-
щенных координат:
q iH , q iУ , q iП , q iК ; (i  1,, n) ,
где n – число подвижных звеньев (число степеней подвижности) мани-
пулятора.
Заметим, что такие точки должны быть определенны по каждой из
обобщенных координат.
Возможно несколько подходов к описанию траектории AНAУAПAК в за-
висимости от предъявляемых к ней требований:
1. Траектория на всем своем протяжении представляется одним полино-
мом по каждой обобщенной координате.
2. Каждый характерный участок траектории описывается отдельной
сплайн – функцией.
3. На участках ухода AНAУ и подхода AПAК для большей определенно-
сти она задается как функция времени в инерциальных координатах робота,
например, отрезком пространственной прямой. В этом случае траектория на
этих участках строго определена и не подлежит планированию, а необходимо
путем решения обратной задачи рассчитать соответствующие значения
обобщенных координат и определить функции

q iHУ (t ) и q iПК (t ) (i  1, , n ) .
4. Участок AУAП перемещения схвата от одного оборудования к друго-
му с целью получения более определенной траектории разбивается на доста-
точно мелкие дополнительные участки, описываемые соответствующими
сплайн – функциями.

163
 15.2. Представление траектории движения схвата одним полиномом
(первый подход)

Задача планирования траектории схвата сводится, следовательно, к по-

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

q i  q i ( t ); 0  t  t 3 , (i = 1,…,n).

Рисунок 15.2 – Траектория в пространстве обобщенных координат

Обобщенные траектории описываются в этом случае одним полиномом.

Сформируем требования, которым должна отвечать траектория в данном
случае.
1. Траектория на всем протяжении должна быть гладкой.
2. Траектория должна проходить через установленные характерные точ-
ки:
q iH (0); q iУ (t1 ); q iП (t 2 ); q iК (t 3 ) .
3. Скорости и ускорения схвата в начальной и конечной точках должны
быть равны значениям, требуемым по условиям сопряжения схвата с техно-
логической оснасткой. Обычно они равны нулю, однако, например, при рабо-
те с конвейером V(0)  0; V(t 3)  0 .
Эти требования позволяют записать граничные условиям полиномов
qi(t), с помощью которых и будет реализовываться траектория.
164
 Точка АН: t = 0: 1) q i (0)  q iH ; 2) q i (0)  0; 3) q i (0)  0;

Точка АУ: t = t1: 4) q i ( t1 )  q iУ ;

Точка АП: t = t2: 5) q i ( t 2 )  q iП ;

Точка АК: t = t3: 6) q i (t 3 )  q iK ; 7) q i (t 3 )  0; 8) q i (t 3 )  0.

Таким образом, полином должен отвечать восьми граничным условиям
и, следовательно, он должен быть минимум седьмой степени, когда в поли-
номе имеется восемь свободных коэффициентов. Если есть необходимость
выполнения каких-либо дополнительных условий, степень полинома может
быть повышена на одну - две. Однако в общем случае такое увеличение не-
желательно, так как повышает степень непредсказуемости поведения траек-
тории между опорными точками. Итак, рассмотрим полином седьмой степе-
ни.
q i (t )  a 7i t 7  a 6i t 6    a 1i t  a 0i (i  1, , n) .
Продифференцируем его дважды:

q i ( t )  7a 7i t 6  6a 6i t 5    a1i ;
qi ( t )  42a 7i t 5  30a 6i t 4  2a 2i .
Подставим в эти выражения значения t=0 для точки AH и получим:
a 0i  q iH ; a1i  0; a 2i  0 .
Оставшиеся пять неизвестных коэффициентов должны быть определены
по пяти неиспользованным граничным условиям из системы пяти уравнений:
 a 7i t 17  a 6i t 16  a 5i t15  a 4i t 14  a 3i t13  q iH  q iY ;

 a 7i t 27  a 6i t 26  a 5i t 52  a 4i t 42  a 3i t 32  q iH  q iП ;

 a 7i t 3  a 6i t 3  a 5i t 3  a 4i t 3  a 3i t 3  q i  q i ;
7 6 5 4 3 H K


7a 7i t 3  6a 6i t 3  5a 5i t 3  4a 4i t 3  3a 3i t 3  0;
6 5 4 3 2

42a t 5  30a t 4  20a t 3  12a t 2  6a t  0.

 7i 3 6i 3 5i 3 4i 3 3i 3

Каждый из коэффициентов является функцией значений обобщенных

координат опорных точек и моментов времени их прохождения, а именно:
165
 a ki  a ki (q iH , q i У , q iП , q iK ; t 1 ; t 2 ; t 3 ) .
Так как k = 0, …, 7, а i = 1, …, n, то всего должно быть определено 8×n
коэффициентов, из них 5×n коэффициентов из n систем пяти уравнений.
Описание траектории одним полиномом высокой степени весьма удобно
с математической и алгоритмической точек зрения. Однако с физической
точки зрения его использование может привести к нежелательным послед-
ствиям, а именно к появлению эффекта «блуждания» схвата, т. е. к значи-
тельному отходу схвата от желаемой траектории между опорными точками
(рис. 15.3).

Рисунок 15.3 – Общий вид полинома седьмой степени, проходящего

через четыре характерных точки

В этом случае возникает сложная задача обеспечения приемлемых от-

клонений действительной траектории от желаемой, что можно осуществить,

отступая от назначенных значений q iУ , q i П , t1 , t 2 (будем считать, что началь-

ные и конечные точки AH и AK изменению не подлежат, так как они опреде-
ляются расположением оборудования и конструкцией технологического при-
способления). Изменению не подлежит также заданное время t3 движения от
одного оборудования к другому.

166
 15.3. Представление траектории движения схвата сплайн-
функциями (второй подход)

Чтобы уменьшить опасность нежелательного блуждания схвата стре-

мятся использовать полиномы возможно более низких степеней. Одним из
путей понижения требуемой степени полинома является представление каж-
дого из трех участков отдельными функциями, которые на границах участка
должны быть соответствующим образом сопряжены – «склеены, сшиты».
В результате траектория схвата будет представлена кусочно-
непрерывной функцией, составленной из трех полиномов, которые в силу их
взаимного сопряжения представляют собой сплайн-функции.
Для рассматриваемой трехучастковой траектории с целью обеспечения
плавного безударного перехода с одного участка на другой на границах
участков значения функций, описывающих соседние участки, а также значе-
ния их первых и вторых производных должны быть равны друг другу.
При рассмотрении сплайн-функций вместо абсолютного времени удобно
использовать относительное (нормированное) время для каждого участка
(рис. 15.4).
t  t m 1
m  ; t m 1  t  t m
t m  t m 1
0  m  1
qi t

m-1 m
t
Рисунок 15. 4 – Использование относительного (нормированного)
времени

167
 Установим граничные условия, которым должны отвечать сплайн –
функции:
Первый участок: Второй участок:
1) q1i (0)  q iH ; 5) q 2i (0)  q iУ ;
2) q 1i (0)  0 ; 6) q 2i (0)  q 1i (1) ;
3) q1i (0)  0 ; 7) q 2i (0)  q1i (1) ;

4) q1i (1)  q iУ ; 8) q 2i (1)  q iП ;

Третий участок:
9) q 3i (0)  q iП ; 12) q 3i (1)  q iК ;
10) q 3i (0)  q 2i (1) ; 13) q 3i (1)  0 ;
11) q3i (0)  q 2i (1) ; 14) q3i (1)  0 .

Учитывая, что используются три полинома (по одному на каждом

участке) и в каждом полиноме есть один свободный коэффициент, то сумма
степеней полиномов должна быть равна
14 – 3 = 11 (здесь 14 – число граничных условий).
Известны различные комбинации степеней полинома на участках.
Наибольшее распространение получили:
4-3-4 – траектории,
3-5-3 – траектории и
5-2-4 – или 4-2-5 – траектории.
Здесь цифры обозначают степени полинома на соответствующих участ-
ках.
Чаще других используется 4-3-4 – траектория, так как из всех упомяну-
тых она имеет полиномы более низких степеней.
Запишем аналитическое выражение для 4-3-4 – траектории:

168
 a 4i 14  a 3i 13  a 2i 12  a 1i 1  a 0i ;
q i ()  b 3i  32  b 2i  22  b1i  2  b 0i ;
c 4i  34  c 3i  33  c 2i  32  c1i  3  c 0i .

Используя условия 1, 2, 3 и 5, 9, найдем:

a 0i  q iH ; a1i  0; a 2i  0;
b 0i  q iУ ; c 0i  q iП .
Остальные девять коэффициентов определяются из решения системы
девяти уравнений. Причем таких систем должно быть n, а определению под-
лежит 14×n коэффициентов, при этом коэффициенты полиномов, как и
раньше, являются функциями обобщенных координат опорных точек и вре-
мени их прохождения.
Продифференцируем сплайн-фукнции при условии, что
q i (0)  q i (t 3 )  0 и qi (0)  qi (t 3 )  0 :

4a 4i 13  3a 3i 12 ;
q i ()  3b 3i  22  2b 2i  2  b1i ;
4c 4i  33  3c 3i  32  2c 2i  3  c1i .

12a 4i 12  6a 3i 1 ;
q i ()  6b 3i  2  2b 2i ;
12c 4i  32  6c 3i  3  2c 2i .
Запишем по оставшимся девяти граничным условиям систему девяти
уравнений:
1) Условие 4 (τ1 = 1): a 4i  a 3i  q iH  q iУ ;
2) Условие 6 (τ1 = 1; τ2 = 0): 4a 4i  3a 3i  b1i ;
3) Условие 7 (τ1 = 1; τ2 = 0): 12a 4i  6a 3i  2b 2i ;

4) Условие 8 (τ2 = 1): b 3i  b 2i  b1i  q iУ  q iП ;

5) Условие 10 (τ2 = 1; τ3 = 0): 3b 3i  2b 2i  b1i  c1i ;
6) Условие 11 (τ2 = 1; τ3 = 0): 6b 3i  2b 2i  2c1i ;
169
 7) Условие 12 (τ3 = 1): c 4i  c 3i  c 2i  c1i  q iП  q iK ;
8) Условие 13 (τ3 = 1): 4c 4i  3c 3i  2c 2i  c1i  0;
9) Условие 14 (τ3 = 1): 12c 4i  6c 3i  2c 2i  0;

Решая эту систему девяти уравнений, определяются девять неизвестных

коэффициентов для n обобщенных координат.
Для еще большего уменьшения вероятности блуждания схвата исполь-
зуют сплайн-функции типа 3-3-3-3-3. В этом случае, кроме ранее рассмот-
ренных трех участков, на участке AУАП вводятся две дополнительные опор-
ные точки и вместо этого одного участка возникает три (рис. 15.5).

Рисунок 15.5 – Траектория типа 3-3-3-3-3

В данном случае дополнительные участки вводятся именно с целью по-

нижения степени составляющих сплайн-функции и уменьшения благодаря
этому блуждания схвата. Конкретные значения обобщенных координат в
этих точках не регламентируется, что позволяет уменьшить число граничных
условий (назначаются лишь моменты времени t2 и t3 прохождения их схва-
том, т.е. моменты перехода с одной функции на другую). В данном случае
также будем пользоваться понятием относительного (нормированного) вре-
мени.

170
 Запишем необходимые при указанных условиях граничные условия
(сшивка полиномов должна обеспечить на границах участков непрерывность
скоростей и ускорений, а также выполнение ранее принятых условий про-
хождения схвата через точки AН , АУ , AП , АК).
Индекс i на время будем опускать.
Участок 1 Участок 3
1) q1 (0)  q H ; 8) q 3 (0)  q 2 (1) ;

2) q 1 (0)  0 ; 9) q 3 (0)  q 2 (1) ;

3) q1 (0)  0 ; 10) q3 (0)  q 2 (1) ;

Участок 4
4) q1 (1)  q У ;
11) q 4 (0)  q 3 (1) ;
Участок 2
У
12) q 4 (0)  q 3 (1) ;
5) q 2 (0)  q ;
13) q 4 (0)  q3 (1) ;
6) q 2 (0)  q 1 (1) ;
14) q 4 (1)  q П ;
7) q 2 (0)  q1 (1) ;
Участок 5
15) q 5 (0)  q П ; 18) q 5 (1)  q К ;
16) q 5 (0)  q 4 (1) ; 19) q 5 (1)  0 ;
17) q5 (0)  q 4 (1) ; 20) q5 (1)  0 .
Таким образом, получено двадцать граничных условий, что равно числу
коэффициентов пяти полиномов третей степени.
Запишем сплайн-функцию для 3-3-3-3-3 – траектории по i-ой степени
подвижности:

a 3i 13  a 2i 12  a 1i   a 0i ;
b 3i  32  b 2i  22  b1i   b 0i ;
q i  c 3i  33  c 2i  32  c1i   c 0i ; (i  1,, n).
d 3i  34  d 2i  4  d1i   d 0i ;
e 3i  35  e 2i  52  e1i   e 0i ;

171
 Из условий 1, 2, 3, 5 и 15 определим

a 0i  q iH ; a1i  0; a 2i  0;
b 0i  q iУ ; e 0i  q П .
Остальные коэффициенты определяются из системы пятнадцати уравне-
ний.

15.4. Общие случаи планирования траекторий сплайн-функциями в

пространстве обобщенных координат

В тех случаях, когда точки АУ и АП удалены друг от друга на значи-

тельные расстояния, может потребоваться большее число участков, чем три
или пять. Увеличение числа участков может быть оправдано и в случае, если
желательно обеспечить максимальную точность реализации траектории.
Возможны два варианта общих случаев (число участков примем равным
М):
Первый – когда координаты дополнительных точек не регламентируют-
ся как при рассмотрении 3-3-3-3-3 – траектории.
Второй (наиболее общий случай) – заданы координаты всех промежу-
точных точек.
Первый случай во многом аналогичен проектированию 3-3-3-3-3 – тра-
ектории.
Учитывая, что 1-й и (М-1)-й участки должны иметь по четыре ограниче-
ния, М-й – шесть ограничений, а все промежуточные по три ограничения,
можно определить выражение для расчета суммы PМ степеней полиномов,
удовлетворяющих сформулированным условиям:
PМ = 4 + 4 + 6 + 3(М – 3) – М = 5 + 2М (М > 3)
Примеры:
М = 3; PМ = 11 (4-3-4; 3-5-3; 5-2-3); М = 4; PМ = 13;
М = 5; PМ = 15 (3-3-3-3-3); М = 6; PМ = 17;
172
 М = 10; PМ = 25 (3-3-2-3-2-2-2-3-2-3).
Второй случай, как отмечалось, является наиболее общим случаем. Он
возникает, когда траектория движения схвата является функцией времени и
задана на всем протяжении в декартовых координатах манипулятора (рис.
15.6).

Рисунок 15.6 – Общий случай задания траектории в пространстве инер-

циальных координат

В результате решения обратной задачи кинематики находятся соответ-

ствующие заданным точкам значения обобщенных координат по каждой сте-
пени подвижности (рис. 15.7):
q iH , q1i , q i2 ,, q il ,, q iМ1 , q iМ  q iК

Рисунок 15.7 – Общий случай задания траектории в пространстве обоб-

щенных координат
173
 Запишем ограничения для рассматриваемого общего случая с использо-
ванием понятия относительного времени:
Участок 1 Участок m
1) q1i (0)  q iH ; 1) q mi (0)  q im1 ;
2) q 1i (0)  0 ; 2) q mi (0)  q ( m1)i (1) ;
3) q1i (0)  0 ; 3) q mi (0)  q ( m1)i (1) ;

4) q1i (1)  q1i . 4) q mi (1)  q im .

Участок 2 Участок (М-1)
1) q 2i (0)  q1i ; 1) q (11)i (0)  q im2 ;
2) q 2i (0)  q 1i (1) ; 2) q ( m1)i (0)  q ( m2)i (1) ;
3) q 2i (0)  q1i (1) ; 3) q ( m1)i (0)  q ( m2)i (1) ;
4) q 2i (1)  q i2 . 4) q ( m1)i (1)  q im1 .

Участок 3 Участок М
1) q 3i (0)  q i2 ; 1) q Мi (0)  q iМ1 ;
2) q 3i (0)  q 2i (1) ; 2) q Мi (0)  q ( М1)i (1) ;
3) q3i (0)  q 2i (1) ; 3) q Мi (0)  q ( М1)i (1) ;

4) q 3i (1)  q 3i . 4) q Мi (1)  q iК ;
………………….. 5) q Мi (1)  0 ;
6) q Мi (1)  0 .

Определим необходимую сумму степеней аппроксимирующих полино-

мов, учитывая, что на участке M имеется шесть условий, а на остальных по
четыре.
Pm = 6 + 4(М – 1) – М = 2 + 3М (М > 3)

174
 Примеры:
М = 3; PМ = 11 совпало с предыдущим, т. к. участков вносящих разницу в
этом случае нет;
М = 4; PМ = 14 (4-3-3-4);
М = 5; PМ = 17 (4-3-3-3-4) два дополнительных условия по положению;
М = 10; PМ = 32.
Общим недостатком такого представления зависимостей qi(t) является
необходимость предварительного решения системы большого числа уравне-
ний для определения коэффициентов полиномов. Трудности усугубляются
еще и тем, что при изменении числа участков появляется новая система
уравнений, которую нужно решить заново.
Таким образом, для успешного использования изложенных методов
представления обобщенных координат необходимо иметь готовые таблицы
зависимостей для расчета коэффициентов.
В настоящее время таких таблиц нет. И для случая деления траектории
на произвольное число участков их получение связано со значительными
трудностями.
Ограничения на обобщенные траектории.
Законы движения qi(t), полученные в ходе планирования обобщенной
траектории, реализуются приводами в соответствующих подвижных сочле-
нениях манипулятора робота. Полученные из теоретических соображений за-
коны qi(t) должны быть проверены на возможность исполнения их соответ-
ствующим приводом. Существуют ограничения на перемещения, на скорости
и ускорения.
Ограничения на обобщенные перемещения связаны с ограниченным
диапазоном перемещения одного звена относительно другого (рис. 15.8):

q imin  q i (t )  q imax

175
 Рисунок 15.8 – Ограничения на перемещения подвижных звеньев
манипулятора

Для удовлетворения ограничений по перемещению следует определить

экстремумы функций qi(t), что нетрудно выполнить после нахождения кор-
ней уравнения q i ( t ) .
Ограничения на обобщенные скорости q i ( t ) диктуются скоростными
возможностями привода и его ограничениями на величину кинетической
энергии. Для определения экстремальных значений q i ( t ) следует найти кор-
ни уравнения qi ( t ) .
Ограничения на обобщенные ускорения определяются максимально
возможными моментами сил и усилиями, развиваемыми приводами.
Траектория движения схвата и его ориентации при конкретном рассмот-
рении может быть задана различным образом. В частности, она может быть
задана как и ранее некоторым числом опорных точек при условии движения
между ними с постоянными скоростями и по прямой линии.
Приведем пример производственной сцены (рис. 15.9), в которой может
возникнуть необходимость в прямолинейных движениях схвата. Понятно,
что движение между опорными точками может в общем случае осуществ-
ляться и по криволинейным траекториям.

176
 Рисунок 15.9 – Производственная сцена

Вопросы к лекции 15:

1. Каковы общие требования к траекториям движения схвата манипуля-
тора в составе РТК?
2. Назовите характерные точки и участки траектории движения схвата
при обслуживании ТО.
3. Назовите подходы к описанию траекторий движения схвата ПР в со-
ставе РТК.
4. Поясните порядок синтеза закона движения по обобщенной коорди-
нате при описании траектории одним полиномом.
5. Каковы граничные условия при синтезе закона движения по обобщен-
ной координате при описании траектории одним полиномом?

177
 6. Поясните порядок синтеза законов движения по обобщенным коорди-
натам при представлении траектории движения сплайн-функциями.
7. Каковы особенности траекторий типов 4-3-4, 3-5-3 и 5-2-4?
8. Каков порядок и какова целесообразность представления траектории
сплайн-функцией типа 3-3-3-3-3?
9. Каковы особенности планирования траекторий в пространстве обоб-
щенных координат для произвольного числа реперных точек?

Лекция 16. Моделирование робототехнических систем в терминах

сетей Петри

16.1. Основные понятия и терминология сетей Петри

Сети Петри представляют собой двудольный ориентированный граф, в

котором имеются вершины двух типов: вершины одного типа называются
позициями и обозначаются pi (изображаются кружками), а вершины другого
типа - переходами с обозначением tj (изображаются чертой-барьером). Для
условно-событийных систем позиции сети Петри интерпретируются как
условия (предусловия, постусловия совершения события), а переходы соот-
ветствуют событиям, происходящим в системе. Элементарная сеть Петри
может быть представлена так (рис. 16.1):

Рисунок 16.1 – Элементарная сеть Петри

Дуги в сетях Петри - направленные. Причем каждая дуга связывает вер-

шины только разных типов: если дуга выходит из позиции, то должна войти

178
в переход и наоборот. На рис. 16.2 а приведен пример, соответствующий
этому ограничению, а на рис. 16.2 б - недопустимые варианты соединений.

а) б)
Рисунок 16.2 – Допустимые (а) и недопустимые (б) варианты
соединений

Позиции, из которых выходят дуги, направленные к данному переходу,

называются его входными позициями. Позиции, в которые входят дуги, ис-
ходящие из данного перехода, называются его выходными позициями. Так, в
элементарной сети на рис.16.1 позиция p1 является для перехода t1 входной, а
позиция р2 – выходной.
Динамика поведения моделируемой системы (и в этом принципиальное
отличие сетей Петри от графовых моделей, которые по своей сути являются
статическими) находит свое отражение в функционировании (работе) сети
Петри. Работу сети можно представить как совокупность срабатываний пере-
ходов. Переход запускается, если выполнены все условия реализации соот-
ветствующего события. Выполнение условия в сетях Петри отображается
разметкой соответствующей позиции, а именно размещением в ней одного
или нескольких маркеров (фишек) в соответствии с емкостью условия. В
графическом представлении маркер обозначается точкой внутри соответ-

179
ствующей позиции. Так, если в позицию p1 на рис. 16.1 поместить маркер, то
это будет означать, что условие совершения события t1 имеет место (выпол-
нено), и событие может произойти (рис. 16.3 а).

а) б)
Рисунок 16.3 – Срабатывание перехода в элементарной сети

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

входных и выходных позиций следующим образом: из каждой входной пози-
ции маркер изымается, а в каждую выходную позицию - добавляется. Тем
самым реализация события изменяет состояние непосредственно связанных с
ним условий: предусловия возникновения события перестают существовать,
а вместо них возникают постусловия совершения события. Для элементарной
сети на рис.16.3 факт срабатывания разрешенного перехода t1 отмечается из-
менением маркировки: маркер, находившийся в позиции p1 в результате сра-
батывания перехода t1 перемещается в позицию р2 (рис. 16.3 б).
В общем виде, когда переход связан со своими позициями не ординар-
ными, а кратными дугами, правило срабатывания перехода звучит так: при
срабатывании перехода t1 он изымает из каждой своей входной позиции
столько маркеров, какова кратность дуги, связывающей этот переход с ука-
занной позиции, и добавляет в каждую свою выходную позицию количество
маркеров, равное кратности связывающих их дуг как показано на рис. 16.4.

180
 а) б)
Рисунок 16.4 – Срабатывание перехода общего вида

Здесь переход t1 имеет две входных и одну выходную позицию

(рис. 16.4 а), причем входная позиция p1 содержит два маркера, а позиция p2
– пять маркеров. Позицию p1 связывает с переходом t1 ординарная дуга, а по-
зицию p2 – дуга, кратность которой равна трем. Очевидно, что переход t1 мо-
жет сработать, так как количество маркеров в его входных позициях больше
кратности дуг, связывающих эти позиции с переходом. При срабатывании
перехода t1 из позиции p1 будет извлечен один маркер, а из позиции p2 – три
маркера. Выходная позиция p3 связана с переходом t1 дугой с кратностью 2,
поэтому результатом срабатывания перехода будет помещение в позицию p3
двух маркеров (рис. 16.4 б). Таким образом, в результате срабатывания пере-
хода t1 маркировка позиций сети изменится и будет следующей: в p1 содер-
жится один маркер, в p2 – два маркера и в p3 – два маркера. Необходимо от-
метить, что переход t1 при такой новой разметке не может сработать еще раз:
количество маркеров в p2 меньше, чем кратность дуги, связывающей эту по-
зицию и переход. Переход будет запрещен до тех пор, пока в позицию p2 не
добавится хотя бы один маркер.
Достоинством сети Петри является ее открытость для расширений и мо-
дификаций, усиливающих выразительные возможности сети как аппарата
моделирования в конкретной прикладной области.
Управление производственной системой можно выразить функцией ее
состояния. В терминах сети Петри это сводится к необходимости управлять
181
переходами сети в зависимости от маркировок ее позиции. Сеть Петри фор-
мально представляется как набор вида:
N={P, Т, F, Н, 0},
где Р – конечное непустое множество позиций рР (состояний);
Т – конечное непустое множество переходов tT (событий);
F – функция входных инциденций (матрица F: TP);
Н – функция выходных инциденций (матрица H: TP);
0 – начальная маркировка (разметка) сети.
Множества входных и выходных позиций перехода tT обычно обозна-
чают соответственно (*t) и (t*), а множества входных и выходных переходов
для позиции рР обозначают соответственно (*р) и (p*).
При маркировке всем позициям сети Петри приписываются некоторые
натуральные числа. Число маркеров в позиции равно значению функции
маркировки : P{0, 1,2,...}. Если мощность множества Р равна n, то марки-
ровку можно представить n-мерным вектором, значения координат которого
равны числу маркеров в соответствующих позициях.
Переход от одной маркировки к другой осуществляется посредством
срабатывания переходов. Переход t может сработать при маркировке i, если
он является возбужденным, т. е.:
i(p) - F(p, t)  0,  pР, (16.1)
где F(p, t) – функция входных инциденций.
Это условие показывает, что в каждой входной позиции перехода t чис-
ло маркеров не меньше веса дуги, соединяющей эту позицию с переходом. В
результате срабатывания перехода t, удовлетворяющего условию (16.1), мар-
кировка k заменяется маркировкой k+1 по следующему правилу:
k+1(p) = k(р) – F(p, t) + Н(p, t),  p Р,
где H(p, t) – функция выходных инциденций.
То есть в результате срабатывания из всех входных позиций перехода t
изымается F(p, t) маркеров и в каждую выходную позицию добавляется
182
H(t, р) маркеров. Следовательно, маркировка k+1 непосредственно достижи-
ма из маркировки k , что обозначается как kk+1.
Функционирование сети Петри осуществляется путем последовательной
смены маркировок  в результате срабатывания возбужденных переходов.
Состояние сети в данный момент времени определяется ее текущей
маркировкой.
Возможные варианты функционирования сети описываются с помощью
графа достижимости.
Графом достижимости называется граф, вершинами которого явля-
ются возможные маркировки. Маркировки k и k+1 соединяются направлен-
ной дугой, помеченной символом перехода tT, если kk+1. Построение
графа достижимости рассмотрим на примере сети Петри, представленной на
рис. 16.5.

Рисунок 16.5 – Представление графа сети Петри

Множество позиций, переходов и начальная маркировка данной сети за-

даны как:

183
 Р = {p1, р2, рз, p4, p5};
T = {t1, t2, t3, t4};
µ0 = (1, 1, 0, 0, 0).
Функции F(p, t) и H(p, t) задаются матрицами:

p1 p2 p3 p4 p5 p1 p2 p3 p4 p5
t1 1 1 0 0 0 t1 0 0 1 2 0
t2 0 0 1 0 0 t2 1 0 0 0 1
F= ; H=
t3 0 0 0 1 0 t3 1 1 0 0 0
t4 0 0 0 0 1 t4 0 0 0 1 0

Содержательная часть позиций Рi и переходов tj должна быть определена

словесно или с помощью предварительно оговоренных символов.
Фрагмент графа достижимости для данного примера сети Петри может
быть представлен следующим образом (табл. 16.1).
Таблица 16.1
Граф достижимости для примера по рисунку 16.5

184
 16.2. Имитационные модели робототехнических систем на основе
сетей Петри

Рассмотрим иерархически связанные имитационные модели, использу-

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

16.2.1. Моделирование однопозиционного РТК сетями Петри

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

рудования в РТК посредством ПР.
Промышленный робот имеет позиционную систему управления и обес-
печивает захват заготовки с приемно-передающего стола (ППС), ее транс-
портирование и установку в патрон шпинделя токарного станка (ТО). ПР об-

185
ладает тремя степенями подвижности по координатам X, Y, Z. Схема загруз-
ки станка представлена на рис. 16.6.

Рисунок 16.6 – Схема загрузки станка

Сгенерируем модель загрузки в виде сети Петри (рис. 16.7).

Цикл загрузки станка: при условии свободного состояния ППС на него
выдается заготовка из входного накопителя и промышленный робот берет
схватом манипулятора заготовку. После захвата заготовки приводы
манипулятора отрабатывают прямой ход: транспортируют, позиционируют и
поджимают заготовку к базе патрона. Зажатие патрона инициирует разжатие
схвата и реверсный ход приводов манипулятора в исходную позицию.
Предполагается, что цикл разгрузки станка осуществляется автоматически при
помощи установленного на станке ловителя.
При условии, что три привода манипулятора параллельно отрабатывают
прямое и реверсное движение, схема может быть упрощена и преобразована в
сеть следующего вида (рис. 16.8).
186
 Рисунок 16.7 – Модель загрузки станка в виде сети Петри

Содержание позиций и переходов сети Петри:

P0 – во входном накопителе присутствует заготовка;
P1 – ППС свободен;
P2 – на выходную позицию ППС подана заготовка;
P3 – станок обработал деталь и ждет разгрузки;

187
P4 – схват сжат, заготовка захвачена;
P5 – привода X,Y,Z отрабатывают прямой ход;
Р6 – патрон станка сжат, заготовка зафиксирована;
P7 – патрон станка разжат, деталь обработана и снята со станка;
P8 – схват разжат и свободен;
P9 – приводы X,Y,Z отрабатывает обратный ход;

Рисунок 16.8 – Сеть Петри при параллельной работе приводов манипулятора

робота

t1 – захват заготовки;
t2 – закрепление заготовки в патроне станка;
t3 – разжатие схвата;
188
 t4 – включение приводов манипулятора на обратный ход (от ТО к ППС);
t5 – выдача заготовки на позицию захвата;
t6 – включение приводов манипулятора на прямой ход (от ППС к ТО).

Построим граф достижимости системы.

При начальной маркировке сети 0{1,1,0,1,1,0,0,0,0,1} (маркировка
графически представлена на рис.16.8) дерево достижимости сети Петри имеет
следующий вид (табл. 16.2).

Таблица 16.2
Дерево (граф) достижимости сети Петри

Цикл работы модели системы включает пять маркировок. Маркировки

1 и 6 совпадают, что свидетельствует о цикличности моделируемого про-
цесса. В данном случае начальная маркировка 0 является запускающей и в
дальнейшем не повторяется.

16.2.2. Моделирование многопозиционного РТК в терминах сетей

Петри

В соответствии с технологическим процессом необходимо последова-

тельно обработать деталь на двух типах технологического оборудования.

189
Обеспечение цикла загрузки-разгрузки технологического оборудования про-
изводится посредством промышленного робота. Расположение оборудова-
ния, обслуживающего робота, и других составляющих РТК представлено на
рис. 16.9 а.

а) б)
Рисунок 16.9 – Компоновка РТК: а) РТК механообработки; б) цикл об-
работки детали

При описании РТК используются следующие сокращения:

ТО1, ТО2 – соответственно первое и второе технологическое оборудо-
вание;
ПР – промышленный робот;
Н1 и Н2 – соответственно входной и выходной накопители.
Цикл обработки детали включает следующую последовательность собы-
тий (рис. 16.9 б).
Промышленный робот ПР при условии его свободного исходного состо-
яния и наличия заготовки в паллете входного накопителя Н1 берет заготовку
из накопителя и устанавливает ее в патрон технологического оборудования
ТО1 (траектория 1). После поджатия кулачковым патроном заготовки в ТО1
промышленный робот освобождается, перемещается к ТО2 (траектория 3) и
осуществляет цикл разгрузки технологического оборудования ТО2, сняв об-
190
работанную деталь и уложив ее на паллету выходного накопителя Н2 (траек-
тория 3). По истечении времени обработки заготовки на технологическом
оборудовании ТО1, робот перемещается к ТО1 (траектория 4) разгружает
станок ТО1 и транспортирует деталь для загрузки технологического обору-
дования ТО2 (траектория 5). По завершении цикла загрузки станка робот пе-
реходит в свободное исходное состояние (траектория 6) и цикл работы РТК
повторяется. Траектории 2, 4 и 6 определяют свободное состояние ПР.
Сеть Петри, моделирующая работу этого РТК, представлена на рис.
16.10.

Рисунок 16.10 – Сеть Петри многопозиционного РТК

Опишем словесно содержание позиций и переходов сети Петри, моде-
лирующей работу рассматриваемого РТК в соответствии с последовательно-
стью технологических операций:
Р0 – входной накопитель РТК, в котором находится теоретически не-
ограниченное количество заготовок;

191
 Р1 - состояние ПР, соответствующее транспортировке заготовки на ТО1
для обработки;
Р2 – ПР свободен и готов к приему заготовки из входного накопителя;
РЗ – обработка заготовки на ТО1;
Р4 – ТО1 свободно и готово к приему заготовки;
Р5 – ПР свободен и готов разгрузить ТО2;
Р6 – состояние транспортирования ПР детали с ТО1 на ТО2;
Р7 – обработка заготовки на ТО2;
Р8 – ТО2 свободен и готов обрабатывать заготовку;
Р9 – состояние транспортировки ПР заготовки от ТО2 к выходному
накопителю Н2;
Р10 – ПР свободен и готов к разгрузке ТО1;
Р11 – выходной накопитель РТК, в котором всегда есть свободная ячей-
ка;
t1 – захват заготовки из входного накопителя H1;
t2 – загрузка заготовки на ТО1;
t3 – разгрузка ТО1;
t4 – загрузка заготовки на ТО2;
t5 – разгрузка ТО2;
t6 – укладка заготовки в выходной накопитель Н2.
Для построения графа достижимости, описывающего возможные
варианты функционирования сети Петри, необходимо определить начальную
маркировку сети: 0{1,0,1,0,1,0,0,1,0,0,0,1} – представленную на рис. 16.10, и
построить матрицу входных и выходных инциденций F и H:

192
 1 0 1 0 0 0 0 0 0 0 0 0 0 1 0 0 0 0 0 0 0 0 0 0
0 1 0 0 1 0 0 0 0 0 0 0 0 0 0 1 0 1 0 0 0 0 0 0
   . 
F=
 0 0 0 1 0 0 0 0 0 0 1 0
; H=
 0 0 0 0 1 0 1 0 0 0 0 0
0 0 0 0 0 0 1 0 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 0
0 0 0 0 0 1 0 1 0 0 0 0
 0 0 0 0 0 0 0 0 1 1 0 0

   
0 0 0 0 0 0 0 0 0 1 0 0 0 0 0 0 0 0 0 0 0 0 1 1

Граф достижимости можно строить, используя непосредственное отсле-

живание движения маркеров по сети Петри.
Последовательность маркировок изображается в виде графа достижимо-
сти (табл. 16.3).
Таблица 16.3
Граф достижимости многопозиционного РТК

Последовательно проходя пять маркировок, система начинает новый

цикл работы. Маркировки 0 и 6 совпадают, то есть 0=6. Таким образом, в
системе отсутствуют тупиковые маркировки, и данная модель системы явля-
ется работоспособной. Граф может быть легко проверен по сети Петри.
Применение сетей Петри дает устойчивые результаты при описании
цикла работы робототехнического оборудования в составе РТК и предопре-

193
деляет возможность расширения системы, что важно при оценке производ-
ственных комплексов в целом.

Вопросы к лекции 16:

1. Какова основная терминология сетей Петри (позиции, переходы, дуги,
маркировки)?
2. Приведите графические изображения позиций, переходов и дуг сетей
Петри.
3. Каковы условия срабатывания переходов сетей Петри?
4. Каково формальное представление сети Петри?
5. Представьте функцию входных инциденций в матричном виде для
анализируемого РТК.
6.Представьте функцию выходных инциденций в матричном виде для
анализируемого РТК.
7. Поясните понятие «граф достижимости» и его применение для анали-
за работоспособности РТК в терминалах сетей Петри.
8. Поясните порядок моделирования работы РТК в терминалах сетей
Петри.

Использованная литература

1. Автоматизированное решение прямой задачи кинематики манипулято-

ров роботов на ПЭВМ / Хомченко В.Г., Соломин В.Ю, Яровой В. Н. Методи-
ческие указания к лабораторно-практическим работам. – Омск, ОмГТУ, 2007.
– 36 с.
2. Афонин В.Л., Макушкин В.А. – Интеллектуальные робототехнические
системы: курс лекций, уч. пособие – М.: интернет – ун – т информ. техноло-
гий, 2005. – 205с.

194
3. Бурдаков С.Ф. и др. Проектирование манипуляторов промышленных
роботов и роботизированных комплексов: Уч. пособие. – М.: Высшая школа,
1986-264 с.
4. Зенкевич С.А. Основы управления манипуляционными роботами / Зен-
кевич С.А., Ющенко А.С. Учебное пособие для вузов – 2-е изд. М.: Изд-во
МГТУ им. Н.Э. Баумана, 2004. – 480 с.
5. Лукинов А.П. Проектирование мехатронных и робототехнических
устройств: Учебное пособие. – СПб.: Изд-во «Лань», 2012. – 608 с.
6. Механика промышленных роботов: Под ред. К.В.Фролова,
Е.И.Воробьева. Кн.1: Кинематика и динамика/ Е.И.Воробьев, С.А.Попов,
Г.И.Шевелева. М. Высш.шк., 1988.-304 с.
7. Подураев Ю. В. Мехатроника: основы, методы, применение: Учебное
пособие для вузов – М.: Машиностроение, 2006. – 256 с.
8. Фу К., Гонсалес Р., Ли К. Робототехника: - М.: Мир, 1989. –624 с.
9. Хомченко В. Г. Моделирование дискретных систем посредством сетей
Петри. Методические указания к расчетно-графической работе по курсу
«Проектирование роботов и робототехнических систем»/ Хомченко В. Г.,
Соломин В. Ю. – Омск, ОмГТУ, 2007. – 20 с.
10. Хомченко В.Г. Метод виртуальных поворотов в решении обратной за-
дачи кинематики платформенного типа/ Омский научный вестник. - №2
(140). – Серия Приборы, машины и технологии. – 2015. – с.41-44
11. Шахинпур М. Курс робототехники: – М. Мир, 1990.-527 с.

195