Давайте поговорим о том как можно использовать Ардуино для создания робота, который балансирует как Сигвей.
Сигвей от англ. Segway – двухколесное средство передвижения стоя, оснащенное электроприводом. Еще их называют гироскутерами или электрическими самокатами.
Вы когда-нибудь задумывались, как работает Сигвей? В этом уроке мы постараемся показать вам, как сделать робота Ардуино, который уравновешивает себя точно так же, как Segway.
Чтобы сбалансировать робота, двигатели должны противодействовать падению робота. Это действие требует обратной связи и корректирующих элементов. Элемент обратной связи - , который обеспечивает как ускорение, так и вращение во всех трех осях (). Ардуино использует это, чтобы знать текущую ориентацию робота. Корректирующим элементом является комбинация двигателя и колеса.
В итоге должен получиться примерно такой друг:
Модуль драйвера двигателя L298N:
Мотор редуктора постоянного тока с колесом:
Самобалансирующийся робот по существу является перевернутым маятником. Он может быть лучше сбалансирован, если центр массы выше относительно колесных осей. Высший центр масс означает более высокий момент инерции массы, что соответствует более низкому угловому ускорению (более медленное падение). Вот почему мы положили батарейный блок на верх. Однако высота робота была выбрана исходя из наличия материалов 🙂
Завершенный вариант самостоятельно балансирующего робота можно посмотреть на рисунке выше. В верхней части находятся шесть Ni-Cd-батарей для питания печатной платы. В промежутках между моторами используется 9-вольтовая батарея для драйвера двигателя.
В теории управления, удерживая некоторую переменную (в данном случае позицию робота), требуется специальный контроллер, называемый ПИД (пропорциональная интегральная производная). Каждый из этих параметров имеет «прирост», обычно называемый Kp, Ki и Kd. PID обеспечивает коррекцию между желаемым значением (или входом) и фактическим значением (или выходом). Разница между входом и выходом называется «ошибкой».
ПИД-регулятор уменьшает погрешность до наименьшего возможного значения, постоянно регулируя выход. В нашем самобалансирующем роботе Arduino вход (который является желаемым наклоном в градусах) устанавливается программным обеспечением. MPU6050 считывает текущий наклон робота и подает его на алгоритм PID, который выполняет вычисления для управления двигателем и удерживает робота в вертикальном положении.
PID требует, чтобы значения Kp, Ki и Kd были настроены на оптимальные значения. Инженеры используют программное обеспечение, такое как MATLAB, для автоматического вычисления этих значений. К сожалению, мы не можем использовать MATLAB в нашем случае, потому что это еще больше усложнит проект. Вместо этого мы будем настраивать значения PID. Вот как это сделать:
Поведение робота можно посмотреть ниже на видео:
Нам понадобилось четыре внешних библиотеки, для создания нашего робота. Библиотека PID упрощает вычисление значений P, I и D. Библиотека LMotorController используется для управления двумя двигателями с модулем L298N. Библиотека I2Cdev и библиотека MPU6050_6_Axis_MotionApps20 предназначены для чтения данных с MPU6050. Вы можете загрузить код, включая библиотеки в этом репозитории .
#include
Значения Kp, Ki, Kd могут работать или не работать. Если они этого не делают, выполните шаги, описанные выше. Обратите внимание, что наклона в коде установлен на 173 градуса. Вы можете изменить это значение, если хотите, но обратите внимание, что это угол наклона, которым должен поддерживаться роботом. Кроме того, если ваши двигатели слишком быстры, вы можете отрегулировать значения motorSpeedFactorLeft и motorSpeedFactorRight.
На этом пока всё. До встречи.
В этой статье будет рассмотрено создание самобалансирующегося средства передвижения или просто «Сегвей». Практически все материалы для создания данного устройства легкодоступны.
Само устройство представляет из себя платформу на которой стоит водитель. Путем наклона туловища осуществляется управление двумя электрическими двигателями посредством цепи схем и микроконтроллеров, отвечающих за балансировку.
Материалы:
Шаг первый: Определение требуемых характеристик и проектирование системы.
При создании этого устройства автор старался, чтобы оно укладывалась в такие параметры как:
-проходимость и мощность, необходимая для свободного перемещения даже по гравию
-аккумуляторы достаточной емкостью, чтобы обеспечить как минимум один час беспрерывной работы устройства
-обеспечить возможность беспроводного управления, а так же фиксирование данных о работе устройства на SD-карту для выявления и устранения неисправностей.
Кроме того желательно, чтобы затраты на создание подобного устройства были меньше чем заказ оригинального внедорожного гироскутера.
Согласно приведенной ниже диаграмме, вы можете увидеть схему электрической цепи самобалансирующегося транспортного средства.
Чтобы запитать сдвоенную мостовую схему управления двигателей необходимо напряжение питания в 24 В, этого напряжения легко достигнуть путем последовательного подключения 12 В автомобильных аккумуляторов.
Система построена так, что питание на двигатели подается, только пока нажата кнопка старта, поэтому для быстрой остановки достаточно просто ее отпустить. При этом платформа Arduino должна поддерживать последовательную связь, как с мостовой схемой управления двигателей, так и с беспроводным модулем управления.
За счет датчика InvenSense MPU-6050 на модуле “GY-521”, обрабатывающего ускорение и несущего в себе функции гироскопа, измеряются параметры наклона. Датчик был расположен на двух отдельных платах расширения. По шине l2c поддерживается связь с микроконтроллером Arduino. Причем датчик наклона с адресом 0x68 был запрограммирован таким образом, чтобы выполнять опрос каждый 20 мс и обеспечивать прерывание микроконтроллера Arduino. Другой датчик имеет адрес 0x69 и он подтянут прямо к Arduino.
Когда пользователь встает на платформу скутера, срабатывает концевой выключатель нагрузки, который и активирует режим алгоритма для балансировки Сегвея.
Шаг второй: Создание корпуса гироскутера и установка основных элементов.
Передача мощности двигателей на колеса будет идти за счет зубчатой передачи. Во время укладки основных компонентов в корпус Сегвея очень важно проследить, чтобы вес распределялся равномерно при приведении Сегвея в рабочее вертикальное положение. Поэтому если не учесть распределение веса от тяжелых аккумуляторов, то работа балансировки устройства будет затруднена.
В данном случае автор расположил аккумуляторы сзади, так, что компенсировать вес двигателя, который находится в центре корпуса устройства. Электронные составляющие устройства были уложены в место между двигателем и аккумуляторами. Для последующего тестирования так же была прикреплена временная кнопка старта на ручке Сегвея.
Шаг третий: Электрическая схема.
При проведении тестирования важно принять во внимание такие факторы как безопасность зоны тестирования, а так же защитная экипировка в виде защитных щитков и шлема для водителя.
Можно ли смастерить сигвей своими руками? Насколько это сложно, и какие детали для этого потребуются? Будет ли самодельный аппарат выполнять все те же функции, что и изготовленный на заводе? Куча похожих вопросов возникает в голове человека, решившего соорудить своими руками. Ответ на первый вопрос будет прост и ясен: сделать «электросамокат» самому под силу любому человеку, который хоть немного разбирается в электронике, физике и механике. Причем, работать устройство будет ничуть не хуже произведенного на заводском станке.
Если внимательно присмотреться к гироскутеру, то можно разглядеть в нем довольно простое сооружение: это всего лишь самокат, оснащенный системой автоматической балансировки. По обеим сторонам от платформы расположены 2 колеса. Для осуществления эффективного балансирования конструкции сегвеев снабжены системой индикаторной стабилизации. Поступающие с датчиков наклона импульсы транспортируются на микропроцессоры, а те, в свою очередь, производят электрические сигналы. В итоге гироскутер движется в заданном направлении.
Для того чтобы сделать сегвей своими руками, потребуются следующие элементы:
Среди перечисленных наименований имеются как механические детали, так и электронные элементы, и прочее оборудование.
Собрать сигвей своими руками не так сложно, как кажется на первый взгляд. При наличии всех необходимых составляющих процесс занимает совсем немного времени.
Для того чтобы собрать сигвей своими руками, мало только скрепить механические детали. Электронное управление не менее важно в гироскутере, ведь это достаточно важная составляющая агрегата.
Как сделать сигвей своими руками, чтобы он наверняка работал? Верно - установить программное обеспечение (или ПО). Вот необходимые шаги для выполнения этой задачи:
Вот, пожалуй, и все, что требуется от человека, который решил самостоятельно смастерить сигвей. Понимание тематики и процесса, а также необходимые компоненты позволят соорудить отличный гироскутер в домашних условиях.
Неужели такое сложное устройство, как сигвей, можно сделать самому? Оказывается, можно. Если приложить достаточно усердия и воспользоваться специальными знаниями. Что и сделал молодой инженер по имени Petter Forsberg, окончивший шведский технологический университет Чалмерса по специальности "Автоматизация и мехатроника".
Кроме знаний и умений, ему еще должны были понадобится немалые деньги, скажете вы. Да, деньги понадобились, но не много, около 300 евро, чтобы приобрести определенный набор деталей и оборудования. Результат его стараний - на этом видео:
Двигатели, колеса, цепи, шестерни и аккумуляторы были взяты от двух недорогих китайских электроскутеров. Двигатели позволяют обеспечить 24Вольт, 300Вт, 2750 оборотов в минуту.
Передача осуществляется от малой шестерни на моторе к большой шестерне на руле. Соотношение составляет примерно 6:1, такое высокое соотношение предпочтительнее, чтобы получить лучший крутящий момент и пониженную максимальную скорость. Передача на 12-дюймовом колесе была основана на механизме свободного хода, поэтому пришлось внести необходимые изменения, чтобы можно было водить колесо в обоих направлениях.
Основа платформы - неподвижная ось, на которой должны вращаться оба колеса. Ось крепится тремя алюминиевыми блоками, которые фиксируются с помощью 5мм установочных винтов.
Чтобы иметь возможность поворачивать при управлении сегвеем с помощью наклона рулевой колонки влево и вправо был выполнен чертеж необходимой детали в программе SolidWorks, после чего она была изготовлена на станке с ЧПУ. Программа для станка была написана с применением CAMBAM. Этот же метод был использован для производства коробки для электроники и сборки блока экстренного торможения.
Руль будущего сегвея представляет из себя обычный велосипедный руль, трубка которого присоединена к 25 мм стальной полой трубе. Чтобы сохранять положение рулевой колонки по центру и создать некоторое усилие для обратной связи были задействованы две стальные пружины. На руле также предусмотрена аварийная кнопка, которая подключена к стандартному реле от автомобиля и может снизить мощность двигателя.
Для питания используются два свинцовых аккумулятора 12V 12Ah, которые применяются для моторов на 24V.
Все печатные платы были изготовлены специально для этой разработки. Главная плата берет на себя вычисления, собирает данные от датчиков, таких как гироскоп (ADXRS614), акселерометр (ADXL203) и подстроечный потенциометр, на основании чего способна определить в каком направлении вы хотите повернуть.
Основной процессор AVR ATmega168. Соединение с ноутбуком производится по Bluetooth с использованием RN-41. Два H-моста преобразуют сигналы управления от основной платы на усилие для двигателей. Каждый H-мост имеет ATmega168, связь между платами осуществляется через UART. Вся электроника работает на отдельной батарее (LiPo 7.4V 900mAh).
Чтобы иметь простой доступ к зарядке аккумуляторов, для программирования основной платы, изменения параметров контура управления была сделана небольшая коробка с необходимыми разъемами, переключателем питания электроники и подстроечного потенциометра на верхней стороне.
Программное обеспечение микроконтроллера в основном состоит из фильтра для гироскопа и акселерометра и цикла PD управления. Для теста были взяты два фильтра: Kalman и Complemenatry. Оказалось, что производительность их была очень похожа, но для Complemenatry фильтра требуется меньше вычислений, поэтому именно он был выбран для использования. Также были написаны приложения на Java, чтобы можно было видеть все значения датчиков и сигналов управления, состояния батареи и т.д.
Техническая сторона создания сегвея своими руками на этом видео:
Сейчас всё более популярным делается небольшая самодвижущаяся платформа с двумя колёсами, так называемый Сигвей, который изобрёл Дин Камен. Замечая трудности, с которыми сталкивается человек в коляске при восхождении на тротуар, он увидел возможность создать транспортное средство, которое может помочь людям передвигаться без особых усилий. Камен применил на практике свою идею о создании самобалансирующейся платформы. Первая модель была испытана в 2001 году и это было средство передвижения с кнопками на ручке. Она была разработана для людей с ограниченными возможностями и позволяла им самостоятельно передвигаться даже по пересеченной местности. Новая модель стала известна как “Сигвей РТ”, и уже позволяла рулить, наклоняя влево или вправо рычаг. В 2004 году она начала продаваться в Европе и Азии. Цена самых продвинутых современных моделей, например Segway PTi2 - около 5000 долларов. В последнее время китайские и японские компании создают устройства с различными модификациями и новаторской конструкцией. Некоторые даже делают подобные транспортные средства только с одним колесом, но давайте рассмотрим классический Сигвей.
Segway состоит из платформы и двух колес, размещенных поперечно с приводом от двух электромоторов. Сама система стабилизируется сложной электронной схемой, которая управляет двигателями, принимая во внимание не только наклоны водителя, но и состояние транспортного средства, что позволяет ему всегда оставаться в вертикальном стабильном положении. Водитель, стоя на платформе, контролирует скорость просто перемещая ручку вперед или назад, при наклоне вправо или влево - поворот. Плата управления отслеживает сигналы соответствующих датчиков движения и ориентирования (похожие на те, которые позволяют смартфонам менять ориентацию экрана), чтобы помочь бортовому микропроцессору точно ориентировать платформу. Главный секрет segway не столько в электро-механической части, сколько в коде, который учитывает физику движения со значительной математической точностью обработки данных и предсказания поведения.
Сигвей оснащен двумя бесщеточными электромоторами, сделанных с применением сплава неодим-железо-бора, способными развивать мощность до 2 кВт, благодаря литий-полимерному аккумулятору.
Для создания Сигвея нужно два мотора-редуктора с колесами, аккумулятор, электронная схема, платформа и руль.
Мощность двигателя недорогих моделей примерно 250W, что обеспечивает скорость до 15 км/ч, с относительно низким потреблением тока. Напрямую крутить колеса не могут, потому что высокое число оборотов этих моторов не позволяют получить нужную тягу. Аналогично тому, что происходит, когда вы используете передач вашего велосипеда: за счет увеличения передаточного отношения потеряется скорость, но увеличится усилие, прикладываемое к педали.
Платформа расположена ниже оси моторов. Батарея, вес которой достаточно высок, также находятся под подножкой в симметричном положении, что гарантирует даже без водителя на борту Сигвей остается в вертикальном положении. Кроме того, внутренняя механическая стабильность поможет узлу электронной стабилизации, которая полностью активна, когда водитель присутствует. Присутствие человека на платформе поднимает центр тяжести выше оси колеса, что делает систему нестабильной - это уже будет компенсировать плате электроники.
В принципе, такую вещь можно сделать и самому, купив нужный блок электроники на китайском сайте (они есть в продаже). Монтаж всех частей осуществляется винтами и гайками (не шурупы). Особое внимание должно быть уделено надлежащему натяжению цепи. Крепление батарей осуществляется через U-образные хомуты с небольшими резиновыми прокладками, чтобы обеспечить нужное давление. Рекомендуется добавлять двухсторонний скотч между батареей и платформой, так чтоб не было проскальзывания. Контрольная панель должна быть вставлена между двумя батареями и крепится специальными распорками.
Рычаг управления может быть, а может и нет - ведь сейчас популярны модели сигвеев и без него (минисигвей). В общем вещь интересная и не очень дорогая, так как по информации от знакомых - закупочная оптовая цена в Китае всего 100 долларов.