Следующий вдоль линии робот на Raspberry Pi


Робот, следующий вдоль линии (Line Follower Robot), является одним из самых популярных проектов для тех, кто только начал заниматься робототехникой. Данный робот способен самостоятельно передвигаться вдоль черной линии, используя для этого пару инфракрасных датчиков и пару электродвигателей постоянного тока. В данной статье мы рассмотрим создание подобного робота на основе платы Raspberry Pi.

Внешний вид следующего вдоль линии робота на Raspberry Pi

Конечно, вычислительная мощность платы Raspberry Pi для этого проекта очень избыточна, такого робота, следующего вдоль линии, можно легко создать на основе платы Arduino или микроконтроллера AVR. Но данный проект имеет обучающий характер и преследует цель обучить вас начальным знаниям робототехники с реализацией на основе платы Raspberry Pi. Данный простейший робот может быть использован в качестве основы для создания значительно более "продвинутых" роботов (например, робот для уборки помещений), в которых вычислительные мощности и возможности платы Raspberry Pi можно будет использовать в полной мере.

Необходимые компоненты

  1. Плата Raspberry Pi (купить на AliExpress).
  2. Инфракрасный датчик – 2 шт. (купить на AliExpress).
  3. Электродвигатель постоянного тока – 2 шт.
  4. Микросхема драйвера двигателей L293D (купить на AliExpress).
  5. Шасси робота (можно сконструировать самому).
  6. Power bank или любой другой подходящий источник питания.

Реклама: ООО "АЛИБАБА.КОМ (РУ)" ИНН: 7703380158

Принцип работы робота, следующего вдоль линии

Следующий вдоль линии робот способен обнаруживать/отслеживать линию с помощью пары инфракрасных датчиков. Каждый инфракрасный датчик имеет в своем составе инфракрасный передатчик (IR Transmitter) и инфракрасный приемник (IR receiver), роль которого выполняет фотодиод. Инфракрасный передатчик излучает инфракрасный свет, а инфракрасный приемник принимает эти отраженные от препятствия лучи (если оно есть). При этом не все поверхности способны хорошо отражать инфракрасные лучи, некоторые поверхности практически полностью поглощают эти лучи. К примеру, от светлой (белой) поверхности инфракрасные лучи отражаются хорошо, а вот черной поверхностью они полностью поглощаются как показано на рисунках ниже. На этих свойствах инфракрасного цвета и будет основан принцип работа нашего робота, следующего вдоль линии.

Отражение света белой поверхностью

Поглощение света черной поверхностью

Внешний вид инфракрасного датчика показан на следующем рисунке. Более подробно о его подключении к плате Raspberry Pi можно посмотреть в следующей статье.

Внешний вид инфракрасного датчика

Таким образом, в составе нашего проекта будет два инфракрасных датчика, которые будут отслеживать местоположение линии и два двигателя, которые будут перемещать робота вдоль этой линии. Эти двигатели будут потреблять достаточно большой ток и должны быть двунаправленными, поэтому для управления ими в нашем проекте мы использовали микросхему драйвера двигателей L293D. Обрабатывать данные с инфракрасных датчиков и управлять работой двигателей в нашем проекте будет плата Raspberry Pi. Структурная схема работы проекта показан на следующем рисунке.

Структурная схема работы проекта

Если ни один из датчиков не будет обнаруживать черную линию, то робот будет двигаться прямо. Эта ситуация показана на нижеприведенном рисунке.

Робот движется прямо

Если левый датчик обнаруживает черную линию, то робот поворачивает влево.

Робот должен повернуть влево

Если правый датчик обнаруживает черную линию, то робот поворачивает вправо.

Робот должен повернуть вправо

Если оба датчика обнаруживают черную линию, робот останавливается.

Робот должен остановиться

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

Схема проекта

Схема следующего вдоль линии робота на Raspberry Pi представлена на следующем рисунке.

