Всем привет. Эта статья небольшой рассказ о том, как сделать робота своими руками . Почему именно рассказ, спросите вы? Всё из-за того, что для изготовления подобной поделки необходимо использовать значительный багаж знаний, который очень трудно изложить в одной статье. Мы пройдёмся по процессу сборки, заглянем одним глазом в программный код и в конечном счете оживим детище «силиконовой долины». Советую посмотреть видео, чтобы иметь представление о том, что в итоге должно получится.
Перед тем, как двигаться дальше прошу отметить следующее, что при изготовлении поделки использовался лазерный резак. От лазерного резака можно отказаться, обладая достаточным опытом работы руками. Точность выступает тем ключом, что поможет завершить проект успешно!
Шаг 1: Как это работает?
Робот имеет 4 ноги, с 3 сервоприводами на каждой из них, что позволяют ему перемещать конечности в 3-х степенях свободы. Он передвигается «ползучей походкой». Пусть она медленная, зато одна из самых плавных.
Для начала нужно научить робота двигаться вперед, назад, влево и вправо, затем добавить ультразвуковой датчик, что поможет обнаруживать препятствия/преграды, а после этого Bluetooth модуль, благодаря которому управление роботом выйдет на новый уровень.
Шаг 2: Необходимые детали
Скелет изготавливается из оргстекла толщиной 2 мм.
Электронная часть самоделки будет состоять из:
- 12 сервоприводов;
- arduino nano (можно заменить любой другой платой arduino);
- Шилда для управления сервоприводами;
- блока питания (в проекте использовался БП 5В 4А);
- ультразвукового датчика;
- hc 05 bluetooth модуля;
Для того, чтобы изготовить шилд понадобится:
- монтажная плата (предпочтительно с общими линиями (шинами) питания и земли);
- межплатные штыревые соединители — 30 шт;
- гнезда на плату – 36 шт;
- провода.
Инструменты :
- Лазерный резак (или умелые руки);
- Суперклей;
- Термоклей.
Шаг 3: Скелет
Воспользуемся графической программой, чтобы начертить составные части скелета.
После этого в любой доступный способ вырезаем 30 деталей будущего робота.
Шаг 4: Сборка
После резки снимаем защитное бумажное покрытие с оргстекла.
Далее приступаем к сборке ног. Крепежные элементы встроенные в части скелета. Всё, что остаётся сделать — это соединить детали воедино. Соединение довольно плотное, но для большей надежности можно нанести по капле суперклея на элементы крепежа.
Затем нужно доработать сервоприводы (приклеить по винту напротив валов сервоприводов).
Этой доработкой мы сделаем робота более устойчивым. Доработку нужно выполнить только для 8 сервоприводов, остальные 4 будут крепиться непосредственно на тело.
Прикрепляем ноги к связующему элементу (изогнутая деталь), а его в свою очередь к сервоприводу на теле.
Шаг 5: Изготавливаем шилд
Изготовление платы довольно простое, если следовать представленным в шаге фотографиям.
Шаг 6: Электроника
Закрепим выводы сервоприводов на плате arduino. Выводы следует соединять в правильной последовательности, иначе ничего не будет работать!
Шаг 7: Программирование
Пришло время оживить Франкенштейна. Сначала загрузим программу legs_init и убедимся в том, что робот находится в таком положении, как на картинке. Далее загрузим quattro_test, чтобы проверить реагирует ли робот на базовые движения, такие как движение вперед, назад, влево и вправо.
ВАЖНО: Вам необходимо добавить дополнительную библиотеку в программную среду arduino IDE. Ссылка на библиотеку представлена ниже:
Робот должен сделать 5 шагов вперед, 5 шагов назад, повернутся влево на 90 градусов, повернутся вправо на 90 градусов. Если Франкенштейн делает всё правильно, мы двигаемся в верном направлении.
P . S : установите робота на чашку, как на стенд, чтобы каждый раз не выставлять его на первоначальную точку. Как только тесты показали нормальную работу робота, можем продолжать испытания, поставив его на землю/пол.
Шаг 8: Инверсная кинематика
Инверсная (обратная) кинематика – именно она в действительности и управляет роботом (если вам не интересна математическая сторона этого проекта и вы торопитесь закончить проект можете пропустить данный шаг, но знание того, что движет роботом всегда будут полезны).
Простыми словами инверсная кинематика или сокращенно ик – «часть» тригонометрических уравнений, что определяют положение острого конца ноги, угла каждого сервоприводи и т.д., что в итоге определяют пару предварительных установочных параметров. Для примера, длина каждого шага робота или высота на которой будет располагаться тело во время движения/покоя. Используя эти предопределенные параметры, система будет извлекать величину, на которую следует сдвинуть каждый сервопривод, для того чтобы управлять роботом при помощи задаваемых команд.
Но и с покупки готового полноценного робота на базе этой платы. Для детей начальной школы или дошкольного возраста такое готовые проекты Arduino даже предпочтительней, т.к. «неожившая» плата выглядит скучновато. Такой способ подойдет и для тех, кого электрические схемы не особо привлекают.
Приобретая работающую модель робота, т.е. фактически готовую высокотехнологичную игрушку, можно разбудить интерес к самостоятельному проектированию и созданию роботов. Наигравшись в такую игрушку и разобравшись в том, как она работает, можно приступать к совершенствованию модели, разобрать все на части и начать собирать новые проекты на Arduino, используя высвободившиеся плату, приводы и датчики. Открытость платформы Arduino позволяет из одних и тех же составных частей мастерить себе новые игрушки.
Мы предлагаем небольшой обзор готовых роботов на плате Arduino.
Машинка на Arduino, управляемая через Bluetooth
Машинка, управляемая через Bluetooth , стоимостью чуть менее $100. Поставляется в разобранном виде. Помимо корпуса, мотора, колес, литиевой батарейки и зарядного устройства, получаем плату Arduino UNO328, контроллер мотора, Bluetooth адаптер, пульт дистанционного управления и прочее.
Видео с участием этого и еще одного робота:
Более подробное описание игрушки и возможность купить на сайте интернет-магазина DealExtreme .
Робот-черепаха Arduino
Комплект для сборки робота-черепахи стоимостью около $90. Не хватает только панциря, все остальное, необходимое для жизни этого героя, в комплекте: плата Arduino Uno, сервоприводы, датчики, модули слежения, ИК-приемник и пульт, батарея.
Черепаху можно купить на сайте DealExtreme , аналогичный более дешевый робот на Aliexpress .
Гусеничная машина на Arduino, управляемая с сотового телефона
Гусеничная машина, управляемая по Bluetooth с сотового телефона , стоимостью $94. Помимо гусеничной базы получаем плату Arduino Uno и плату расширения, Bluetooth плату, аккумулятор и зарядное устройство.
Гусеничную машину также можно купить на сайте DealExtreme , там же подробное описание. Может быть, более интересный железный Arduino-танк на Aliexpress .
Arduino-автомобиль, проезжающий лабиринты
Автомобиль, проезжающий лабиринты , стоимостью $83. Помимо моторов, платы Arduino Uno и прочего необходимого cодержит модули слежения и модули обхода препятствий.
Готовый робот или каркас для робота
Помимо рассмотренного в обзоре варианта использования готовых комплектов для создания роботов Arduino, можно купить отдельно каркас (корпус) робота — это может быть платформа на колесиках или гусенице, гуманоид, паук и другие модели. В этом случае начинку робота придется делать самостоятельно. Обзор таких корпусов приведен в нашей .
Где еще купить готовых роботов
В обзоре мы выбрали наиболее дешевых и интересных на наш взгляд готовых Arduino-роботов из китайских интернет-магазинов. Если нет времени ждать посылку из Китая — большой выбор готовых роботов в интернет-магазинах Амперка и DESSY . Низкие цены и быструю доставку предлагает интернет-магазин ROBstore . Список рекомендованных магазинов .
Возможно вас также заинтересуют наши обзоры проектов на Arduino:
Обучение Arduino
Не знаете, с чего начать изучение Arduino? Подумайте, что вам ближе — сборка собственных простых моделей и постепенное их усложнение или знакомство с более сложными, но готовыми решениями?
После того, как стали популярными самобалансирующие скутеры Segway, я
всегда хотел создать нечто подобное. Вдохновившись ими, я решил построить Self Balancing Robot
,
используя Arduino. Таким образом, я захотел понять основный принцип работы всех этих скутеров,
а также узнать, как работает алгоритм ПИД-регулирования.
Как только я начал работу над ним, я понял, что этот робот — немного сложнее нежели я думал.
Существует так много подводных камней, которые
следует учитывать — тип батареи, положение батареи, сцепление с колесом, тип драйвера двигателя,
поддержание CoG (центр тяжести) и многое другое.
Но как только вы его сделаете, вы согласитесь, что это не так сложно,
как кажется. Итак, давайте посмотрим правде в глаза, в этом уроке я опишу свой опыт по созданию
робота для самостоятельной балансировки. Вы можете быть абсолютным новичком, который только
начинает работать или, возможно, приземлился здесь после долгого разочарования, когда питались заставить вашего робота балансировать.
Итак, давайте начнем …
Выбор електроники для вашего бота
Прежде чем я расскажу вам все варианты создания бота, позвольте мне перечислить элементы,
которые я использовал в этом проекте.
- Arduino UNO
- Двигатели постоянного тока с редуктором – 2Nos
- L298N Motor Driver Module
- MPU6050
- Пара колес
- 7.4V Li-ion Battery
- Купа проводов
- Каркас напечатанный на 3D принтере
Контроллер: Контроллер, который я использовал здесь, это Arduino UNO, почему, потому что он просто прост в использовании. Вы также можете использовать Arduino Nano или Arduino mini, но я бы рекомендовал вам придерживаться UNO, так как мы можем запрограммировать его напрямую без какого-либо внешнего оборудования.
Двигатели: лучший выбор двигателя, который вы можете использовать для самобалансирующегося робота, без сомнения, будет шаговым двигателем. Но чтобы все было просто, я использовал двигатель редуктора постоянного тока. Да, не обязательно иметь степпера; бот отлично работает с этими дешевыми широко распространенными желтыми цветными двигателями постоянного тока.
Драйвер двигателя: если вы выбрали двигатели постоянного тока, такие как мои, тогда вы можете использовать модуль драйвера L298N, как я, или даже L293D должен работать нормально.
Колеса: не недооценивайте этих парней; Мне было трудно понять, что проблема была в моих колесах. Поэтому убедитесь, что ваши колеса хорошо сцеплены с полом, который вы используете.
Акселерометр и гироскоп: лучшим выбором акселерометра и гироскопа для вашего робота будет MPU6050 . Поэтому не пытайтесь построить его с обычным акселерометром, например ADXL345 , или что-то в этом роде, он просто не сработает. Вы узнаете, почему в конце этой статьи. Вы также можете использовать эту статью для изучения MPU6050 и его подключения к Arduino.
Battery: Нам нужна батарея как можно более легкая, а рабочее напряжение должно быть больше 5 В, чтобы мы могли напрямую управлять нашим Arduino без модуля повышения. Таким образом, идеальным выбором будет литий-полимерный аккумулятор 7.4V. Поскольку у меня была литий-ионная аккумуляторная батарея 7,4 В, я ее использовал. Но помните, что Li-po лучше, чем Li-ion.
Chassis: Еще одно место, где вы не должны идти на компромисс, — это шасси вашего робота. Вы можете использовать картон, дерево, пластик, с которым вы хорошо справляетесь. Но только убедитесь, что шасси прочное и оно не должно люфтить, когда робот пытается балансировать. Я разработал собственное шасси в программе Solidworks . Если у вас есть принтер, вы также можете распечатать проект, его файлы будут прикреплены внизу статьи.
3D-печать и сборка робота
Если вы решили напечатать то же самое шасси, которое я использую, чтобы построить моего робота, тогда скачайте STL-файлы. Я также добавил файлы проетка вместе с ним, чтобы вы также могли изменить его в соответствии с вашими предпочтениями.
Детали не имеют нависающих частей, поэтому вы можете легко распечатать их без каких-либо опор, а заполнение на 25% будет вполне достаточно. Конструкция довольно простая, и любой базовый принтер должен легко справиться с ее частями. Я использовал программное обеспечение Cura , чтобы подготовить модель и напечатать ее с помощью Tevo Tarantula , настройка показана ниже.
Вам придется распечатать одну часть корпуса, а также четыре части крепления двигателей. Сборка довольно проста; используйте гайки и болты 3 мм для крепления двигателя и шасси между собой. После сборки он должен выглядеть примерно так, как показано на рисунке ниже.
Фактическая конструкция была запланирована с использованием приводного модуля L298N в нижней стойке, Arduino в средней и батареи сверху, как показано выше. Если вы делаете все как я, вы можете напрямую завинтить плату с помощью предусмотренных отверстий и использовать проводную бирку для аккумулятора Li-po. Эта компоновка также должна работать, за исключением сверхпрочных колес, которые мне пришлось изменить позже.
В моем роботе я поменял позицию батареи и платы Arduino UNO для упрощения программирования, а также должен был ввести кнопку выключения. Так что мой бот не выглядел так, как я планировал на начальном этапе. После завершения тестирования проводов и всего, мой бот, наконец, выглядит так как на второй картинке выше.
Принципиальная электрическая схема
Соединение частей этого робота между собой задача не сложная. Нам просто нужно подключить MPU6050 к Arduino и подключить двигатели, через модуль драйвера двигателя. Вся конструкция рассчитана на питание от литиево-ионного аккумулятора 7.4V. Схема показана ниже….
Модуль управления двигателем Arduino и L298N напрямую питается через вывод Vin и 12-вольтовый вход соответственно. Встроенный регулятор на плате Arduino преобразует входное напряжение 7.4V в 5V, и ATmega IC и MPU6050 будут питаться от него.
MPU6050 взаимодействует с интерфейсом Arduino через интерфейс I2C, поэтому мы используем штыри SPI A4 и A5 от Arduino. Двигатели постоянного тока подключаются к штырям PWM D6, D9 D10 и D11 соответственно. Нам нужно подключить их к контактам PWM, потому что мы будем контролировать скорость двигателя постоянного тока, изменяя рабочий цикл сигналов ШИМ. Если вы не знакомы с этими двумя компонентами, рекомендуется прочитать руководство по интерфейсу MPU6050 Interfacing и L298N Motor.
Программирование самобалансирующегося робота
Теперь нам нужно запрограммировать нашу Arduino UNO, чтобы сбалансировать робота. Здесь происходит вся магия; концепция, стоящая за ней, проста. Мы должны проверить, наклоняется ли бот к передней или к задней части с помощью MPU6050, а затем, если он наклоняется к передней части, мы должны вращать колеса в прямом направлении, и если он наклоняется к задней части, мы должны вращать колеса в обратном направлении.
В то же время мы также должны контролировать скорость вращения колес, если бот слегка дезориентирован из центрального положения, колеса вращаются медленно, а скорость увеличивается, когда она больше удаляется от центрального положения. Для достижения этой логики мы используем алгоритм PID, который имеет центральное положение в качестве заданного значения и уровень дезориентации в качестве выходного.
Чтобы узнать текущее положение бота, мы используем MPU6050, который представляет собой 6-осевой акселерометр и датчик гироскопа. Чтобы получить достоверное значение положения от датчика, нам нужно использовать значение как акселерометра, так и гироскопа, поскольку значения от акселерометра имеют проблемы с шумом, а значения из гироскопа со временем дрейфуют. Таким образом, мы должны объединить оба и получить значение шага рыскания и крена нашего робота, из которого мы будем использовать только значение рыскания.
Теперь у нас есть библиотеки, добавленные в нашу среду разработки Arduino. Давайте начнем программирование для нашего Self-балансирующего робота. Как и всегда, полный код для проекта приведен в конце этой страницы, здесь я просто объясняю наиболее важные фрагменты кода. Ранее сообщалось, что код построен поверх примера кода MPU6050, мы просто собираемся оптимизировать код для нашей цели и добавить PID и технологию управления для нашего самобалансирующегося робота.
Сначала мы включаем библиотеки, которые необходимы для работы этой программы. Они включают встроенную библиотеку I2C, библиотеку PID и библиотеку MPU6050, которые мы только что загрузили.
Затем мы объявляем переменные, которые необходимы для получения данных от датчика MPU6050. Мы читаем как значения гравитационного вектора, так и значения кватерниона, а затем вычисляем значение угла и угла поворота бота. Конечный результат будет иметь массив float ypr .
Далее идет очень важный сегмент кода, и именно здесь вы будете тратить много времени на настройку нужного набора значений. Если ваш робот построен с очень хорошим центром тяжести, а компоненты симметрично расположены (что в большинстве случаев нет), тогда значение вашего уставки будет равно 180. Просто подключите ваш бот к серийному монитору Arduino и наклоните его до положения балансировки, прочитайте значение, отображаемое на последовательном мониторе, и это ваше заданное значение. Значение Kp, Kd и Ki должно быть настроено в соответствии с вашим ботом. Никакие два одинаковых бота не будут иметь одинаковых значений Kp, Kd и Ki, поэтому от него не уйти.
В следующей строке мы инициализируем алгоритм PID, передавая входные переменные input, output, set point, Kp, Ki и Kd. Из них мы уже установили значения заданного значения Kp, Ki и Kd в приведенном выше фрагменте кода. Значение входа будет текущим значением рыскания, которое считывается с датчика MPU6050, а значением выхода будет значение, которое рассчитывается по алгоритму PID. Таким образом, в основном алгоритм PID даст нам выходное значение, которое должно использоваться для коррекции значения Input, чтобы оно было близко к заданной точке.
Внутри функции void setup мы инициализируем MPU6050, настроив DMP (Digital Motion Processor). Это поможет нам объединить данные акселерометра с данными гироскопа и обеспечить надежное значение Yaw, Pitch and Roll. Мы не будем углубляться в это, так как это будет далеко за пределами темы. Во всяком случае, один сегмент кода, который вы должны искать в функции настройки, представляет собой значения смещения гироскопа. Каждый датчик MPU6050 имеет собственные значения смещений, вы можете использовать этот эскиз Arduino для расчета значения смещения вашего датчика и соответственно обновить следующие строки в вашей программе.
Мы также должны инициализировать контакты PWM Digital, которые мы используем для подключения наших двигателей. В нашем случае это D6, D9, D10 и D11. Таким образом, мы инициализируем эти контакты, поскольку выходные выводы делают их LOW по умолчанию.
Внутри основной функции цикла мы проверяем, готовы ли данные из MPU6050 для чтения. Если да, то мы используем его для вычисления значения PID, а затем отображаем входное и выходное значение PID на последовательном мониторе, чтобы проверить, как реагирует PID. Затем, основываясь на значении вывода, мы решаем, должен ли бот двигаться вперед или назад или стоять на месте.
Поскольку мы предполагаем, что MPU6050 вернет 180, когда бот будет вертикально. Мы получим положительные значения коррекции, когда бот падает вперед, и мы получим значения отрицательными, если бот падает назад. Поэтому мы проверяем это условие и вызываем соответствующие функции для перемещения бота вперед или назад.
Выходная переменная PID также определяет, как быстро двигатель должен вращаться. Если бот вот-вот упадет, мы сделаем небольшую коррекцию, медленно вращая колесо. Если эти незначительные корректировки работают, и все еще, если бот падает, мы увеличиваем скорость двигателя. Значение того, как быстро вращаются колеса, будет определяться алгоритмом PI. Заметим, что для функции Reverse мы умножили значение вывода с -1, чтобы мы могли преобразовать отрицательное значение в положительное.
Работа робота Self Balancing Arduino
После того как вы будете готовы с оборудованием, вы можете загрузить этот код на свою плату Arduino. Убедитесь, что соединения правильные, поскольку мы используем литий-ионную батарею. Поэтому дважды проверьте наличие коротких замыканий и убедитесь, что клеммы не соприкасаются, даже если ваш бот испытывает небольшие удары. Включите ваш модуль и откройте свой последовательный монитор, если ваш Arduino может связаться с MPU6050 успешно, и если все работает должным образом, вы увидите следующий экран.
Здесь мы видим входные и выходные значения ПИД-алгоритма в формате input => output. Если бот отлично сбалансирован, значение выхода будет равно 0. Входное значение — это текущее значение от датчика MPU6050. Символ «F» означает, что бот движется вперед, а «R» означает, что бот обратно.
Надеюсь, это поможет создать собственный робот-балансировщик =).
В итоге получился довольно забавный робот , который может видеть перед собой препятствия, анализировать ситуацию и затем, только выбрав лучший маршрут, едет дальше. Робот получился очень маневренным. Он способен разворачиваться на 180 градусов, а угол поворота составляет 45 и 90 градусов. В качестве основного контроллера автор использовал Iteaduino, который является аналогом Arduino.
Материалы и инструменты для изготовления робота:
- микроконтроллер (Arduino или ему подобный Iteaduino);
- ультразвуковой датчик;
- держатель для батареек;
- китайские игрушки для создания колесной базы (можно купить готовую);
- кусачки;
- клей;
- провода;
- моторчики;
- ДВП;
- лобзик;
- транзисторы (D882 P).
Процесс изготовления робота:
Шаг первый. Создание колесной базы
Для того чтобы создать колесную базу автор прикупил две китайские игрушечные машинки. Впрочем, по этому поводу можно и не беспокоиться, если есть лишние деньги, так как уже готовую базу можно купить. С помощью кусачек машинки были разрезаны на две части, чтобы образовалось две ведущих оси. Далее эти части были склеены. Впрочем, в таком случае можно поработать и паяльником, пластмасса отлично спаивается.
Выбирая машинки, лучше всего брать игрушки с обычными колесами, так как, по словам автора, с такими шипами как у него, робот сильно скачет.
Есть еще один такой момент, когда от моторчиков будут выводиться провода, на одном из них нужно не забыть сменить полярность.
Шаг второй. Изготовление верхней крышки
Верхняя крышка робота изготавливается из ДВП, также для этих целей можно использовать толстый картон. В крышке можно увидеть прямоугольно отверстие, оно должно быть расположено так, чтобы ось сервопривода, которая будет в него вставлена, располагалась симметрично. Что касается отверстия посередине, то через него будут выводиться провода.
Шаг третий. Начинка робота
Для подключения шасси лучше всего использовать отдельный источник питания, поскольку для питания контроллера требуется 9В, а для моторчиков нужно всего 3В. Вообще в шасси таких машинок уже встроены держатели батареек, их просто нужно соединить параллельно.
К контроллеру моторчики подключаются при помощи транзисторов типа D882 P. Они были вытащены из старого пульта управления машинкой. Лучше всего конечно использовать силовые транзисторы типа TIP120Б, но автор выбирал просто по подходящим характеристикам. Вся электронная часть подключается по указанной схеме.
После прошивки робота он будет готов к тестированию. Чтобы робот успевал развернуться на определенный угол, нужно правильно выбрать время работы моторчиков.
Что касается датчиков, то ультразвуковой нужно подключить к 7-му цифровому выходу микроконтроллера. Серводвигатель подключается к 3-му цифровому входу, база транзистора левого мотора подключается к 11 контакту, а база правого к 10-му.
Если в качестве питания будет использоваться Крона, то минус подключается к GND, а плюс к VIN. Еще к GND нужно подключить эмиттер транзистора и отрицательный контакт от источника питания шасси робота.
Всем Доброго Времени Суток! Данная статья будет посвящена любителям электроники, робототехники, а также людям с нестандартным взглядом на окружающие вещи!
Итак сейчас я постараюсь максимально наглядно описать процесс создания, сборки робота с электронной начинкой, а именно, на Ардуино! Поехали!
Что нам понадобится:
Трёхпроводной шлейф
(3 штуки). Желательно взять подлиннее.
Обычные провода
Потенциометры
Резисторы (220 Ом)
Кнопка
Батарейный отсек с аккумуляторами
Макетная плата
Ну и, безусловно, сама ардуинка
А также плата расширения к ней - что то вроде MultiservoShield , для управления большим количеством сервоприводов
И еще любой конструктор , который будет основой нашего робота, поэтому желательно выбрать "крепкий"
Из инструментов понадобится:
Набор отверток, ключей и т.п.
А также паяльник, припой и флюс
Ну теперь начнем!
Шаг№1. Изготовление основного каркаса
Для начала соберем "две буквы Н" Выглядит это вот так:
Затем некоторую конструкцию, на которой наш робот будет стоять. Совсем необязательно как на рисунке - на ваше усмотрение.. У меня получилось так:
Устанавливаем нашу "Н" на опору
Снизу закручиваем болты
На другой "Н" закрепляем первый сервопривод, отвечающий за повороты головы нашего будущего робота
Получается что-то следующее:
Почти каркас готов! Осталось скрепить эти две конструкции металлическими пластинками и придать роботу высоты!
Шаг№2 Изготовление каркаса для будущих ушей робота
Для этого нам необходимо собрать две подобные конструкции и закрепить на них сервоприводы, как показано на рисунке:
Затем с помощью болтов и гаек соединим с основным каркасом. Получится следующее:
Вид сверху:
Ну что же, некий прообраз робота почти готов! Идем дальше..
Шаг№3. Изготовление глаз и вообще всей головы нашего робота!
Именно для этого я использовал старую трубку от домофона. Лично мне она напоминает лицо! Увидите дальше..
Проделываем два отверстия и прикручиваем качалку для сервопривода к трубке
Сразу же приклеим светодиоды по бокам и припаяем к ним проводки
Я использовал тоненькие:
Вот что получилось!
Шаг№4 Изготовление ушей
Будем использовать обычные крышечки от маленьких коробочек
Также прикрутим качалки для серв
Теперь смело фиксируем части тела робота на сервах
Вот так:
Вид сверху:
Сзади:
В принципе наслаждаться роботом можно и сейчас, но мы усложним задачу.. Будем поворачивать глаза и уши робота с помощью потенциометров и нашей ардуинки
Шаг№5 Электроника
Соединив ардуино с мультисервошилдом, вставляем трехпроводной шлейф от каждой сервы к пинам 9, 10, 11 (Левое ухо, Правое ухо, Цент, если поставить робота лицом к нам)
Затем на макетной плате устанавливаем потенциометр, кнопку, резисторы.. Выглядеть это будет так, некрасиво конечно, но главное работает)
Более подробно!
Как установить кнопку:
Где белый провод - питание, Красный - цифровой вход микроконтроллера №6, а резистор уходит на землю(желтый провод)
Как установить потенциометр:
Красный провод - питание, Желтый - земля, Белый - аналоговый вход микроконтроллера №0 (другой потенциометр присоединяем точно также, только аналоговый вход контроллера №1)
На плате устанавливаем также резисторы для светодиодов
:
ток будет подаваться с 3 и 5 пинов ардуино, а приходить по желтому и черному проводу и через резисторы уходить в землю (GND контроллера)
Ну в принципе все, с электроникой мы закончили! Осталось только вгрузить следующий скетч и поиграться с роботом!!
#include #include Multiservo myservo1; Multiservo myservo2; Multiservo myservo3; int b,k1,p1,p2; int A = 0; int i = 0; unsigned long m2=0; unsigned long m1=0; int r1=70; int r2=110; int r3=70; int h1=0; int h=0; void setup() { myservo1.attach(9); // левое ухо myservo2.attach(10); // правое ухо myservo3.attach(11); // глаза pinMode(6,INPUT); // кнопка pinMode(3,OUTPUT); //глаза огни PWM pinMode(5,OUTPUT); } void loop() { while(A==0) // цикл ручного управления роботом { b = digitalRead(6); if (!b) k1 = 1; if (b==1 && k1 == 1) { delay(10); b = digitalRead(6); if(b==1 && k1 == 1) { A=1; k1=0; } } p1=int(analogRead(A0)/6); p2=int(analogRead(A1)/6); myservo1.write(p1); myservo2.write(p1); myservo3.write(p2); analogWrite(3,i); analogWrite(5,i); if(millis() >= m1+70 && h1==0) { i=i+4; m1=millis(); if(i>250) h1=1; } if(millis() >= m1+70 && h1==1) { i=i-4; m1=millis(); if(i==0) h1=0; } } while(A==1) // цикл автономной работы робота { digitalWrite(13,0); b = digitalRead(6); if (!b) k1 = 1; if (b==1 && k1 == 1) { delay(10); b = digitalRead(6); if(b==1 && k1 == 1) { A=0; k1=0; } } analogWrite(3,i); analogWrite(5,i); if(millis() >= m1+70 && h1==0) { i=i+4; m1=millis(); if(i>250) h1=1; } if(millis() >= m1+70 && h1==1) { i=i-4; m1=millis(); if(i==0) h1=0; } if(millis() >= m2+15 && h==0) { myservo1.write(r1); myservo2.write(r2); myservo3.write(r3); r1=r1+1; r2=r2-1; r3=r3+1; if(r1==110) h=1; m2=millis(); } if(millis() >= m2+15 && h==1) { myservo1.write(r1); // 110 myservo2.write(r2); // 70 myservo3.write(r3); // 110 r1=r1-1; r2=r2+1; r3=r3-1; if(r1==70) h=0; m2=millis(); } } }
Код немаленький, но поверьте это того стоит!
Кратко, что выполняет данная программа:
У нас есть кнопка, которая отвечает за 2 состояния системы: либо мы управляем роботом вручную, либо он осуществляет уже прописанные заранее движения. При нажатии на кнопку для нас меняются состояния, а в коде - меняются 2 цикла между собой, в которых прописаны соответствующие команды. Глаза нашего робота постепенно загораются, становятся все ярче и ярче, а затем затухают. именно поэтому мы подкличили светодиоды к пинам, поддерживающим PWM - широтно-импульсную модуляцию.