Робот рука манипулятор на шаговых двигателях. Промышленный робот-манипулятор: все могу и все умею. Скетч с использованием ультразвукового датчика расстояния
Одной из основных движущих сил автоматизации современного производства являются промышленные роботы-манипуляторы. Их разработка и внедрение позволили выйти предприятиям на новый научно-технический уровень выполнения задач, перераспределить обязанности между техникой и человеком, повысить производительность. О видах роботизированных помощников, их функционале и ценах поговорим в статье.
Помощник №1 – робот-манипулятор
Промышленность – фундамент большинства экономик мира. От качества предлагаемых товаров, объемов и ценообразования зависит доход не только отдельно взятого производства, но и государственного бюджета.
В свете активного внедрения автоматизированных линий и повсеместного использования умной техники возрастают требования к поставляемой продукции. Выдержать конкуренцию без использования автоматизированных линий или промышленных роботов-манипуляторов сегодня практически невозможно.
Как устроен промышленный робот
Робот-манипулятор выглядит как огромная автоматизированная «рука» под контролем системы электроуправления. В конструкции устройств отсутствует пневматика или гидравлика, все построено на электромеханике. Это позволило сократить стоимость роботов и повысить их долговечность.
Промышленные роботы могут быть 4-х осевыми (используются для укладки и фасовки) и 6-ти осевыми (для остальных видов работ). Кроме того, роботы отличаются и в зависимости от степени свободы: от 2 до 6. Чем он выше, тем точнее манипулятор воссоздает движение человеческой руки: вращение, перемещение, сжатие/разжатие, наклоны и прочее.
Принцип действия устройства зависит от его программного обеспечения и оснащения, и если в начале своего развития основная цель была освобождение работников от тяжелого и опасного вида работ, то сегодня спектр выполняемых задач значительно возрос.
Использование роботизированных помощников позволяет справляться одновременно с несколькими задачами:
- сокращение рабочих площадей и высвобождение специалистов (их опыт и знания могут быть использованы на другом участке);
- увеличение объемов производства;
- повышение качества продукции;
- благодаря непрерывности процесса сокращается цикл изготовления.
В Японии, Китае, США, Германии на предприятиях работает минимум сотрудников, обязанностью которых является лишь контроль работы манипуляторов и качество изготавливаемой продукции. Стоит отметить, что промышленный робот-манипулятор – это не только функциональный помощник в машиностроении или сварочном деле. Автоматизированные устройства представлены в широком ассортименте и используются в металлургии, легкой и пищевой промышленности. В зависимости от потребностей предприятия можно подобрать манипулятор, соответствующий функциональным обязанностям и бюджету.
Виды промышленных роботов-манипуляторов
На сегодняшний день существует около 30 видов роботизированных рук: от универсальных моделей до узкоспециализированных помощников. В зависимости от выполняемых функций, механизмы манипуляторов могут отличаться: так например, это могут быть сварочные работы, резка, сверление, гибка, сортировка, укладка и упаковка товаров.
В отличие от существующего стереотипа о дороговизне роботизированной техники, каждое, даже небольшое предприятие, сможет приобрести подобный механизм. Небольшие универсальные роботы-манипуляторы с небольшой грузоподъемностью (до 5кг) ABB, и FANUC будут стоить от 2 до 4 тысяч долларов.
Несмотря на компактность устройств, они способны увеличить скорость работы и качество обработки изделий. Под каждого робота будет написано уникальное ПО, которое в точности координирует работу агрегата.
Узкоспециализированные модели
Роботы сварщики нашли свое наибольшее применение в машиностроении. Благодаря тому, что устройства способны сваривать не только ровные детали, но и эффективно проводить сварочные работы под углом, в труднодоступных местах устанавливают целые автоматизированные линии.
Запускается конвейерная система, где каждый робот за определенное время проделывает свою часть работы, а после линия начинает двигаться к следующему этапу. Организовать такую систему с людьми достаточно непросто: никто из работников не должен отлучаться ни на секунду, в противном случае сбивается весь производственный процесс, либо появляется брак.
Сварщики
Самыми распространенными вариантами являются сварочные роботы. Их производительность и точность в 8 раз выше, чем у человека. Такие модели могут выполнять несколько видов сварки: дуговая или точечная (в зависимости от ПО).
Лидерами в данной области считаются промышленные роботы-манипуляторы Kuka. Стоимость от 5 до 300 тысяч долларов (в зависимости от грузоподъемности и функций).
Сборщики, грузчики и упаковщики
Тяжелый и вредный для человеческого организма труд стал причиной появления в этой отрасли автоматизированных помощников. Роботы упаковщики за считанные минуты подготавливают товар к отгрузке. Стоимость таких роботов до 4 тысяч долларов.
Производители ABB, KUKA, и Epson предлагают воспользоваться устройствами для подъема тяжелых грузов весом больше 1 тонны и транспортировку от склада к месту погрузки.
Производители промышленных роботов манипуляторов
Бесспорными лидерами в данной отрасли считаются Япония и Германия. На их долю приходится более 50% всей роботизированной техники. Конкурировать с гигантами, непросто, однако, и в странах СНГ постепенно появляются собственные производители и стартапы.
KNN Systems. Украинская компания является партнером немецкой Kuka и занимается разработкой проектов по роботизации процессов сварки, фрезеровки, плазменной резки и паллетизации. Благодаря их ПО промышленный робот может быть перенастроен под новый вид задач всего за один день.
Rozum Robotics (Беларусь). Специалисты компании разработали промышленный робот-манипулятор PULSE, отличающийся своей легкостью и простотой в использовании. Устройство подходит для сборки, упаковки, склеиванию и перестановки деталей. Цена робота в районе 500 долларов.
«АРКОДИМ-Про» (Россия). Занимается выпуском линейных роботов-манипуляторов (двигаются по линейным осям), используемых для литья пластика под давлением. Кроме того, роботы ARKODIM могут работать, как часть конвейерной системы, и выполнять функции сварщика или упаковщика.
Муниципальное бюджетное учреждение
дополнительного образования «Станция юных техников»
города Каменск Шахтинский
Муниципальный этап областного слета-конкурса
«Юные конструкторы Дона – третьему тысячелетию»
Раздел «Робототехника»
« Рука-манипулятор на Arduino»
педагог дополнительного образования
МБУ ДО «СЮТ»
Материалы и инструменты 6
Механическая начинка манипулятора 7
Электронная начинка манипулятора 9
Введение 3
Исследование и анализ 4
Этапы изготовления узлов и сборка манипулятора 6
Заключение 11
Источники информации 12
Приложение 13
Введение
Робот – манипулятор это трехмерная машина, имеющая три измерения, соответствующие пространству живого существа. В широком понимании манипулятор может быть определен как техническая система, способная замещать человека или помогать ему в выполнении различных задач.
В настоящее время развитие робототехники не идет, а бежит, обгоняя время. Только за первые 10 лет XXI века было изобретено и внедрено более 1 млн. роботов. Но самое интересное, что разработками в этой области могут заниматься не только коллективы больших корпораций, группы ученых и инженеров профессионалов, но и обычные школьники по всему миру.
Для изучения робототехники в школе разработано несколько комплексов. Наиболее известные из них – это:
Arduino .
Robotis Bioloid;
LEGO Mindstorms;
Большой интерес у роботостроителей представляют конструкторы Arduino. Платы Arduino - это радио - конструктор, весьма простой, но достаточно функциональный для очень быстрого программирования на языке Виринг (фактически С++) и воплощения в жизнь технических идей.
Но как показывает практика, все большее практическое значение приобретают именно работы молодых специалистов нового поколения.
Обучение детей программированию будет всегда актуальна, так как бурное развитие робототехники связано, прежде всего, с развитием информационных технологий и средств коммуникации.
Цель проекта – создание обучающего радио - конструктора на базе руки – манипулятора, для обучения детей программированию в среде Arduino в игровой форме. Дать возможность, чтобы как можно больше детей могли познакомиться с конструкторской деятельностью в робототехнике.
Задачи проекта:
разработать и построить обучающую руку – манипулятор с минимальными затратами средств, не уступающую зарубежным аналогам;
в качестве механизмов манипулятора использовать сервоприводы;
управление механизмами манипулятора осуществить с помощью радио – конструктора Arduino UNO R 3;
разработать программу в среде программирования Arduino для пропорционального управления сервоприводами.
Для выполнения поставленной цели и задач нашего проекта необходимо изучить виды существующих манипуляторов, техническую литературу по этой теме и аппаратно - вычислительную платформу Arduino.
Исследование и анализ
Исследование.
Промышленный манипулятор - предназначенный для выполнения двигательных и управляющих функций в производственном процессе, т. е. автоматическое устройство, состоящее из манипулятора и перепрограммируемого устройства управления, которое формирует управляющие воздействия, задающие требуемые движения исполнительных органов манипулятора. Применяется для перемещения предметов производства и выполнения различных технологических операций.
О
бучающий конструктор - манипулятор снабжен роботизированной рукой, которая сжимается и разжимается. С его помощью можно играть в шахматы, управляя дистанционно. Также можно с помощью робо - руки раздавать визитки. Движение включают в себя: запястье 120°, локоть 300°, базовое вращения 270°, базовые движения 180°. Игрушка очень хорошая и полезная, но стоимость его составляет порядка 17200 рублей.
Благодаря проекту «uArm», каждый желающий может собрать своего настольного мини - робота. «uArm» - это 4-x осевой манипулятор, миниатюрная версия промышленного робота «ABB PalletPack IRB460» Манипулятор оснащен микропроцессором Atmel и набором сервомоторов, общая стоимость необходимых деталей - 12959 рублей. Проект uArm требует хотя бы начальных навыков программирования и опыта конструирования лего. Мини - робот можно запрограммировать на множество функций: от игры на музыкальном инструменте, до загрузки какой - то сложной программы. В настоящее время ведется разработка приложений для iOS и Android, что позволит управлять «uArm» со смартфона.
Манипуляторы «uArm»
Большинство существующих манипуляторов предполагают расположение двигателей непосредственно в суставах. Это проще конструктивно, но выходит, что двигатели должны поднимать не только полезную нагрузку, но и другие двигатели.
Анализ.
За основу взяли, манипулятор, представленный на сайте Kickstarter, который назывался «uArm». Преимущество этой конструкции в том, что площадка для размещения захвата всегда расположена параллельно рабочей поверхности. Тяжелые двигатели расположены у основания, усилия передаются через тяги. В итоге манипулятор имеет три сервопривода (три степени свободы), которые позволяют ему перемещать инструмент по всем трем осям на 90 градусов.
В подвижных частях манипулятора решили установить подшипники. Такая конструкция манипулятора имеет массу преимуществ перед многими моделями, которые сейчас есть в продаже: Всего в манипуляторе использовано 11 подшипников: 10 штук на вал 3мм и один на вал 30мм.
Характеристики руки манипулятора:
Высота: 300мм.
Рабочая зона (при полностью вытянутом манипуляторе): от 140мм до 300мм вокруг основания
Максимальная грузоподъемность на вытянутой руке: 200г
Потребляемый ток, не более: 1А
Простота сборки. Очень много внимания уделили тому, чтобы была такая последовательность сборки манипулятора, при которой все детали прикручивать предельно удобно. Особенно сложно было сделать это для узлов мощных сервоприводов в основании.
Управление реализуется с помощью переменных резисторов, пропорциональное управление. Можно сконструировать управление типа пантограф, как у ядерщиков и у героя в большом роботе из фильма «Аватара», может управляться и мышкой, а по примерам кода можно составить свои алгоритмы движения.
Открытость проекта. Любой желающий может сделать свои инструменты (присоску или зажим для карандаша) и загрузить в контроллер необходимую для выполнения поставленной задачи программу (скетч).
Этапы изготовления узлов и сборка манипулятора
Материалы и инструменты
Для изготовления руки - манипулятора использовали композитную панель, толщиной 3мм и 5мм. Это материал, который состоит из двух алюминиевых листов, толщиной 0,21 мм соединенных термопластичной прослойкой из полимера, обладает хорошей жесткостью, легкий и хорошо обрабатывается. Скаченные фотографии манипулятора в интернете обрабатывались компьютерной программой Inkscape (векторный графический редактор). В программе AutoCAD (трёхмерная система автоматизированного проектирования и черчения) чертились чертежи руки - манипулятора.
Готовые детали для манипулятора.
Готовые детали основания манипулятора.
Механическая начинка манипулятора
Для основания манипулятора использовали сервоприводы MG-995. Это цифровые сервоприводы с металлическими шестеренками и шарикоподшипниками, они обеспечивают усилие 4,8кг/см, точную отработку позиции и приемлемую скорость. Весит один сервопривод 55,0 граммов при размерах 40,7 х 19,7 х 42,9мм, напряжение питания от 4,8 до 7,2 вольт.
Для захвата и поворота кисти использовали сервоприводы MG-90S. Это тоже цифровые сервоприводы с металлическими шестеренками и шарикоподшипник на выходном валу, они обеспечивают усилие 1,8кг/см и точную отработку позиции. Весит один сервопривод 13.4 грамма при размерах 22,8 х 12,2 х 28,5мм, напряжение питания от 4,8 до 6,0 вольт.
Сервопривод MG-995 Сервопривод MG90S
Подшипник размером 30х55х13 используется для облегчения поворота основания руки – манипулятора с грузом.
Установка подшипника. Поворотное устройство в сборе.
Основание руки – манипулятора в сборе.
Детали для сборки захвата. Захват в сборе.
Электронная начинка манипулятора
Есть такой открытый проект, который называется Arduino. Основа этого проекта – базовый аппаратный модуль и программа, в которой можно написать код для контроллера на специализированном языке, и которая позволяет этот модуль подключить и запрограммировать.
Для работы с манипулятором использовали плату Arduino UNO R 3 и совместимую плату расширения для подключения сервоприводов. На нем установлен стабилизатор 5 вольт, для питания сервоприводов, PLS-контакты для подключения сервоприводов и разъем для подключения переменных резисторов. Питание осуществляется от блока 9В, 3А.
Плата контроллера Arduino UNO R 3.
Принципиальная схема расширения для платы контроллера Arduino UNO R 3 разрабатывалась с учетом поставленных задач.
Принципиальная схема платы расширения для контроллера.
Плата расширения для контроллера.
Подключаем плату Arduino UNO R 3 с помощью кабеля USB A-B к компьютеру, устанавливаем необходимые настройки в среде программирования, составляем программу (скетч) для работы сервоприводов используя библиотеки Arduino. Компилируем (проверяем) скетч, затем загружаем в контроллер. С подробной информацией о работе в среде Arduino можно ознакомиться на сайте http://edurobots.ru/category/uroki/ (Arduino для начинающих. Уроки).
Окно программы со скетчем.
Заключение
Данная модель манипулятора, отличается низкой себестоимостью, от таких как простой конструктор «Уткоробот» который выполняет 2 движения и стоит 1102 рублей, или Лего - конструктор «Полицейский участок» стоимостью 8429 рублей. Наш конструктор выполняет 5 движений и стоит 2384 рубля.
| Комплектующие и материал | Количество | |||
| Сервопривод MG-995 | ||||
| Сервопривод MG90S | ||||
| Подшипник 30х55х13 | ||||
| Подшипник 3х8х3 | ||||
| М3х27 стойка латунная мама-мама | ||||
| М3х10 винт с гол. под в/ш | ||||
| Композитная панель размером 0,6м 2 | ||||
| Плата контроллера Arduino UNO R 3 | ||||
| Переменные резисторы 100ком. | ||||
Низкая себестоимость способствовала разработке технического конструктора руки - манипулятора, на примере которой наглядно продемонстрирован принцип работы манипулятора, выполнение поставленных задач в игровой форме.
Принцип работы в среде программирования Arduino отлично зарекомендовал себя на испытаниях. Такой способ управления и обучения программированию в игровой форме не только возможен, но и эффективен.
Начальный файл со скетчем, взятый на официальном сайте Arduino и отлаженный в среде программирования обеспечивает правильную и надежную работу манипулятора.
В дальнейшем хочу отказаться от дорогостоящих сервоприводов и использовать шаговые двигатели, таким образом, она будет достаточно точно и плавно перемещаться.
Управление манипулятором осуществить с помощью пантографа по радиоканалу Bluetooth.
Источники информации
Гололобов Н. В.О проекте Arduino для школьников. Москва. 2011.
Курт Е. Д. Введение в микроконтроллеры с Перевод на русский язык Т. Волкова. 2012.
Белов А. В. Самоучитель разработчика устройств на микроконтроллерах AVR. Наука и техника, Санкт-Петербург, 2008.
http://www.customelectronics.ru/robo-ruka-sborka-mehaniki/ манипулятор на гусеничном ходу.
http://robocraft.ru/blog/electronics/660.html манипулятор по Bluetooth.
http://robocraft.ru/blog/mechanics/583.html ссылка на статью и видео.
http://edurobots.ru/category/uroki/ Arduino для начинающих.
Приложение
Чертеж основания манипулятора
Чертеж стрелы и захвата манипулятора.
Создаем робот-манипулятор с использованием дальномера, реализуем подсветку.
Резать основание будем из акрила. В качестве двигателей используем сервопривода.
Общее описание проекта робота-манипулятора
В проекте использовано 6 серводвигателей. Для механической части использован акрил толщиной 2 миллиметра. В качестве штатива пригодилось основание от диско-шара (один из двигателей вмонтирован внутрь). Также использован ультразвуковой датчик расстояния и светодиод диаметром 10 мм.
Для управления роботом используется Arduino плата питания. Сам источник питания - блок питания компьютера.
В проекте изложены исчерпывающие пояснения по разработке робо-руки. Отдельно рассмотрены вопросы питания разработанной конструкции.
Основные узлы для проекта манипулятора
Давайте начнем разработку. Вам понадобятся:
- 6 серводвигателей (я использовал 2 модели mg946, 2 mg995 , 2 futuba s3003 (mg995/mg946 по характеристикам лучше, чем futuba s3003, но последние намного дешевле);
- акрил толщиной 2 миллиметра (и небольшой кусок толщиной 4 мм);
- ультразвуковой датчик расстояния hc-sr04 ;
- светодиды 10 мм (цвет - на ваше усмотрение);
- штатив (используется в качестве основания);
- схват аллюминиевый (стоит около 10-15 долларов).
Для управления:
- Плата Arduino Uno (в проекте использована самодельная плата, которая полностью аналогична Arduino);
- плата питания (вам придется ее сделать самим, к этому вопросу мы вернемся позже, он требует отдельного внимания);
- блок питания (в данном случае используется блок питания компьютера);
- компьютер для программирования вашего манипулятора (если вы используете для программирования Arduino, значит, среда Arduino IDE)
Конечно же, вам пригодятся кабели и некоторые базовые инструменты вроде отверток и т.п. Теперь мы можем перейти к конструированию.
Сборка механической части
Перед началом разработки механической части манипулятора, стоит отметить, что чертежей у меня нет. Все узлы делались "на коленке". Но принцип очень простой. У вас есть два звена из акрила, между которыми надо установить серводвигатели. И другие два звенья. Тоже для установки двигателей. Ну и сам схват. Подобный схват проще всего купить в интеренете. Практически все устанавливается с помощью винтов.
Длина первой части около 19 см; второй - около 17.5; длина переднего звена около 5.5 см. Остальные габариты подбирайте в соответсвии с размерами вашего проекта. В принципе, размеры остальных узлов не так важны.
Механическая рука должна обеспечивать угол поворота 180 градусов в основании. Так что мы должны установить снизу серводвигатель. В данном случае он устанавливается в тот самый диско-шар. В вашем случае это может быть любой подходящий бокс. Робот устанавливается на этот серводвигатель. Можно, как это показано на рисунке, установить дополнительное металлическое кольцо-фланец. Можно обойтись и без него.
Для установки ультразвукового датчика, используется акрил толщиной 2 мм. Тут же снизу можно установить светодиод.
Детально объяснить как именно сконструировать подобный манипулятор сложно. Многое зависит от тех узлов и частей, которые есть у вас в наличии или вы приобретаете. Например, если габариты ваших сервоприводов отличаются, звенья арма из акрила тоже изменятся. Если изменятся габариты, калибровка манипулятора тоже будет отличаться.
Вам точно придется после завершения разработки механической части манипулятора удлинить кабели серводвигателей. Для этих целей в данном проекте использовались провода из интернет-кабеля. Для того, чтобы все это имело вид, не поленитесь и установите на свободные концы удлиненных кабелей переходники - мама или папа, в зависимости от выходов вашей платы Arduino, шилда или источника питания.
После сборки механической части, мы можем перейти к "мозгам" нашего манипулятора.
Схват манипулятора
Для установки схвата вам понадобится серводвигатель и несколько винтов.
Итак, что именно необходимо сделать.
Берете качалку от сервы и укорачиваете, пока она не подойдет к вашему схвату. После этого закручиваете два маленьких винта.
После установки сервы, проворачиваете ее в крайнее левое положение и сжимаете губки схвата.
Теперь можно установить серву на 4 болта. При этом следите, чтобы двигатель был все так же в крайнем левом положении, а губки схвата закрыты.
Можно подключить сервопривод к плате Arduino и проверить работоспособность схвата.
Учтите, что могут возникнуть проблемы с работой схвата, если болты/винты слишком сильно затянуты.
Добавление подсветки на манипулятор
Можно сделать ваш проект ярче, добавив на него подсветку. Для этого использовались светодиоды. Делается несложно, а в темноте выглядит очень эффектно.
Места для установки светодиодов зависят от вашего креатива и фантазии.
Электросхема
Можно использовать вместо резистора R1 потенциометр на 100 кОм для регулировки яркости вручную. В качестве сопротивлени R2 использовались резисторы на 118 Ом.
Перечень основных узлов, которые использовались:
- R1 - резистор на 100 кОм
- R2 - резистор на 118 Ом
- Транзистор bc547
- Фоторезистор
- 7 светодиодов
- Переключатель
- Подключение к плате Arduino
В качестве микроконтроллера использовалась плата Arduino. В качестве питания использовался блок питания от персонального компьютера. Подключив мультиметр к красному и черному кабелям, вы увидите 5 вольт (которые используются для серводвигателей и ультразвукового датчика расстояния). Желтый и черный дадут вам 12 вольт (для Arduino). Делаем 5 коннекторов для сервомоторов, параллельно подключаем позитивные к 5 В, а негативные - к земле. Аналогично с датчиком расстояния.
После этого подключите оставшиеся коннекторы (по одному с каждой сервы и два с дальномера) к распаянной нами плате и Arduino. При этом не забудьте в программе в дальнейшем корректно указать пины, которые вы использовали.
Кроме того, на плате питания был установлен светодиод-индикатор питания. Реализуется это несложно. Дополнительно использовался резистор на 100 Ом между 5 В и землей.
10 миллиметровый светодиод на роботе тоже подключен к Arduino. Резистор на 100 Ом идет от 13 пина к к позитивной ноге светодиода. Негативный - к земле. В программе его можно отключить.
Для 6 серводвигателей использовано 6 коннекторов, так как 2 серводвигателя снизу используют одинаковый сигнал управления. Соответствующие проводники соединяются и подключаются к одному пину.
Повторюсь, что в качестве питания используется блок питания от персонального компьютера. Либо, конечно, вы можете приобрести отдельный источник питания. Но с учетом, того, что у нас 6 приводов, каждый из которых может потреблять около 2 А, подобный мощный блок питания обойдется недешево.
Обратите внимание, что коннекторы от серв подключаются к ШИМ-выходам Arduino. Возле каждого такого пина на плате есть условное обозначение ~. Ультразвуковой датчик расттояния можно подключить к пинам 6, 7. Светодиод - к 13 пину и земле. Это все пины, которые нам понадобятся.
Теперь мы можем перейти к программированию Arduino.
Перед тем как подключить плату через usb к компьютеру, убедитесь, что вы отключили питание. Когда будете тестировать программу, также отключайте питание вашей робо-руки. Если питание не выключить, Arduino получит 5 вольт от usb и 12 вольт от блока питания. Соответственно, мощность от usb перекинется к источнику питания и он немного "просядет".
На схеме подключения видно, что были добавлены потенциометры для управления сервами. Потенциометры не являются обязательным звеном, но приведенный код не будет работать без них. Потенциометры можно подключить к пинам 0,1,2,3 и 4.
Программирование и первый запуск
Для управления использовано 5 потенциометров (вполне можно заменить это на 1 потенциометр и два джойстика). Схема подключения с потенциометрами приведена в предыдущей части. Скетч для Arduino находится здесь.
Снизу представлены несколько видео робота-манипулятора в работе. Надеюсь, вам понравится.
На видео сверху представлены последние модификации арма. Пришлось немного изменить конструкцию и заменить несколько деталей. Оказалось, что сервы futuba s3003 слабоваты. Их получилось использовать только для схвата или поворота руки. Так что виесто них были установлены mg995. Ну а mg946 вообще будут отличным вариантом.
Программа управления и пояснения к ней
// управляются привода с помощью переменных резисторов - потенциометров.
int potpin = 0; // аналоговый пин для подключения потенциометра
int val; // переменная для считывания данных с аналогового пина
myservo1.attach(3);
myservo2.attach(5);
myservo3.attach(9);
myservo4.attach(10);
myservo5.attach(11);
pinMode(led, OUTPUT);
{ //servo 1 analog pin 0
val = analogRead(potpin); // считывает значение потенциометра (значение между 0 и 1023)
// масштабирует полученное значение для использования с сервами (получаем значение в диапазоне от 0 до 180)
myservo1.write(val); // выводит серву в позицию в соответствии с рассчитанным значением
delay(15); // ждет, пока серводвигатель выйдет в заданное положение
val = analogRead(potpin1); // серва 2 на аналоговом пине 1
val = map(val, 0, 1023, 0, 179);
myservo2.write(val);
val = analogRead(potpin2); // серва 3 на аналоговом пине 2
val = map(val, 0, 1023, 0, 179);
myservo3.write(val);
val = analogRead(potpin3); // серва 4 на аналоговом пине 3
val = map(val, 0, 1023, 0, 179);
myservo4.write(val);
val = analogRead(potpin4); //серва 5 на аналоговом пине 4
val = map(val, 0, 1023, 0, 179);
myservo5.write(val);
Скетч с использованием ультразвукового датчика расстояния
Это, наверное, одна из самых эффектных частей проекта. На манипулятор устанавливается датчик расстояния, который реагирует на препятствия вокруг.
Основные пояснения к коду представлены ниже
#define trigPin 7
Следующий кусок кода:
Мы присвоили всем 5-ти сигналам (для 6 приводов) названия (могут быть любыми)
Следующее:
Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(led, OUTPUT);
myservo1.attach(3);
myservo2.attach(5);
myservo3.attach(9);
myservo4.attach(10);
myservo5.attach(11);
Мы сообщаем плате Arduino к каким пинам подключены светодиоды, серводвигатели и датчик расстояния. Изменять здесь ничего не стоит.
void position1(){
digitalWrite(led, HIGH);
myservo2.writeMicroseconds(1300);
myservo4.writeMicroseconds(800);
myservo5.writeMicroseconds(1000);
Здесь кое-что можно менять. Я задал позицию и назвал ее position1. Она будет использована в дальнейшей программе. Если вы хотите обеспечить другое движение, измените значения в скобках в диапазоне от 0 до 3000.
После этого:
void position2(){
digitalWrite(led,LOW);
myservo2.writeMicroseconds(1200);
myservo3.writeMicroseconds(1300);
myservo4.writeMicroseconds(1400);
myservo5.writeMicroseconds(2200);
Аналогично предыдущему куску, только в данном случае это position2. По такому же принципу вы можете добавлять новые положения для перемещения.
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2) / 29.1;
Теперь начинает отрабатывать основной код программы. Не стоит его изменять. Основная задача приведенных выше строк - настройка датчика расстояния.
После этого:
if (distance <= 30) {
if (distance < 10) {
myservo5.writeMicroseconds(2200); //открыть схват
myservo5.writeMicroseconds(1000); //закрыть схват
Теперь вы можете добавлять новые перемещения в зависимости от расстояния, измеренного ультразвуковым датчиком.
if(distance <=30){ // данная строка обеспечивает переход в position1, если расстояние меньше 30 см.
position1(); //по сути арм отработает все, что вы зададите между скобками { }
else{ // если расстояние больше 30 см, переход в position2
position()2 // аналогично предыдущей строке
Можно в коде поменять расстояние ну и творить все, что вы пожелаете.
Последние строки кода
if (distance > 30 || distance <= 0){
Serial.println("Out of range"); //вывод в серийном монитеоре сообщения, что мы вышли за заданный диапазон
Serial.print(distance);
Serial.println(" cm"); //расстояние в сантиметрах
delay(500); //задержка в 0.5 секунды
Конечно, можно перевести тут все в миллиметры, метры, изменить отображающееся сообщение и т.п. Можно немного поиграться с задержкой.
Вот, собственно и все. Наслаждайтесь, модернизируйте свои собственные манипуляторы, делитесь идеями и резутатами!
Робот-манипулятор MeArm — карманная версия промышленного манипулятора. MeArm - простой в сборке и управлении робот, механическая рука. Манипулятор имеет четыре степени свободы, что позволяет легко захватывать и перемещать различные небольшие предметы.
Данный товар представлен в виде набора для сборки. Включает в себя следующие части:
- набор деталей из прозрачного акрила для сборки механического манипулятора;
- 4 сервопривода;
- плата управления, на которой расположен микроконтроллер Arduino Pro micro и графический дисплей Nokia 5110;
- плата джойстиков, содержащая два двухкоординатных аналоговых джойстика;
- USB кабель питания.
Перед сборкой механического манипулятора необходимо произвести калибровку сервоприводов. Для калибровки будем использовать контроллер Arduino. Подсоединяем сервоприводы к плате Arduino (необходим внешний источник питания 5-6В 2А).
Servo middle, left, right, claw ; // создание 4 объектов Servo
Void setup()
{
Serial.begin(9600);
middle.attach(11); // присоединяет серво на контакт 11 на вращение платформы
left.attach(10); // присоединяет серво на контакт 10 на левое плечо
right.attach(9); // присоединяет серво на контакт 11 на правое плечо
claw.attach(6); // присоединяет серво на контакт 6 claw (захват)
}
Void loop()
{
// устанавливает позицию сервопривода по величине(в градусах)
middle.write(90);
left.write(90);
right.write(90);
claw.write(25);
delay(300);
}
Используя маркер, сделайте линию через корпус серводвигателя и шпиндель. Подключите пластмассовую качалку из комплекта к сервоприводу, как показано ниже с помощью небольшого винта из комплекта креплений к сервоприводу. Мы будем использовать их в этом положении при сборке механической части MeArm. Будьте осторожны, чтобы не переместить положение шпинделя.
Теперь можно производить сборку механического манипулятора.
Возьмём основание и прикрепим ножки к её углам. Затем установим четыре 20 мм болта и накрутим на них гайки (половину от общей длины).
Теперь крепим центральный сервопривод двумя 8-мм болтами к маленькой пластине, и получившуюся конструкцию крепим к основанию с помощью 20 мм болтов.
Собираем левую секцию конструкции.
Собираем правую секцию конструкции.
Теперь необходимо соединить левую и правую секции. Сначала леую к переходной пластине
Потом правую, и получаем
Подсоединяем конструкцию к платформе
И собираем "клешню"
Крепим "клешню"
Для сборки можно использовать следующее руководство (на англ. языке) или руководство по сборке подобного манипулятора (на русском).
Схема расположения выводов
Теперь можно приступать к написанию Arduino кода. Для управления манипуляторм, наряду с возможностью управления управления с помощью джойстика, было бы неплохо направлять манипулятор в какую-то определенную точку декартовых координат (x, y, z). Есть соответствующая библиотека, которую можно скачать с github - https://github.com/mimeindustries/MeArm/tree/master/Code/Arduino/BobStonesArduinoCode .
Координаты измеряются в мм от центра вращения. Исходное положение находится в точке (0, 100, 50), то есть 100 мм вперед от основания и 50 мм от земли.
Пример использования библиотеки для установки манипулятора в определенной точке декартовых координат:
#include "meArm.h"
#include
Void setup() {
arm.begin(11, 10, 9, 6);
arm.openGripper();
}
Void loop() {
// вверх и влево
arm.gotoPoint(-80,100,140);
// захватить
arm.closeGripper();
// вниз, вред и вправо
arm.gotoPoint(70,200,10);
// отпустить захват
arm.openGripper();
// вернуться вт начальную точку
arm.gotoPoint(0,100,50);
}
Методы класса meArm:
void
begin
(int
pinBase
,
int
pinShoulder
,
int
pinElbow
,
int
pinGripper
)
- запуск meArm, указываются пины подключения для сервоприводов middle, left, right, claw. Необходимо вызвать в setup();
void
openGripper
()
- открыть захват;
void
closeGripper
()
- захватить;
void
gotoPoint
(float
x
,
float
y
,
float
z
)
- переместить манипулятор в позицию декартовых координат (x, y, z);
float
getX
()
- текущая координата X;
float
getY
()
- текущая координата Y;
float
getZ
()
- текущая координата Z.
Руководство по сборке (англ.)
Имеет подсветку. Всего робот работает на 6-ти серводвигателях. Для создания механической части использовался акрил толщиной два миллиметра. Для изготовления штатива было взято основание от диско-шара, при этом один мотор строен прямо в него.
Робот работает на плате Arduino . В качестве источника питания используется компьютерный блок.
Материалы и инструменты:
- 6 серводвигателей;
- акрил толщиной 2 мм (и еще небольшой кусок толщиной 4 мм);
- штатив (для создания основания);
- ультразвуковой датчик расстояния типа hc-sr04;
- контроллер Arduino Uno;
- контроллер питания (изготавливается самостоятельно);
- блок питания от компьютера;
- компьютер (нужен для программирования Arduino);
- провода, инструменты и прочее.
Процесс изготовления:
Шаг первый. Собираем механическую часть робота
Механическая часть собирается очень просто. Два куска акрила нужно соединить с помощью серводвигателя. Другие два звена соединяются аналогичным образом. Что касается схвата, то его лучше всего купить через интернет. Все элементы крепятся с помощью винтов.
Длина первой части составляет порядка 19 см, а второй примерно 17.5 см. Переднее звено имеет длину 5.5 см. Что касается остальных элементов, то их размеры выбираются на личное усмотрение.
Угол поворота в основании механической руки должен составлять 180 градусов, поэтому снизу нужно установить серводвигатель. В нашем случае его нужно установить в диско-шар. Робот же устанавливается уже на серводвигатель.
Для установки ультразвукового датчика понадобится кусок акрила толщиной 2 см.
Чтобы установить схват будет нужно несколько винтов и серводвигатель. Нужно взять качалку от серводвигателя и укорачивать ее до тех пор, пока она не подойдет ко схвату. Затем можно закрутить два маленьких винта. После установки серводвигатель нужно повернуть в крайнее левое положение и свести губки захвата.
Теперь серводвигатель крепится на 4 болта, при этом важно следить, чтобы он находился в крайнем левом положении, а губы были сведены.
Теперь сервпривод можно подключить к плате и проверить, работает ли схват.
Шаг второй. Подсветка робота
Чтобы робот был интереснее, ему можно сделать подсветку. Делается это с помощью светодиодов разнообразных цветов.
Шаг третий. Подключение электронной части
Основным контроллером для робота является плата Arduino. В качестве источника питания используется компьютерный блок, на его выходах нужно найти напряжение 5 Вольт. Оно должно быть, если замерить мультиметром напряжение на красном и черном проводе. Это напряжение нужно для питания серводвигателей и датчика расстояния. Желтый и черный провод блока выдает уже 12 Вольт, они нужны для работы Arduino.
Для сервомоторов нужно сделать пять коннекторов. К позитивным подключаем 5В, а негативные к земле. Аналогичным образом подключается и датчик расстояния.
Еще на плате имеется светодиодный индикатор питания. Для его подключения используется резистор 100 Ом между +5В и землей.
Выходы от серводвигателей подключаются к ШИМ-выходам на Arduino. Такие пины на плате обозначаются значком «~». Что касается ультразвукового датчика расстояния, то его можно подключить к пинам 6 и 7. Светодиод подключается к земле и 13-му пину.
Теперь можно приступать к программированию. Перед тем как подключаться через USB, нужно убедиться, что питание полностью отключено. При тестировании программы питание робота тоже нужно отключать. Если это не сделать, контроллер получить 5В от USB и 12В от блока питания.
На схеме можно увидеть, что для управления серводвигателями были добавлены потенциометры. Они не являются необходимой составляющей робота, но без них предложенный код работать не будет. Потенциометры подключаются к пинам 0,1,2,3 и 4.
На схеме есть резистор R1, его можно заменить потенциометром на 100 кОм. Это позволит регулировать яркость вручную. Что касается резисторов R2, то их номинал 118 Ом.
Вот перечень основных узлов, которые применялись:
- 7 светодиодов;
- R2 - резистор на 118 Ом;
- R1 - резистор на 100 кОм;
- переключатель;
- фоторезистор;
- транзистор bc547.
Шаг четвертый. Программирование и первый запуск робота
Чтобы управлять роботом, было использовано 5 потенциометров. Вполне реально заменить такую схему на один потенциометр и два джойстика. Как подключить потенциометр, было показано в предыдущем шаге. После установки скеча робота можно испытать.
Первые испытания робота показали, что установленные серводвигатели типа futuba s3003 оказались слабыми для робота. Их можно применять лишь для поворота руки или для схвата. Вместо них автор установил двигатели mg995. Идеальным вариантом будут двигатели типа mg946.