Схема следующего вдоль линии робота на Raspberry PiСхема содержит плату Raspberry Pi и подключенные к ней инфракрасные датчики и микросхему L293D, к которой уже подключены двигатели. Схема запитывается от мобильного Power bank (на схеме он нарисован в виде батареи формата AAA).

Распиновка контактов ввода/вывода платы Raspberry Pi показана на следующем рисунке.

Распиновка контактов ввода/вывода платы Raspberry Pi

Плата Raspberry Pi запитывается от Power bank, а инфракрасные датчики – от контакта +5V платы (провода красного цвета на схеме). Общий провод (земля) на схеме обозначен линиями черного цвета. Провод желтого цвета используется для подключения выходных контактов инфракрасных датчиков к контактам GPIO платы Raspberry Pi.

Для управления двигателями нам необходимо четыре контакта (A,B,A,B). Эти контакты подключены к контактам GPIO 14, 4, 17 и 18 платы Raspberry Pi соответственно. Провода оранжевого и белого цвета вместе формируют соединение для подключения одного двигателя.

Двигатели подключены к микросхеме L293D, которая запитывается от power bank. Перед тестированием работы схемы убедитесь в том, что земля power bank подключена к земле платы Raspberry Pi, иначе схема работать не будет.

Объяснение программы для Raspberry Pi

Полный код программы приведен в конце статьи, здесь же мы кратко рассмотрим его основные фрагменты.

После сборки проекта у вас должна получиться конструкция примерно следующего вида:

Вид робота спереди Вид робота сзади

После этого можно приступать к написанию кода программы.

В программе нам первым делом необходимо подключить (импортировать) библиотеку для работы с контактами ввода/вывода. Также мы импортируем эту библиотеку RPi.GPIO под именем “IO” (то есть переименовываем ее для использования в программе), то есть далее в программе всегда, когда мы захотим обратиться к контактам ввода/вывода, мы будем использовать слово ‘IO’.

Иногда контакты ввода/вывода (GPIO pins), которые мы собираемся использовать в программе, могут выполнять другие функции. В этом случае во время исполнения программы мы будем получать предупреждения (warnings). Следующей командой мы укажем плате Raspberry Pi на то, чтобы она игнорировала эти предупреждения и продолжала исполнение программы.

Мы можем обращаться к контактам ввода/вывода (GPIO pins) платы Raspberry Pi используя либо номер контакта на плате, либо его функциональный номер. В представленной выше распиновке контактов ввода/вывода можно увидеть, к примеру, что обозначение GPIO19 соответствует контакту PIN 35. То есть в зависимости от того, какой способ обращения к контактам мы выбрали, мы можем обращаться к рассмотренному контакту либо по номеру ‘35’, либо по номеру ‘19’. В данном проекте мы выберем способ обращения к контактам по их функциональным номерам, поэтому используем следующую команду:

Далее сконфигурируем 6 контактов в качестве цифровых входов/выходов. Первые два из этих контактов будут использоваться для считывания данных с инфракрасных датчиков. С остальных 4-х контактов будет осуществляться управление двигателями (по 2 контакта на каждый двигатель).

Если на выходе инфракрасного датчика “True”, это значит, что его сигнал отражается от белой поверхности, следовательно, робот может двигаться прямо.

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

Если второй инфракрасный датчик обнаруживает под собой черную линию, мы должны начать поворот робота влево (останавливаем левый двигатель).

Если оба инфракрасных датчика обнаруживают перед собой черную линию, это значит, что робот должен остановиться.

Тестирование работы проекта

После того как аппаратная часть проекта будет готова загрузите программу в Raspberry Pi и запустите ее на выполнение. Для работы робота нам будет необходим портативный источник питания – для этой цели хорошо подойдет power bank. Мы использовали power bank с двумя USB портами: один из них используется для подачи питания на плату Raspberry Pi, а второй – для подачи питания на микросхему драйвера двигателя как показано на следующем рисунке.

Подключение power bank с двумя USB портами для питания робота

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

Исходный код программы на Python

Видео, демонстрирующее работу робота

(Проголосуй первым!)
Загрузка...
456 просмотров

Добавить комментарий

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