Урок 5. Решение задания
На этой странице разобрано решение домашнего задания урока 5. Узел /board_monitor_node одновременно публикует аналоговый сигнал с разъёма GPIO A8 с частотой 10 Гц, отправляет события нажатия кнопки D28 и управляет шкалой из четырёх светодиодов D48–D51 по командам из топика /led_level.
Полный код скетча
#include <RosDuino.h>
#include <std_msgs/msg/Bool.h>
#include <std_msgs/msg/Int32.h>
const int SENSOR_PIN = A8;
const int BUTTON_PIN = 28;
const int LED_COUNT = 4;
const int LED_PINS[LED_COUNT] = {48, 49, 50, 51};
std_msgs::Int32 sensorMsg;
std_msgs::Bool buttonMsg;
rosduino::Timer sensorTimer(100); // 10 Гц для аналогового сигнала
rosduino::Timer buttonTimer(30); // 30 мс для опроса кнопки без дребезга
int lastButtonState = LOW;
// Включает первые count светодиодов массива и гасит остальные.
void showLitCount(int count) {
for (int i = 0; i < LED_COUNT; i++) {
if (i < count) {
digitalWrite(LED_PINS[i], HIGH);
} else {
digitalWrite(LED_PINS[i], LOW);
}
}
}
// Обработчик команд из топика "/led_level".
void onLedLevel(std_msgs::Int32 msg) {
int level = constrain(msg.data, 0, LED_COUNT);
showLitCount(level);
}
void setup() {
pinMode(BUTTON_PIN, INPUT);
for (int i = 0; i < LED_COUNT; i++) {
pinMode(LED_PINS[i], OUTPUT);
}
showLitCount(0);
lastButtonState = digitalRead(BUTTON_PIN);
ros.begin("board_monitor_node");
ros.advertise("button_state", buttonMsg);
ros.subscribe("led_level", onLedLevel);
}
void loop() {
ros.update();
// Задача 1: публикация аналогового сигнала каждые 100 мс (10 Гц).
if (sensorTimer.check()) {
sensorMsg.data = analogRead(SENSOR_PIN);
ros.publish("sensor_value", sensorMsg);
}
// Задача 2: опрос кнопки каждые 30 мс и публикация при смене состояния.
if (buttonTimer.check()) {
int reading = digitalRead(BUTTON_PIN);
if (reading != lastButtonState) {
lastButtonState = reading;
buttonMsg.data = (lastButtonState == HIGH);
ros.publish("button_state", buttonMsg);
}
}
}
Как устроено решение
- Два независимых таймера
rosduino::Timer: объектsensorTimer(100)отвечает за равномерную отправку значенийanalogRead(A8)10 раз в секунду, аbuttonTimer(30)считывает кнопку раз в 30 мс, отсекая механический дребезг контактов без остановкиloop(). - Предварительная регистрация и экономия канала для кнопки: вызов
ros.advertise("button_state", buttonMsg)вsetup()создаёт топик/button_stateсразу при подключении агента, не отправляя сообщение. А вloop()вызовros.publish("button_state", buttonMsg)находится внутри проверкиif (reading != lastButtonState): пакеты уходят в ROS 2 только в момент нажатия (true) и отпускания (false), причём самое первое нажатие доставляется без потерь. - Управление линейкой светодиодов (
onLedLevel): когда из ROS 2 приходит сообщение в топик/led_level, функцияconstrain(msg.data, 0, LED_COUNT)защищает программу от чисел меньше0и больше4, а знакомая по уроку 2 функцияshowLitCount()включает нужное число светодиодов.
Как проверить решение
- Остановите
rosduino_agentв Терминале 1 (Ctrl+C), загрузите скетч в плату и снова запустите агент:ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0 - Не нажимая кнопку
D28, проверьте список топиков в Терминале 2 — благодаряros.advertise()топик/button_stateпоявляется сразу после подключения агента:ros2 topic list -t # Ожидаемые пользовательские топики: # /button_state [std_msgs/msg/Bool] # /led_level [std_msgs/msg/Int32] # /sensor_value [std_msgs/msg/Int32] - Запустите просмотр
ros2 topic echo /button_stateи нажмите кнопкуD28— уже первое нажатие выведетdata: true, а отпускание —data: false. Затем проверьте частоту публикации аналогового сигнала:ros2 topic hz /sensor_value - Проверьте зажигание светодиодов
D48–D51командами из Терминала 2:ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 1}" ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 3}" ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 4}" ros2 topic pub --once /led_level std_msgs/msg/Int32 "{data: 0}"
Ответы на вопросы для самопроверки
-
Какую задачу решает класс
rosduino::Timerи почему с ним не нужно вручную хранить переменнуюlastTimeдляmillis()?
Классrosduino::Timerхранит интервал и время последнего срабатывания внутри самого объекта. Методtimer.check()сам сравнивает текущее времяmillis()с сохранённым и возвращаетtrue, когда интервал истёк, поэтому код остаётся коротким и не блокируетros.update(). -
Что происходит при самом первом вызове
ros.publish()без предварительной регистрации и зачем для кнопки вsetup()вызываютros.advertise()?
Без предварительной регистрации первый вызовros.publish("имя_топика", msg)только регистрирует издателя в агенте (по типу переменнойmsg), поэтому до этого вызова топика не видно вros2 topic list, а само первое сообщение теряется. Для периодического датчика это не страшно, так как следом сразу идут новые измерения. Для кнопки же вызовros.advertise("button", pressed)вsetup()создаёт топик сразу при подключении агента без отправки сообщения, благодаря чему топик сразу виден в ROS 2 и первое нажатие не пропадает. -
Какой командой в терминале можно измерить фактическую частоту публикации сообщений в топике
/sensor_percent?
Командойros2 topic hz /sensor_percent. -
Почему для события нажатия кнопки лучше вызывать
ros.publish()только при смене состояния пина, а не отправлять поток сообщений при удержании или в каждом циклеloop()?
При отправке в каждомloop()плата перегрузит последовательный порт сотнями одинаковых пакетов в секунду, а при отправке по таймеру во время удержания даже одно короткое нажатие породит несколько дублирующих сообщений подряд. Публикация только при смене состояния передаёт ровно одно сообщение в момент нажатия и одно в момент отпускания.
Назад: Домашнее задание.
Дальше: Урок 6. Сервисы в RosDuino.