Keyboard shortcuts

Press ← or → to navigate between chapters

Press S or / to search in the book

Press ? to show this help

Press Esc to hide this help

Управление светодиодом из ROS

Агент rosduino_agent собран и готов к работе. Теперь мы загрузим в плату TurtleBro первый скетч с библиотекой RosDuino, превратим плату в узел ROS 2 с именем /led_board и будем включать и выключать светодиод D48 командами из терминала.

Как устроен скетч с RosDuino

Посмотрите на полный код первого узла — он занимает меньше двадцати строк:

#include <RosDuino.h>
#include <std_msgs/msg/Bool.h>

const int LED_PIN = 48;

// Функция вызывается автоматически при получении сообщения из топика "led".
void onLed(std_msgs::Bool msg) {
  digitalWrite(LED_PIN, msg.data ? HIGH : LOW);
}

void setup() {
  pinMode(LED_PIN, OUTPUT);
  digitalWrite(LED_PIN, LOW);

  ros.begin("led_board");
  ros.subscribe("led", onLed);
}

void loop() {
  ros.update();
}

Разберём новые элементы по шагам:

  1. Заголовочные файлы:
    • #include <RosDuino.h> — подключает основную библиотеку и создаёт объект ros;
    • #include <std_msgs/msg/Bool.h> — подключает стандартный тип сообщения ROS 2 с одним логическим полем data (true или false).
  2. Функция-обработчик (onLed): Когда из ROS 2 в топик приходит новое сообщение, библиотека сама вызывает функцию onLed(std_msgs::Bool msg) и передаёт в неё полученное сообщение msg. Если msg.data равно true, на пин D48 подаётся HIGH, иначе — LOW.
  3. Регистрация узла и подписки в setup():
    • ros.begin("led_board"); — запускает обмен с агентом и задаёт имя узла ROS 2 (led_board);
    • ros.subscribe("led", onLed); — подписывает плату на топик led и связывает его с функцией onLed. Тип топика (std_msgs/msg/Bool) библиотека определяет автоматически по аргументу функции onLed.
  4. Обслуживание связи в loop(): Вызов ros.update() проверяет новые пакеты от агента, вызывает обработчики подписок и поддерживает связь с компьютером.

Пошаговая практика

1. Загрузите скетч в плату

  1. Убедитесь, что rosduino_agent ещё не запущен, а вкладка утилиты мониторинга порта в Arduino IDE закрыта.
  2. Скопируйте приведённый выше скетч в Arduino IDE 2.
  3. Проверьте, что выбрана плата Arduino Due (Programming Port) и нужный порт (например, /dev/ttyACM0 или /dev/ttyUSB0).
  4. Нажмите Загрузить (Upload) и дождитесь завершения записи.

2. Запустите агент в Терминале 1

Откройте первое окно терминала (Терминал 1), подключите окружение рабочего пространства и запустите rosduino_agent, указав порт вашей платы (тот же самый путь /dev/ttyACM0 или /dev/ttyUSB0, который был выбран в Arduino IDE):

Терминал 1:

source ~/ros2_ws/install/setup.bash
ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0

Если ваша плата определилась как /dev/ttyUSB0, укажите --port /dev/ttyUSB0. Напоминание о том, как посмотреть список портов через ls -l /dev/serial/by-id/, есть в справочном материале на странице «Установка в Linux».

Ожидаемый результат в Терминале 1

В журнале агента появится сообщение об успешном рукопожатии с узлом led_board и создании подписки на топик /led. Оставьте Терминал 1 открытым — агент должен продолжать работать.

3. Проверьте узел и топики в Терминале 2

Откройте второе окно терминала (Терминал 2) и проверьте, что плата появилась в графе ROS 2.

Терминал 2:

ros2 node list

Ожидаемый вывод:

/led_board

Посмотрите список доступных топиков вместе с их типами (флаг -t):

Терминал 2:

ros2 topic list -t

Ожидаемый вывод:

/diagnostics [diagnostic_msgs/msg/DiagnosticArray]
/led [std_msgs/msg/Bool]
/parameter_events [rcl_interfaces/msg/ParameterEvent]
/rosout [rcl_interfaces/msg/Log]

4. Включите и выключите светодиод D48 из ROS 2

Опубликуйте одно сообщение (--once) со значением true в топик /led:

Терминал 2:

ros2 topic pub --once /led std_msgs/msg/Bool "{data: true}"

Светодиод D48 на плате сразу загорится. Теперь отправьте false:

Терминал 2:

ros2 topic pub --once /led std_msgs/msg/Bool "{data: false}"

Светодиод D48 погаснет.

Автоматическое восстановление связи

Если во время работы нажать кнопку Reset на плате или на секунду переткнуть USB-кабель, перезапускать rosduino_agent не нужно: агент сам заметит перезагрузку платы, заново проведёт рукопожатие и восстановит топик /led.

Если узел или светодиод не работают

НаблюдениеЧто проверить
Ошибка Permission denied при запуске агентаПроверьте, что пользователь добавлен в группу dialout (см. урок 1, страница установки в Linux) и что утилита мониторинга порта в Arduino IDE закрыта
Arduino IDE не может загрузить скетч в платуВ Терминале 1 остановите rosduino_agent клавишами Ctrl+C, загрузите скетч и затем снова запустите агент
Команда ros2 node list не показывает /led_boardПроверьте, что в --port указан правильный порт платы, а скетч с ros.begin("led_board") успешно загружен
Топик /led виден, но светодиод не загораетсяПроверьте, что в скетче указан пин 48, а в команде терминала написано "{data: true}" с пробелом после двоеточия

Вопросы для самопроверки

  1. Какие две части входят в систему RosDuino и какая из них работает на микроконтроллере, а какая — на компьютере с Ubuntu?
  2. Почему в скетче с RosDuino нельзя одновременно использовать Serial.println() и держать открытой утилиту мониторинга порта в Arduino IDE?
  3. Что нужно сделать в терминале с rosduino_agent перед тем, как нажать кнопку Загрузить в Arduino IDE?
  4. Как агент rosduino_agent узнаёт, какое имя узла и какой тип топика нужно создать в ROS 2?

Назад: Установка и запуск агента RosDuino.
Дальше: Домашнее задание.