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

Домашнее задание

В этом задании вы объедините публикацию данных по таймеру rosduino::Timer, отправку событий кнопки и управление массивом светодиодов D48–D51 из урока 2 в одном узле ROS 2. Внешние детали подключать не обязательно: все кнопки и светодиоды уже распаяны на плате TurtleBro, а analogRead(A8) работает как с потенциометром, так и без него.

Что должно получиться

Напишите скетч, который регистрирует узел board_monitor_node и выполняет три задачи одновременно:

  1. Публикация аналогового сигнала (10 Гц — каждые 100 мс):
    • по таймеру rosduino::Timer(100) считывает полученное значение analogRead(A8) (0–1023);
    • публикует его в топик /sensor_value с типом std_msgs/msg/Int32.
  2. Публикация нажатий кнопки D28 (с защитой от дребезга 30 мс):
    • заранее регистрирует в setup() топик /button_state (std_msgs/msg/Bool) с помощью ros.advertise(), чтобы топик был виден сразу и не терял первое нажатие;
    • опрашивает кнопку D28 по второму таймеру rosduino::Timer(30);
    • при каждом изменении состояния кнопки (нажата — true, отпущена — false) публикует сообщение std_msgs/msg/Bool в топик /button_state.
  3. Подписка на уровень светодиодной шкалы (D48–D51):
    • подписывается на топик /led_level с типом std_msgs/msg/Int32;
    • при получении сообщения ограничивает значение msg.data диапазоном от 0 до 4 через constrain(msg.data, 0, 4) и зажигает соответствующее количество светодиодов из массива {48, 49, 50, 51} (0 — все погашены, 1 — горит только D48, …, 4 — горят все четыре светодиода).

Требования к программе

  • В функции loop() вызывается ros.update() и не используется delay().
  • Топик кнопки предварительно регистрируется в setup() после ros.begin() вызовом ros.advertise("button_state", buttonMsg);.
  • Для периодического опроса применяются два объекта rosduino::Timer (100 мс и 30 мс).
  • Для управления четырьмя светодиодами используется массив пинов const int LED_PINS[4] = {48, 49, 50, 51}; и цикл for (как в уроке 2).

Как составить алгоритм

  1. Подключите <RosDuino.h>, <std_msgs/msg/Int32.h> и <std_msgs/msg/Bool.h>.
  2. Объявите константы пинов (SENSOR_PIN = A8, BUTTON_PIN = 28, массив LED_PINS[4] = {48, 49, 50, 51}), сообщения sensorMsg и buttonMsg, а также два таймера: rosduino::Timer sensorTimer(100); и rosduino::Timer buttonTimer(30);.
  3. Перенесите из урока 2 функцию void showLitCount(int count), которая в цикле for зажигает первые count светодиодов массива и гасит остальные.
  4. Напишите функцию-обработчик подписки void onLedLevel(std_msgs::Int32 msg):
    • ограничьте входное значение: int count = constrain(msg.data, 0, 4);;
    • вызовите showLitCount(count);.
  5. В setup() настройте пины кнопки и светодиодов, погасите все светодиоды, считайте начальное состояние кнопки, вызовите ros.begin("board_monitor_node"), зарегистрируйте топик кнопки ros.advertise("button_state", buttonMsg) и подписку ros.subscribe("led_level", onLedLevel).
  6. В loop() вызовите ros.update(), затем проверьте sensorTimer.check() и buttonTimer.check().

Как проверить результат из терминала ROS 2

  1. Остановите rosduino_agent в Терминале 1 (Ctrl+C), загрузите скетч в плату и снова запустите агент.
  2. Не нажимая кнопку D28, убедитесь в Терминале 2, что топик /button_state уже виден в списке ros2 topic list -t, и проверьте частоту публикации /sensor_value:
    ros2 topic hz /sensor_value
    
    Частота должна составлять около 10 Гц. Остановите проверку клавишами Ctrl+C.
  3. В Терминале 2 запустите просмотр состояния кнопки и понажимайте D28 на плате:
    ros2 topic echo /button_state
    
    Уже с самого первого нажатия должно приходить одно сообщение data: true, а при отпускании — одно сообщение data: false.
  4. Проверьте управление светодиодной шкалой D48–D51 командами из Терминала 2:
    ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 2}"
    ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 4}"
    ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 0}"
    
    При отправке 2 загорятся D48 и D49, при отправке 4 — все четыре светодиода, при отправке 0 — все погаснут.

Посмотреть решение и разбор

Назад: Одновременная публикация и подписка.
Дальше: Урок 6. Сервисы в RosDuino.