Домашнее задание
В этом задании вы объедините публикацию данных по таймеру rosduino::Timer, отправку событий кнопки и управление массивом светодиодов D48–D51 из урока 2 в одном узле ROS 2. Внешние детали подключать не обязательно: все кнопки и светодиоды уже распаяны на плате TurtleBro, а analogRead(A8) работает как с потенциометром, так и без него.
Что должно получиться
Напишите скетч, который регистрирует узел board_monitor_node и выполняет три задачи одновременно:
- Публикация аналогового сигнала (10 Гц — каждые
100 мс):- по таймеру
rosduino::Timer(100)считывает полученное значениеanalogRead(A8)(0–1023); - публикует его в топик
/sensor_valueс типомstd_msgs/msg/Int32.
- по таймеру
- Публикация нажатий кнопки
D28(с защитой от дребезга30 мс):- заранее регистрирует в
setup()топик/button_state(std_msgs/msg/Bool) с помощьюros.advertise(), чтобы топик был виден сразу и не терял первое нажатие; - опрашивает кнопку
D28по второму таймеруrosduino::Timer(30); - при каждом изменении состояния кнопки (нажата —
true, отпущена —false) публикует сообщениеstd_msgs/msg/Boolв топик/button_state.
- заранее регистрирует в
- Подписка на уровень светодиодной шкалы (
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).
Как составить алгоритм
- Подключите
<RosDuino.h>,<std_msgs/msg/Int32.h>и<std_msgs/msg/Bool.h>. - Объявите константы пинов (
SENSOR_PIN = A8,BUTTON_PIN = 28, массивLED_PINS[4] = {48, 49, 50, 51}), сообщенияsensorMsgиbuttonMsg, а также два таймера:rosduino::Timer sensorTimer(100);иrosduino::Timer buttonTimer(30);. - Перенесите из урока 2 функцию
void showLitCount(int count), которая в циклеforзажигает первыеcountсветодиодов массива и гасит остальные. - Напишите функцию-обработчик подписки
void onLedLevel(std_msgs::Int32 msg):- ограничьте входное значение:
int count = constrain(msg.data, 0, 4);; - вызовите
showLitCount(count);.
- ограничьте входное значение:
- В
setup()настройте пины кнопки и светодиодов, погасите все светодиоды, считайте начальное состояние кнопки, вызовитеros.begin("board_monitor_node"), зарегистрируйте топик кнопкиros.advertise("button_state", buttonMsg)и подпискуros.subscribe("led_level", onLedLevel). - В
loop()вызовитеros.update(), затем проверьтеsensorTimer.check()иbuttonTimer.check().
Как проверить результат из терминала ROS 2
- Остановите
rosduino_agentв Терминале 1 (Ctrl+C), загрузите скетч в плату и снова запустите агент. - Не нажимая кнопку
D28, убедитесь в Терминале 2, что топик/button_stateуже виден в спискеros2 topic list -t, и проверьте частоту публикации/sensor_value:
Частота должна составлять околоros2 topic hz /sensor_value10 Гц. Остановите проверку клавишамиCtrl+C. - В Терминале 2 запустите просмотр состояния кнопки и понажимайте
D28на плате:
Уже с самого первого нажатия должно приходить одно сообщениеros2 topic echo /button_statedata: true, а при отпускании — одно сообщениеdata: false. - Проверьте управление светодиодной шкалой
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.