Подходы к моделированию и управлению манипуляторами. Требования к разрабатываемому устройству, его функциональность и возможности, сферы практического применения. Построение структурной кинематической схемы. Порядок сборки и тестирования манипулятора.
Манипулятор - совокупность пространственного рычажного механизма и системы приводов, осуществляющая под управлением программируемого автоматического устройства или человека-оператора действия (манипуляции), аналогичные действиям руки человека. Целью данной работы является разработка кинематической схемы трехстепенного манипулятора и построение трехмерной модели его конструкции, моделирование компьютерной динамической модели манипулятора, выполнить анализ движения модели робота при различных условиях, определить некоторые характеристики робота на основе моделирования, проектирование отдельных деталей и изготовление их при помощи 3D печати, сборка робота, разработка системы управления манипулятором на основе Arduino [3]. В данной работе будет разрабатываться манипулятор ангулярного типа т.к. вращательные кинематические пары наиболее просты в конструкции и легко реализуемы, также такая конструкция имеет довольно обширную рабочую зону и своей гибкостью позволяет обходить некоторые препятствия. Но реализация системы управления для такой конструкции будет вызывать некоторые трудности т.к. для передвижения рабочего органа манипулятора по декартовым координатам потребуется управлять углами поворотов звеньев робота, причем отклонения поворота каждого звена от нужного значения вносят суммирующее воздействие на погрешность положения рабочего органа. Решение обратной задачи: Задаем длины звеньев, мм: Задаем координаты положения точки схвата: Решение задачи: Находим проекцию точки P4 на плоскость OXY: Находим проекцию точки P3 на плоскость OXY: Смещаем вниз координату z точки P3 на длину L0: Находим расстояние между началом координат и точкой P3: Находим угол q0: 1 ое и 2 ое звенья и отрезок B образуют треугольник, т.к. мы знаем их длины, то можем определить углы этого треугольника по формулам: Найдем угол q01: Найдем угол q0r: Найдем угол q02: Найдя углы треугольника можно определить углы поворотов звеньев: Найдем значения углов в градусах: Решение показывает, что подставив значения координат из решения прямой задачи в обратную задачу и решив ее, получим значения углов такие же как задавали в прямой задачи, что подтверждает правильность решения этих задач.4.7), при этом средняя угловая скорость поворота каждого звена составляла 1.57 рад/с, достигнув каждого положения манипулятор останавливался на 0.5 сек. На рисунке 4.8 показаны графики: угол поворота q1 1 ого звена, сила F, момент M, угловая скорость ? и угловое ускорение а, зависящие от времени. В начальный момент времени, когда манипулятор в положении «1» угол поворота 1 ого звена считается нулевым. Модель манимулятора ставится в положение с максимально вытянутой рукой вперед, на ось 1 го звена задается вращающий момент М=1.86 Н*м, который сможет развить сервопривод, схват манипулятора держит груз, масса которого m постепенно увеличивается до тех пор, пока силы момента не хватит чтобы его поднять (Рис. Окончательно имеем уравнения описывающие динамику движения манипулятора, где сила, которую должен развить силовой привод i-го сочленения, чтобы реализовать данное движение: , Для сравнения работы математической и компьютерной динамических моделях манипулятора был вычислен график зависимости момента от времени в сочленении 2-го и 1-го звеньев.В ходе выполнения работы была построена кинематическая схема трехстепенного манипулятора, в которой использовался параллельный механизм для того чтобы схват манипулятора оставался параллельно основанию. Рабочая зона строилась при помощи динамической модели манипулятора, в которой манипулятор прошелся через все крайние положения рабочей зоны. В динамической модели были определены зависимости различных велечин таких как: сила, момент, угловая скорость и угловое ускорение, которые действовали на оси поворотов звеньев и основания. Также было смоделировано как вращающий момент, который развивают реальные сервоприводы, действовал на движение звеньев манипулятора. Компьютерная программа позволяет управлять манипулятором в различных режимах как вручную - управление каждым звеном манипулятора по отдельности или передвижением рабочей точки по осям координат, так и управление в автоматическом режиме, когда программируются различные позиции, по которым должен пройти манипулятор.Код Matlab для вычисления математической динамической модели манипулятора#include «Servo.h» int q0, nq0 = 94; // начальное положене угла серво0 int q1, nq1 = 144; // начальное положене угла серво1 int q2, nq2 = 180; // начальное положене угла серво2 int q3, nq3 = 50; // начальное положене угла серво3 float p0, p1, p2, p3; servo0.attach(6); // серво1 подключен к пин 6 servo1.attach(8); // серво1 подключен к пин 8 servo2.attach(10); // серво2 подключен к пин 10 servo3.attach(12); // серво3 подключен к пин 12 q0 = nq0; servo0.write(q0); // Повернуть серво0 на q0 градусов servo1.write(q1); // Повернуть серво1 на q1 градусов servo2.write(q2); // Повернуть серво2 на q2 градусов servo3.write(q3); // Повернуть серво3 на q3 градусов p0=q0; servo0.
Введение
манипулятор управление моделирование
Манипулятор - совокупность пространственного рычажного механизма и системы приводов, осуществляющая под управлением программируемого автоматического устройства или человека-оператора действия (манипуляции), аналогичные действиям руки человека.
Промышленные роботы предназначены для замены человека при выполнении основных и вспомогательных технологических операций в процессе промышленного производства. При этом решается важная социальная задача - освобождения человека от работ, связанных с опасностями для здоровья или с тяжелым физическим трудом, а также от простых монотонных операций, не требующих высокой квалификации. Гибкие автоматизированные производства, создаваемые на базе промышленных роботов, позволяют решать задачи автоматизации на предприятиях с широкой номенклатурой продукции при мелкосерийном и штучном производстве. Промышленные роботы являются важными составными частями современного промышленного производства [1].
Компьютерное моделирование робототехнических систем имеет огромное значение в областях науки и техники. Огромное множество трудоемкой физической работы человека в настоящее время заменено роботами, а компьютерные устройства, системы компьютерной математики значительно облегчили громоздкие вычисления и преобразования, сведя их к минимуму.
Компьютерная модель - компьютерная программа, реализующая абстрактную модель некоторой системы. Компьютерные модели используются для получения новых знаний о моделируемом объекте или для приближенной оценки поведения математических систем, слишком сложных для аналитического исследования.
Компьютерное моделирование является одним из эффективных методов изучения сложных систем. Компьютерные модели проще и удобнее исследовать, в тех случаях когда реальные эксперименты затруднены изза финансовых или физических препятствий или могут дать непредсказуемый результат. Логичность и формализованность компьютерных моделей позволяет выявить основные факторы, определяющие свойства изучаемого объекта. [2]
Целью данной работы является разработка кинематической схемы трехстепенного манипулятора и построение трехмерной модели его конструкции, моделирование компьютерной динамической модели манипулятора, выполнить анализ движения модели робота при различных условиях, определить некоторые характеристики робота на основе моделирования, проектирование отдельных деталей и изготовление их при помощи 3D печати, сборка робота, разработка системы управления манипулятором на основе Arduino [3].
Манипулятор по принципу действия напоминает человеческую руку. В нем присутствуют поворотные соединения, которые обеспечивают наклон в плечевом соединении и сгибание в локте, механический захват, который позволит роботу хватать и перемещать предметы в разных направлениях.
Отличительная черта данной конструкции - очень высокая гибкость, позволяющая роботу обходить многие препятствия. Кроме того, робот этого типа достаточно компактен, и обслуживаемая им зона гораздо больше, чем занимаемое роботом место.
Несмотря на очевидные преимущества конструкции, управлять таким роботом достаточно сложно. При перемещении каждого звена принцип минимального значения требуемого угла, и манипулятор движется не по прямой линии (как декартов, например), а выполняет довольно сложную траекторию, имитируя движения живой руки. В результате мысленное представление всех движений «руки» сильно затруднено, что создает трудности при программировании. [4]
1. Подходы к моделированию и управлению манипуляторами
1.1 Типы манипуляторов
Первый вопрос, с которым сталкивается создатель манипулятора, - выбор его кинематической схемы, структуры его скелета. В процессе выполнения операций с объектами манипулирования в большинстве случаев манипуляторы имитируют движение рук человека. Поэтому структурная схема манипулятора должна обладать кинематическими характеристиками, аналогичными характеристикам руки человека.
Манипулятор должен иметь по крайней три степени подвижности, необходимые для перемещения инструмента в любую точку зоны обслуживания. Каждая степень подвижности манипуляционного робота управляется индивидуальным приводом, в результате чего исполнительный орган получает направленное вполне определенное движение. В современных манипуляторах используют электромеханические, гидравлические, пневматические или комбинированные приводы.
Существует большое количество схем манипуляторов, различным образом реализующих региональные движения, но наиболее распространенными в промышленности являются пять следующих схем с одноподвижными кинематическими парами: Декартовый тип. Манипулятор (рис. 1.1), функционирующий в декартовой (прямоугольной) системе координат, прост в управлении и отличается высокой точностью действий. Схват манипулятора поступательно перемещается вдоль трех основных осей: х, у и z (т.е. слева направо, вперед-назад и вверх-вниз).
Рис. 1.1. Манипулятор декартового типа
Цилиндрический тип. Манипулятор (рис. 1.2), работающий в цилиндрической системе координат. Его схват может выдвигаться и втягиваться, а также перемещаться вверх и вниз вдоль стойки. Кроме того, весь узел манипулятора может поворачиваться вокруг оси основания, но не на полный оборот, что позволяет ему выполнять операции в окружающей цилиндрической зоне.
Рис. 1.2. Манипулятор цилиндрического типа
Сферический тип. Манипулятор (рис. 1.3), действующий в сферической (или полярной) системе координат. Его схват может выдвигаться и втягиваться. Вертикальные перемещения манипулятора достигаются путем поворота его в вертикальной плоскости в «плечевом» суставе. Весь узел манипулятора может также поворачиваться вокруг оси основания. Зона действия подобного манипулятора представляет усеченную сферу. Первые модели промышленных роботов были сконструированы именно по этому принципу.
Рис. 1.3. Манипулятор сферического типа
Ангулярный тип. Шарнирный манипулятор (рис. 1.4), действующий в ангулярной системе координат, не имеет поступательных кинематических пар, а имеет только вращательные кинематические пары. Манипулятор такого типа очень напоминает руку человека, поскольку имеет «плечевое» и «локтевое» сочленения, а также «запястье». Его зона обслуживания значительно больше, чем у роботов других типов. Он способен обходить препятствия гораздо более разнообразными путями и даже складываться, но вместе с тем он исключительно сложен в управлении.
Рис. 1.4. Манипулятор ангулярного типа
Тип SCARA. Своеобразную схему имеет манипулятор системы SCARA (рис. 1.5), представляющий собой вариант манипулятора с цилиндрической системой координат. Все кинематические пары этого манипулятора располагаются в горизонтальной плоскости, благодаря чему механизм способен разворачиваться подобно складной ширме. Его зона обслуживания имеет цилиндрическую форму.
Рис. 1.5. Манипулятор SCARA типа
Перспективными представляются роботы еще двух типов. Первый из них, «Spine» (рис. 1.6), спроектирован специалистами фирмы «Спайн роботикс». В нем используется длинный хоботоподобный манипулятор, состоящий из множества чечевицеобразных дисков, которые соединены между собой двумя парами тросов, обеспечивающих натяжение. Тросы соединены с поршнями гидравлических цилиндров, которые, создавая натяжение, вызывают перемещение манипулятора. Специальные датчики передают на систему управления информацию о положении манипулятора и его кисти. Такой робот отличается чрезвычайно большой гибкостью, значительным радиусом действия и высокой маневренностью.
Рис. 1.6. Манипулятор Spine типа
Другой робот маятникового типа (рис. 1.7), IR B1000, разработан специалистами фирмы ASEA; его манипулятор подвешен подобно маятнику с двойным карданным подвесом и может перемещаться по направляющим относительно продольной и поперечной осей. По утверждению специалистов фирмы ASEA, это устройство движется в 1,5 раза быстрее, чем традиционные манипуляторы, что обеспечивает высокую производительность. [5]
Рис. 1.6. Манипулятор маятникового типа
В данной работе будет разрабатываться манипулятор ангулярного типа т.к. вращательные кинематические пары наиболее просты в конструкции и легко реализуемы, также такая конструкция имеет довольно обширную рабочую зону и своей гибкостью позволяет обходить некоторые препятствия. Но реализация системы управления для такой конструкции будет вызывать некоторые трудности т.к. для передвижения рабочего органа манипулятора по декартовым координатам потребуется управлять углами поворотов звеньев робота, причем отклонения поворота каждого звена от нужного значения вносят суммирующее воздействие на погрешность положения рабочего органа.
1.2 Классификация манипуляторов
Манипуляторы составляют 85-90% всех роботов в мире.
Классификация роботов по назначению в промышленности: · Керамическая промышленность: выдавливание керамического сырья, загрузка вальцовых (крокетных) машин, извлечение сформованных изделий, складирование, покрытие глазурью путем окунания, нанесение глазури пульверизатором, шлифовка изделия после обжига, загрузка и разгрузка печей;
· Стекольная промышленность: загрузка и разгрузка машин;
По степени универсальности: · универсальные (для выполнения разных операций совместно с различными видами оборудования);
· специализированные (выполняет одну операцию из нескольких возможных с различным оборудованием);
· специальные (выполняет конкретную операцию с одним типом оборудования).
По виду технологических операций: · осуществляющие основные технологические операции;
· выполняющие вспомогательные технологические операции по обслуживанию технологического оборудования (средства автоматизации).
По показателям, определяющим их конструкцию: · тип приводов робота (электрический, гидравлический, пневматический);
· грузоподъемность (сверхлегкие - до 1 кг; легкие - от 1 до 10 кг; средние 10?200 кг; тяжелые - 200?1000 кг; сверхтяжелые - свыше 1000 кг);
· количество манипуляторов (от 1 до 4 рук);
· тип и параметры рабочей зоны манипуляторов (прямоугольная, цилиндрическая, сферическая, угловая (ангулярная) и различные их комбинации).);
· подвижность робота определяется наличием или отсутствием у него устройства передвижения (подвижный или стационарный).
· по способу размещения стационарные и подвижные роботы бывают напольными, подвесными (перемещаются по монорельсу), встраиваемые в другое оборудование (в станок или др.);
· по исполнению робота - зависит от назначения (нормальное, пылезащитное, теплозащитное, влагозащитное, взрывобезопасное и т.п.).
По способу управления: · с программным управлением;
· с адаптивным управлением;
· с интеллектуальным управлением.
По быстродействию движений: · малое быстродействие - до 0,5 м/с;
· среднее - линейные скорости от 0,5 до 1 м/с (~80% роботов);
· высокое - свыше 1 м/с (~20% роботов).
По точности движений: · малая точность - при линейной погрешности от 1 мм и выше;
· средняя - от 0,1 до 1 мм (больше всего роботов);
· высокая - менее 0,1 мм.
Параметры, определяющие технический уровень роботов: · надежность;
· число одновременно работающих степеней подвижности;
· время программирования;
· удельная грузоподъемность (отнесенная к массе робота);
· выходная мощность манипулятора (произведение грузоподъемности на скорость перемещения), отнесенная к мощности его приводов;
· относительные оценки габаритных параметров и т.п.
Эти параметры служат критериями качества, предназначенные для их оптимизации при проектировании и сравнительной оценки роботов. [6]
Разрабатываемый в данной работе трехстепенной манипулятор будет иметь следующие параметры классификации: · степень универсальности - специальный, предназначен для переноски небольших легких предметов;
· тип приводов - электрический;
· грузоподъемность - сверхлегкий (до 1 кг);
· тип рабочей зоны - ангулярная;
· подвижность робота - стационарный;
· способ размещения - напольный;
· способ управления - программный и ручной;
· быстродействие движений - малое быстродействие (до 0,5 м/с);
· точность передвижений - малая точность (погрешность боле 1 мм).
1.3 Системы управления манипулятором
Системами управления оснащены все манипуляторы, у которых перемещение подвижных звеньев осуществляются с помощью различных немеханических приводов.
Система управления современного манипулятора состоит из нескольких подсистем, выполняющих определенные информационные, управляющие, защитно-предупредительные, ограничительные и другие функции.
Различают три основных вида управления ПР: цикловое, позиционное, контурное. Цикловое управление программирует последовательность выполнения движений и условия начала и окончания движений; положение, до которой идет движение, задаются на самом манипуляторе, а не в программе; скорость перемещения определяется характеристиками привода и также не задается в программе. При позиционном управлении команды подаются так, что перемещение рабочего органа происходит от точки к точке, причем положения точек задаются программой. Скорость перемещения между точками не контролируется и не реализуется. При контурном управлении движение рабочего органа происходит по заданной траектории с задаваемой скоростью. В программе задаются сами траектории и режимы движения. Контурное управление используется значительно в технологических работах.
Устройство управления и другие блоки системы управления при цикловом, позиционном и контурном управлениях могут быть реализованы на одинаковых или разных принципах и элементных базах. В особый вид обычно выделяется адаптивное управление, при котором осуществляется автоматическое изменение управляющих программ. В частности адаптация или приспособленность системы управления может заключаться в том, что устройства системы управления с помощью специальных датчиков определяют конфигурацию объекта и его положения.
Все основные ПР образуют систему управления. Объектом управления является исполнительное устройство (манипулятор плюс устройство передвижения, если оно есть). В исполнительное устройство также входят приводы. Все остальное оборудование робота предназначено для формирования и выдачи управляющих воздействий исполнительному устройству. Таким образом, устройство управления получает сигналы (от датчиков) и выдает сигналы (на приводы манипулятора).
Для пульта ручного управления основными являются связи с устройством управления. С пульта ручного управления могут осуществляться ввод программ, настройка. На пульт управления поступают сигналы о выполнении различных движений, а также о возможных нарушениях режимов работы и об отказах. Следует иметь в виду, что в устройство управления обычно поступают сигналы от внешних (по отношению к роботу) датчиков и систем (например, от систем управления обслуживаемым оборудованием). Устройство управления роботом также может быть связано с ЭВМ, координирующей работу нескольких единиц оборудования, например всего оборудования технологического участка или линии. В этих случаях эта ЭВМ как бы находится на более высоком этаже, на следующем уровне управления. Такая многоуровневая система управления типична для современных гибких производственных систем. [7]
В данной работе системой управления манипулятором будет микроконтроллер Arduino, который будет получать сигналы управления с компьютера через COM порт. Все вычисления будут выполняться на компьютере, микроконтроллер будет отвечать за повороты сервоприводов робота. Через программу в компьютере можно будет управлять манипулятором вручную, т.е. поворачивать звенья манипулятора или передвигать рабочую точку робота по декартовым осям координат. Также будет режим программирования, где рабочая точка робота будет перемещаться от положения к положению, т.е. реализуется позиционная система управления.
1.4 Способы моделирования манипуляторов
Моделирование играет ключевую роль в области роботостроения, потому что оно позволяет проводить эксперименты, которые в ином случае были бы дорогими и / или требовали больших затрат времени [8].
С помощью компьютерной динамической модели робота-манипулятора можно определить диапазон углов поворотов звеньев и рабочую зону робота с учетом ограничений его конструкции, а также определить различные возникающие моменты и силы в узлах конструкции. Разработка модели робота играет ключевую роль при его проектировании.
Существуют различные подходы к разработке динамической модели робота-манипулятора. Есть математические и компьютерные динамические модели.
Математическая динамическая модель манипулятора может быть построена на основе известных законов ньютоновской или лагранжевой механики. Результатом применения этих законов являются уравнения, связывающие действующие в сочленениях силы и моменты с кинематическими характеристиками и параметрами движения звеньев. Таким образом, уравнения динамики движения реального манипулятора могут быть получены традиционными методами Лагранжа-Эйлера или Ньютона-Эйлера.
Вывод уравнений динамики движения манипулятора методом Лагранжа-Эйлера отличается простотой и единством подхода и основан на следующем: 1. На описании взаимного пространственного расположения систем координат i-го и (i-1) - го звеньев с помощью матрицы преобразования однородных координат.
2. На использовании уравнения Лагранжа-Эйлера
С целью получения более эффективных с вычислительной точки зрения алгоритмов расчета обобщенных сил и моментов используются уравнения Ньютона-Эйлера. Вывод уравнений Ньютона-Эйлера прост по содержанию, но весьма трудоемок. Результатом является система прямых и обратных рекуррентных уравнений, последовательно применяемых к звеньям манипулятора.
Уравнения Лагранжа-Эйлера обладают низкой вычислительной эффективностью, это обусловлено тем, что для описания кинематической цепи используются матрицы преобразования однородных координат. Уравнения Ньютона-Эйлера обладают большей вычислительной эффективностью, что связано с их векториальным представлением и их рекуррентной природой. [9]
Для построения компьютерной динамической модели робота используются программы предназначенные для моделирования динамики и кинематики пространственных механических систем, например: MSC.ADAMS [10]; UM [11]; Unigraphics NX [12]; CATIA [13]; SOLIDWORKS [14].
Создание модели подразумевает описание всех ее характеристик: геометрических размеров, физических свойств, способов соединения подвижных и неподвижных частей, задание действующих сил и моментов, начального положения элементов модели и их скоростей. Этап тестирования модели включает в себя моделирование поведения частей модели под действием приложенных сил и заданных движений и выявление критических параметров, наиболее сильно влияющих на эффективность работы модели в целом.
В данной работе динамическая модель робота-манипулятора будет строиться в программной среде MSC.ADAMS, предназначенной для виртуального моделирования сложных механизмов. Широкие возможности программного пакета, высокая надежность и малая трудоемкость его использования позволяют исследовать множество вариантов механизмов, моделируя на компьютере реальные условия их работы, сравнивать и выбирать лучший вариант [15]. Также для сравнения с компьютерной моделью будет выведена математическая динамическая модель с использованием уравнений Лагранжа-Эйлера.
2. Требования к разрабатываемому устройству
1. Разрабатываемое устройство должно обладать следующими свойствами: · Основание, поворачивающееся вокруг своей оси, способное крепиться к горизонтальной плоской поверхности;
· Два звена, имеющих длину по 20 см с шарнирными соединениями;
· Механический схват, способный схватить легкие предметы диаметром до 7 см.
2. Построить кинематическую схему робота.
3. Разработать трехмерную модель конструкции трехстепенного манипулятора с механическим захватом.
4. В трехмерной модели определить диапазоны углов поворотов звеньев с учетом ограничений конструкции робота.
5. Построить компьютерную динамическую модель робота, с помощью которой определить: · Рабочую зону манипулятора;
· Скорости, ускорения, силы и моменты, возникающие в шарнирах звеньев манипулятора при различных условиях;
· Максимальную грузоподъемность робота.
6. Изготовить детали звеньев и захвата манипулятора при помощи 3D печати.
7. Собрать манипулятор.
8. Разработать систему управления манипулятором на основе Arduino.
9. Разработать компьютерную программу для управления манипулятором, которая позволит: · Вручную управлять поворотами каждого звена по отдельности а также схватом;
· Управлять передвижением рабочей точки манипулятора вдоль осей X, Y, Z декартовой системы координат.
· Управлять скоростью движения манипулятора;
· Позволить программировать манипулятор для автоматического передвижения через конкретные точки.
10. Проанализировать работу конструкции манипулятора и программу управления манипулятором и сделать выводы.
Перед разработкой трехмерной модели конструкции манипулятора необходимо составить его структурную кинематическую схему (Рис. 3.1). Для начала необходимо определить тип манипулятора. Было решено разработать манипулятор ангулярного типа т.к. вращательные кинематические пары наиболее просты в конструкции и легко реализуемы, также такая конструкция имеет довольно обширную рабочую зону и своей гибкостью позволяет обходить некоторые препятствия. Также по заданию манипулятор должен иметь всего 3 степени подвижности: поворот основания вокруг своей оси и повороты 1 го и 2 го звеньев. Чтобы схват захватывал объекты правильно, он должен быть направлен в определенной ориентации, для этого в кинематическую схему добавлен специальный механизм для удержания схвата в неизменной ориентации.
Кинематическая схема разрабатывалась на основе реального промышленного робота Fanuc M-410IB/450 [16] (Рис. 3.1), который имеет 4 степени подвижности и используется для переноски груза.
Рис. 3.1. Промышленный манипулятор Fanuc M-410IB/450 и его рабочая зона
Разработанная кинематическая схема трехстепенного манипулятора указана на рисунке 3.1. На схеме указаны 1 ое и 2 ое звенья, которые поворачиваются на углы q1 и q2, основание, вокруг которого манипулятор поворачивается на угол q0, и схват, а также проставлены длины всех частей манипулятора.
Рис. 3.1. кинематическая схема манипулятора
В этой кинематической схеме используются некоторые дополнительные звенья и элементы, которые образуют параллельный механизм, который позволяет схвату манипулятора оставаться всегда параллельно основанию независимо от того, на какие углы q1 и q2 повернуться звенья манипулятора На рисунке 3.2 (а, б, в, г) показан принцип работы параллельного механизма, на котором видно что при изменении углов поворота звеньев, схват робота сохраняет параллельное положение относительно основание. Данное свойство удобно для захвата, перемещения и установления объекта в новое положение, при этом сохраниться его вертикальная ориентация. Так же отпадает необходимость ставить 3е управляемое звено. Несмотря на множество шарнирных соединений в данной схеме для ориентации манипулятора используется всего 3 сервопривода, которые расположены в точках углов поворотов звеньев q0, q1, q2, еще один сервопривод нужен для сжатия / разжатия схвата.
Рис. 3.2. принцип работы параллельного механизма
3.2 Решение прямой и обратной задачи кинематики
Прямая задача - это определение положений звеньев манипулятора при заданных углах поворота соединений и размеров звеньев.
Обратная задача - это определение углов поворота при заданных координатах положения рабочей точки манипулятора
Пред решением задач составим структурную схему (Рис. 3.3) с нужными для решения обозначениями.
Рис. 3.3. Структурная схема с обозначениями
В данной схеме: q0, q1, q2 - углы поворота;
L0, L1, L2, L3 - длины звеньев;
P0, P1, P2, P3, P4 - точки положения звеньев
Все вычисления для прямой и обратной задач проводились в среде Mathcad.
Решение прямой задачи: Задаем углы и расстояния:
Задаем длины звеньев, мм: Матрицы переноса: Матрицы поворота:
Вычисление матриц положения точек:
Координаты точек манипулятора:
На рисунке 3.4 изображено решение прямой задачи
Рис. 3.4. Решение прямой задачи
Для наглядного представления решения обратной задачи показана геометрическая схема на рисунке 3.5.
Рис. 3.5. Решение обратной задачи
Решение обратной задачи: Задаем длины звеньев, мм: Задаем координаты положения точки схвата: Решение задачи: Находим проекцию точки P4 на плоскость OXY:
Находим проекцию точки P3 на плоскость OXY:
Смещаем вниз координату z точки P3 на длину L0:
Находим расстояние между началом координат и точкой P3:
Находим угол q0:
1 ое и 2 ое звенья и отрезок B образуют треугольник, т.к. мы знаем их длины, то можем определить углы этого треугольника по формулам: Найдем угол q01:
Найдем угол q0r: Найдем угол q02:
Найдя углы треугольника можно определить углы поворотов звеньев:
Найдем значения углов в градусах:
Решение показывает, что подставив значения координат из решения прямой задачи в обратную задачу и решив ее, получим значения углов такие же как задавали в прямой задачи, что подтверждает правильность решения этих задач.
3.3 Выбор сервоприводов
Поворот звеньев манипулятора и сжатие / разжатие захвата будут осуществлять цифровые сервоприводы. При длине двух звеньев (по 20 см каждое) и с учетом размера захвата приблизительная максимальная длина манипулятора будет 57 см. Чтобы определить мощность, необходимую сервоприводу для поднятия манипулятора, нужно определить вес манипулятора. Для этого нужно учесть вес сервоприводов и деталей звеньев и захвата. Сервопривод весит в среднем 60 грамм, т.к. их 3, то общий их вес 180 грамм, остальные детали будут сделаны из пластика и металла, в целом вес робота должен быть около 500 грамм без основания. Допустим что масса робота примерно распределена равномерно вдоль всей его длины, следовательно, при закрепленном основании и расположении звеньев робота перпендикулярно силе тяжести, масса в рабочей точке робота будет 250 грамм (Рис. 3.6).
Рис. 3.6. Примерная оценка массы робота
При массе 250 грамм в рабочей точки и длине робота в 57 см, момент на валу сервопривода будет 14,25 кг*см при условии, что захват робота будет без груза.
Доступные в данный момент сервоприводы с достаточно большим моментом были сервоприводы DF15RMG (Рис. 3.7) для работы 1 го звена манипулятора и RDS3115 (Рис. 3.8) для работы 2 го звена, эти сервоприводы практически идентичны по характеристикам и одинаковые по размерам.
Рис. 3.7. Внешний вид DF15RMG с дополнительными кронштейнами
Спецификации для сервопривода DF15RMG: - угол поворота: 170°
- Скорость поворота: 60°/0.16s
- Момент: 19.3 кг•см при 7.4V
- Металлические шестерни
- Размеры: 40x40x20 мм
- Вес: 65 г.
- Рабочее напряжение: 5-7.4v
- Максимальный ток: 3A при 8.5V
- PPM Voltage:3V-5V
- Разрешение: 2 мкс
- Частота: до 4 КГЦ [17]
Рис. 3.8. Внешний вид RDS3115 с дополнительными кронштейнами
Спецификации для сервопривода RDS3115: - угол поворота: 180°
- Скорость поворота: 60°/0.16s
- Момент: 17 кг•см при 7.2V
- Металлические шестерни
- Размеры: 40x40x20 мм
- Вес: 60 г.
- Рабочее напряжение: 4.8-8.4v [18]
Для работы захвата и поворота основания манипулятора будут использованы сервоприводы SR430 (Рис. 3.8). Они развивают меньший момент чем DF15RMG, т.к. для работы захвата и поворота основания не требуется высокий момент.
Рис. 3.8. Внешний вид SR430
Спецификации для сервопривода SR430: - Рабочее напряжение: 6,0 - 7,4 В
- Скорость: 0,18 сек/60° при 6 В
- Усилие на валу: 4,2 кг/см при 6 В
- Скорость: 0,16 сек/60° при 7,4 В
- Усилие на валу: 5,3 кг/см при 7,4 В
- Угол вращения: 180°
- Размеры: 42 x 39,5 x 20,5 мм
- Вес: 44 гр.
- Шестерни редуктора: пластиковые [19]
3.4 Проектирование деталей
Выбор САПР
Для проектирования 3D моделей деталей робота была выбрана программа Google SKETCHUP, т.к. она является одной из простейших программ для 3D моделирования и является бесплатной, а также имеет интерфейс на русском языке. Программа оснащена упрощенным набором инструментов, с которым пользователю работать максимально удобно - это позволит всего лишь за несколько часов освоить работу в программе и начать проектировать самые разные 3D-модели, от простейших геометрических фигур до полномасштабных красивых моделей [20].
Проектирование 1-го и 2-го звеньев
Сервоприводы DF15RMG уже обладают готовыми креплениями (Рис. 3.9) к ним, поэтому звено нужно спроектировать таким образом, чтобы оно могло крепиться к ним. Значит необходимо в детали сделать такие же отверстия как и в кронштейнах, чтобы их можно было стянуть болтами. Диаметр отверстий 3 мм, расстояние между ним 10 мм. Деталь будет сделана из алюминиевой рейки т.к. металл выдержит более высокие нагрузки и он менее деформируется по сравнению с пластиком.
Рис. 3.9. 3D модель сервопривода DF15RMG и его кронштейнов
Стоит учесть, что сервоприводы, соединенные с рейкой образуют единое звено манипулятора, которое должно иметь длину 20 см (Рис. 3.10), следовательно длину рейки нужно подобрать таким образом, чтобы выполнялось это условие.
Рис. 3.10. Модель 1-го звена
В результате получится рейка длиной 12,8 см (Рис. 3.11), которая образует с двумя сервоприводами 1 ое звено длиной 20 см.
Рис. 3.11. Трехмерный вид детали 1 го звена с указанными размерами
Рейка 2 го звена будет такая же как и для 1 го звена, но только другой длинны. 2 ое звено образуют сервопривод, металлическая рейка и специальное крепление для схвата. Расстояние между осью вала сервопривода и осью вращения крепления для схвата составляет 20 см, что является длиной 2 ого звена (Рис. 3.12).
Рис. 3.12. Модель 2-го звена
В результате получится рейка 2 го звена длиной 14,9 см (Рис. 3.13).
Рис. 3.13. Трехмерный вид детали 2 го звена с указанными размерами
Проектирование схвата
Модель схвата будет строится на основе готового чертежа (Рис. 3.14). Такой схват имеет 6 подвижных деталей, которые крепятся на основание (Рис. 3.15).
Рис. 3.14. Чертеж для построения модели схвата
Рис. 3.15. Модель основания схвата с разных сторон
Расположение крепления для сервопривода было изменено, по сравнению с готовым чертежом, для того, чтобы схват мог шире раскрыться. Также на креплении добавлены специальные опоры для сервопривода SR430. В основании имеется специальное отверстие, чтобы вал сервопривода соединить с шестерней, которая приводит механизм схвата в движение.
Расположение подвижных деталей и их форма остались как на чертеже. Все детали схвата (Рис. 3.17) должны крепится между собой болтами диаметром 3 мм и длиной желательно 15 мм.
Рис. 3.17. Детали и основание схвата и сервопривод SR430
На рисунке 3.19 изображены 3D модели собранного схвата с разных ракурсов вместе с сервоприводом SR430.
Рис. 3.19. Модель собранного схвата с разных ракурсов
Из рисунка 3.20 видно, что длина схвата меняется в зависимости от степени его раскрытия.
Рис. 3.20. Схват при различных положениях и проставленные размеры
Проектирование основания
На основание манипулятора будут идти самые большие нагрузки, также оно примет на себя весь его вес. К тому же к основанию предъявляется ряд требований: оно должно иметь возможность крепиться к плоской поверхности; поворачиваться вокруг своей оси; за вращение должен отвечать сервопривод SR430; основание должно быть достаточно широким, чтобы не опрокинуться при нагрузках и прочным, чтобы не сломаться от высоких нагрузок.
При проектировании основания было решено следующее: т.к. основание вращается оно должно быть цилиндрической формы, в нем должен поместиться сервопривод, оно должно иметь крепления для 1 го звена манипулятора. Креплением 1 го звена является кронштейн его сервопривода, сделаем в основании отверстия для крепления кронштейна (Рис. 3.21).
Рис. 3.21. Крепление 1 го звена к основанию манипулятора
Внутри основания предусмотрены крепления для сервопривода SR430, они достаточно прочны чтобы выдержать нагрузки при вращении основания. Сервопривод крепится так, чтобы центр его вала находился по центру основания (Рис. 3.22).
Рис. 3.22. Крепление сервопривода в основании манипулятора
Чтобы основание вращалось, у него есть отдельная нижняя часть, относительно которой оно вращается (Рис. 3.23). Нижняя часть имеет по контуру 8 отверстий для крепления к плоской поверхности. Чтобы основание не вывалилось из своей нижней части, нижняя часть крепится болтами к валу сервопривода, который крепится к основанию (Рис. 3.24). При вращении вала сервопривода основание начнет вращаться относительно нижней части.
Рис. 3.23. Соединение основания с нижней частью
Рис. 3.24. Структура основания
На рисунках 3.25 и 3.26 указаны основные размеры деталей основания: верхней поворачивающейся части и нижней части, крепящейся к поверхности.
Рис. 3.25. Верхняя часть основания с указанными размерами
Рис. 3.26. Нижняя часть основания с указанными размерами
Проектирование всей конструкции манипулятора
Используя разработанные модели основания, звеньев и схвата манипулятора необходимо разработать модель всей конструкции манипулятора на основе его кинематической схемы (Рис. 3.1). Для этого нужно разработать модели деталей, которые должны образовать параллельный механизм согласно кинематической схеме. На рисунке 3.27 обозначены числами 1 - 5 те шарниры и звенья, которые нужно спроектировать для параллельного механизма.
Рис. 3.27. Обозначение элементов параллельного механизма на кинематической схеме
Звенья под номерами 2 и 4 (Рис. 3.27) имеют одинаковую длину по 20 см. Следовательно детали этих звеньев можно спроектировать одинаковыми. На рисунке 3.28 изображена модель этих звеньев, они будут выполняться из алюминиевых пластин, чтобы иметь достаточную прочность при их длине.
Рис. 3.28. Модель дополнительных звеньев для параллельного механизма
Модель детали, которая образует шарнирное соединение в точке 1 (Рис. 3.27) изображена на рисунке 3.29. Эта деталь будет изготавливаться при помощи 3D печати и будет крепиться к поворачивающемуся основанию манипулятора.
Рис. 3.29. Модель детали для шарнирного соединения
Модель детали, которая образует 3 шарнирных соединения в точке 3 (Рис. 3.27) изображена на рисунке 3.30. Эта деталь будет изготавливаться при помощи 3D печати и будет крепиться к валу сервопривода 2 го звена манипулятора, а также будет соединять дополнительные звенья.
Рис. 3.30. Модель центральной детали параллельного механизма
Модель шарнирного механизм а под номером 5 (Рис. 3.27) объединяет 2 ое звено, схват и дополнительное звено манипулятора, она состоит из двух отдельных деталей, которые печатаются на 3D принтере и соединяются между собой длинным болтом. На рисунках 3.31 и 3.32 изображены эти детали по отдельности и объединенные вместе.
Рис. 3.31. Модель деталей шарнирного соединения манипулятора в области схвата
Рис. 3.32. Вид сбоку и сверху шарнирного соединения
Разработав модели всех деталей конструкции манипулятора, можно объединить их и получить модель полностью собранного манипулятора (Рис. 3.33). Чтобы лучше различить отдельные детали, они были окрашены в разные цвета.
Рис. 3.33. Модель всей конструкции манипулятора
На рисунке 3.34 показаны различные положения модели манипулятора и их кинематические схемы, тут же демонстрируется принцип работы параллельного механизма.
Рис. 3.34. Манипулятор в различных положениях
3.5 Определение диапазонов углов поворотов звеньев
Построив 3D модель манипулятора (Рис. 3.33) с учетом всех длин звеньев и размеров деталей, можно определить диапазоны углов поворотов звеньев робота относительно начального положения. Эти диапазоны будут учитываться при определении рабочей зоны динамической модели манипулятора.
Угол поворота основания q0: За повор
Вывод
В ходе выполнения работы была построена кинематическая схема трехстепенного манипулятора, в которой использовался параллельный механизм для того чтобы схват манипулятора оставался параллельно основанию. Работа данной конструкции была смоделирована на динамической модели манипулятора где подтвердилась ее работоспособность.
Также была построена 3D модель манипулятора, с учетом всех длин и размеров деталей, для определения ее конструктивных ограничений, а именно диапазонов углов поворотов звеньев. Эти углы определили форму рабочей зоны, максимальный радиус которой получился 570 мм от центра основания робота. Рабочая зона строилась при помощи динамической модели манипулятора, в которой манипулятор прошелся через все крайние положения рабочей зоны.
В динамической модели были определены зависимости различных велечин таких как: сила, момент, угловая скорость и угловое ускорение, которые действовали на оси поворотов звеньев и основания. Также было смоделировано как вращающий момент, который развивают реальные сервоприводы, действовал на движение звеньев манипулятора. Этот же момент использовался для определения грузоподъемности манипулятора, которая составила 150 грамм при максимально вытянутой руке манипулятора.
На основе спроектированной трехмерной модели были изготовлены детали для схвата, основания и еще некоторые элементы манипулятора при помощи 3D печати из пластика и металлические детали звеньев, которые создавались вручную.
Была разработана система управления манипулятором на основе платы Arduino Uno, которая получает сигналы управления с компьютера. Компьютерная программа позволяет управлять манипулятором в различных режимах как вручную - управление каждым звеном манипулятора по отдельности или передвижением рабочей точки по осям координат, так и управление в автоматическом режиме, когда программируются различные позиции, по которым должен пройти манипулятор.
Проверка работоспособности манипулятора показала, что робот отрабатывает точно все движения, которые ему задаются в программе. При этом были заметны некоторые небольшие рывки при движении конструкции манипулятора, это происходит изза особенностей сервоприводов. Тестирование работы манипулятора позволило определить его следующие параметры: повторяемость, которая в среднем составляла 2 мм; реальная грузоподъемность, равная от 50 до 100 грамм в зависимости от длины плеча, что является меньше чем при моделировании, т.к. реальная масса робота оказалась немного больше ожидаемой; рабочая зона, которая получилась такая же как и при моделировании.
Так же были получены новые знания и навыки построения 3D моделей деталей, работы с 3D принтером, сборки манипулятора, разработки и тестировании его компьютерной динамической модели, разработки системы управления и программировании на языке C#.
Разработанный в данной работе, манипулятор может эффективно использоваться в качестве лабораторного оборудования для изучения задач кинематики и динамики роботов.
17. Описание сервопривода DF15RMG [электронный ресурс]. Режим доступа: http://www.electronshik.ru/item/df15rmg-tilt-kit-20kg-1114314 (дата обращения: 12.06.2015).
18. Описание сервопривода RDS3115 [электронный ресурс]. Режим доступа: http://www.aliexpress.com/snapshot/6494586405.html? ORDERID=65771461539714 (дата обращения: 12.06.2015).
19. Описание сервопривода SR430 [электронный ресурс]. Режим доступа: http://robot-kit.ru/print_product_info.php/products_id/438 (дата обращения: 12.06.2015).
20. Описание Google SKETCHUP 8 [электронный ресурс]. Режим доступа: http://reviewsoft.ru/Windows/Audio-Video/Audio-Recorders/google-sketchup/ (дата обращения: 12.06.2015).
21. Visual Studio - Microsoft Developer Tools [электронный ресурс]. Режим доступа: https://www.visualstudio.com/ru-ru/visualstudio-homepage-vs.aspx (дата обращения: 13.06.2015).
Вы можете ЗАГРУЗИТЬ и ПОВЫСИТЬ уникальность своей работы