Управление светодиодом из 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();
}
Разберём новые элементы по шагам:
- Заголовочные файлы:
#include <RosDuino.h>— подключает основную библиотеку и создаёт объектros;#include <std_msgs/msg/Bool.h>— подключает стандартный тип сообщения ROS 2 с одним логическим полемdata(trueилиfalse).
- Функция-обработчик (
onLed): Когда из ROS 2 в топик приходит новое сообщение, библиотека сама вызывает функциюonLed(std_msgs::Bool msg)и передаёт в неё полученное сообщениеmsg. Еслиmsg.dataравноtrue, на пинD48подаётсяHIGH, иначе —LOW. - Регистрация узла и подписки в
setup():ros.begin("led_board");— запускает обмен с агентом и задаёт имя узла ROS 2 (led_board);ros.subscribe("led", onLed);— подписывает плату на топикledи связывает его с функциейonLed. Тип топика (std_msgs/msg/Bool) библиотека определяет автоматически по аргументу функцииonLed.
- Обслуживание связи в
loop(): Вызовros.update()проверяет новые пакеты от агента, вызывает обработчики подписок и поддерживает связь с компьютером.
Пошаговая практика
1. Загрузите скетч в плату
- Убедитесь, что
rosduino_agentещё не запущен, а вкладка утилиты мониторинга порта в Arduino IDE закрыта. - Скопируйте приведённый выше скетч в Arduino IDE 2.
- Проверьте, что выбрана плата Arduino Due (Programming Port) и нужный порт (например,
/dev/ttyACM0или/dev/ttyUSB0). - Нажмите Загрузить (
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».
В журнале агента появится сообщение об успешном рукопожатии с узлом 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}" с пробелом после двоеточия |
Вопросы для самопроверки
- Какие две части входят в систему
RosDuinoи какая из них работает на микроконтроллере, а какая — на компьютере с Ubuntu? - Почему в скетче с
RosDuinoнельзя одновременно использоватьSerial.println()и держать открытой утилиту мониторинга порта в Arduino IDE? - Что нужно сделать в терминале с
rosduino_agentперед тем, как нажать кнопку Загрузить в Arduino IDE? - Как агент
rosduino_agentузнаёт, какое имя узла и какой тип топика нужно создать в ROS 2?
Назад: Установка и запуск агента RosDuino.
Дальше: Домашнее задание.