Публикация данных и таймер rosduino::Timer
Чтобы компьютер робота знал, что происходит вокруг платы, микроконтроллер должен регулярно отправлять полученные значения датчиков в топики ROS 2. В этой части урока мы опубликуем аналоговый сигнал с разъёма GPIO A8 с частотой 10 Гц и измерим эту частоту инструментами ROS 2.
Как работает таймер rosduino::Timer
В уроке 3 для запуска периодического действия без delay() мы создавали переменную unsigned long lastTime и вычисляли разницу millis() - lastTime >= PERIOD.
В библиотеке RosDuino эта проверка уже упакована в удобный класс rosduino::Timer:
rosduino::Timer sensorTimer(100); // период 100 мс (10 раз в секунду)
Внутри loop() достаточно вызвать метод sensorTimer.check(). Он возвращает true, когда прошло заданное количество миллисекунд. Во все остальные проходы цикла он мгновенно возвращает false, не задерживая выполнение ros.update().
Если в скетче нужны два или три разных интервала (например, 50 мс для кнопки и 100 мс для аналогового сигнала), достаточно создать несколько объектов rosduino::Timer с разными периодами.
Как устроена отправка сообщений ros.publish()
Для публикации данных в топик используется команда ros.publish("имя_топика", сообщение):
#include <RosDuino.h>
#include <std_msgs/msg/Int32.h>
std_msgs::Int32 signalMsg;
rosduino::Timer publishTimer(100);
void setup() {
ros.begin("analog_publisher");
}
void loop() {
ros.update();
if (publishTimer.check()) {
signalMsg.data = analogRead(A8);
ros.publish("analog_signal", signalMsg);
}
}
Обратите внимание на три особенности:
- Автоматическое создание топика при первом вызове: когда
ros.publish("analog_signal", signalMsg)выполняется впервые, библиотека запрашивает у агента регистрацию нового топика. Пока топик регистрируется, само первое сообщение не отправляется. Для датчика, который передаёт измерения каждые100 мс, потеря самого первого отсчёта при старте незаметна — уже через десятую долю секунды в топик пойдут следующие значения. - Тип топика определяется автоматически: поскольку переменная
signalMsgимеет типstd_msgs::Int32, в ROS 2 создаётся топик с типомstd_msgs/msg/Int32. - Безопасное поведение без агента: пока
rosduino_agentна компьютере ещё не запущен, функцияros.publish()просто возвращает кодrosduino::Result::NotConnectedи не зависает. При желании связь можно проверить заранее условиемif (ros.connected()).
Шаг 1. Публикация аналогового сигнала с частотой 10 Гц
Загрузим приведённый выше скетч в плату и проверим поток данных на компьютере. Напомним: если к разъёму GPIO A8 подключён потенциометр из урока 3, вы сможете плавно менять значения ручкой; если ничего не подключено — analogRead(A8) будет передавать меняющиеся значения электрических наводок.
- Если в Терминале 1 запущен
rosduino_agent, остановите его клавишамиCtrl+C. - Загрузите скетч в плату TurtleBro через Arduino IDE 2.
- Запустите агент в Терминале 1:
Терминал 1:
ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
- Во втором окне терминала (Терминал 2) посмотрите список топиков:
Терминал 2:
ros2 topic list -t
Ожидаемый вывод:
/analog_signal [std_msgs/msg/Int32]
/diagnostics [diagnostic_msgs/msg/DiagnosticArray]
/parameter_events [rcl_interfaces/msg/ParameterEvent]
/rosout [rcl_interfaces/msg/Log]
- Выведите приходящие сообщения на экран:
Терминал 2:
ros2 topic echo /analog_signal
В Терминале 2 бежит поток сообщений с полем data: ... в диапазоне 0–1023. Поверните ручку потенциометра или поднесите палец к разъёму GPIO A8 — полученные значения в топике сразу изменятся. Нажмите Ctrl+C, чтобы остановить вывод echo.
- Теперь проверим, действительно ли таймер
rosduino::Timer(100)выдерживает частоту 10 раз в секунду (10 Гц). Выполните команду измерения частоты:
Терминал 2:
ros2 topic hz /analog_signal
Через пару секунд в терминале появятся расчёты:
average rate: 10.001
min: 0.099s max: 0.101s std dev: 0.00045s window: 10
Остановите измерение клавишами Ctrl+C.
Шаг 2. Простой способ работы с кнопкой: отправка потока при нажатии
С кнопкой D28 можно начать работать так же просто, как с обычным датчиком — сразу вызывать ros.publish(). Будем проверять пин кнопки каждые 50 мс и, пока кнопка удерживается нажатой (HIGH), отправлять true в топик /button:
#include <RosDuino.h>
#include <std_msgs/msg/Bool.h>
const int BUTTON_PIN = 28;
std_msgs::Bool pressed;
rosduino::Timer buttonTimer(50); // опрос каждые 50 мс (20 раз в секунду)
void setup() {
pinMode(BUTTON_PIN, INPUT);
ros.begin("button_node");
}
void loop() {
ros.update();
if (buttonTimer.check()) {
if (digitalRead(BUTTON_PIN) == HIGH) {
pressed.data = true;
ros.publish("button", pressed);
}
}
}
(Если убрать условие if (digitalRead(BUTTON_PIN) == HIGH) и передавать текущее состояние pressed.data = (digitalRead(BUTTON_PIN) == HIGH) при каждом срабатывании таймера, как в стандартном примере библиотеки Simple/ButtonSimple, плата будет непрерывно слать false и true 20 раз в секунду).
Посмотрим, как ведёт себя такой скетч на практике:
- Остановите агент в Терминале 1 (
Ctrl+C), загрузите скетч в плату и запустите агент снова. - Не нажимая кнопку
D28, проверьте список топиков в Терминале 2:
Терминал 2:
ros2 topic list -t
Топика /button в списке ещё нет: программа ни разу не зашла внутрь блока if (digitalRead(BUTTON_PIN) == HIGH) и не вызвала ros.publish().
- Теперь нажмите и удерживайте кнопку
D28полсекунды, после чего запустите просмотр топика и нажмите кнопку снова:
Терминал 2:
ros2 topic echo /button
Первый вызов ros.publish() в момент нажатия создал топик /button (потеряв при этом самое первое сообщение), а все последующие срабатывания таймера каждые 50 мс начали непрерывно заполнять топик сообщениями data: true, пока палец удерживает кнопку.
Для простой проверки связи этого достаточно, но при управлении роботом такой подход неудобен по двум причинам:
- поток повторов вместо одного события: даже короткое нажатие длится
150–200 мси отправляет в топик сразу несколько одинаковых сообщенийdata: trueподряд; - топик не виден до нажатия и теряет первый вызов: если мы уберём повторы и будем вызывать
ros.publish()ровно один раз при смене состояния кнопки, то до первого нажатия топика не будет вros2 topic list, а само первое нажатие потратится на регистрацию топика и пропадёт.
Шаг 3. Одиночные события кнопки и регистрация топика ros.advertise()
Чтобы топик кнопки появился в ROS 2 сразу при подключении платы, а первое нажатие не терялось, перед началом работы с кнопкой — в функции setup() сразу после ros.begin() — вызывается ros.advertise("имя_топика", переменная_сообщения):
ros.begin("sensor_board");
ros.advertise("button_pressed", buttonMsg);
Разберём, что делает эта строка:
- создаёт топик без отправки сообщения: переменная
buttonMsgв этот момент никуда не пересылается — библиотека использует её только для того, чтобы узнать тип топика (std_msgs/msg/Bool); - делает топик видимым сразу: как только запускается
rosduino_agent, топик/button_pressedсразу появляется вros2 topic list -t, поэтому на него можно заранее подписаться черезros2 topic echoили из управляющего узла; - сохраняет первое нажатие: когда кнопка меняет состояние впервые, топик уже зарегистрирован, и первый же вызов
ros.publish()доставляет сообщение без потерь.
Объединим периодическую публикацию аналогового сигнала A8 (для которого advertise не требуется) и отправку одиночных событий кнопки D28 (аналог стандартного примера Simple/ButtonOnce в меню Файл → Примеры → RosDuino):
#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;
std_msgs::Int32 signalMsg;
std_msgs::Bool buttonMsg;
rosduino::Timer analogTimer(100); // 10 Гц для аналогового сигнала
rosduino::Timer buttonTimer(30); // период опроса кнопки (антидребезг)
int lastButtonState = LOW;
void setup() {
pinMode(BUTTON_PIN, INPUT);
lastButtonState = digitalRead(BUTTON_PIN);
ros.begin("sensor_board");
// Заранее создаём топик кнопки, чтобы не потерять первое нажатие.
ros.advertise("button_pressed", buttonMsg);
}
void loop() {
ros.update();
// Задача 1: каждые 100 мс публикуем значение с разъёма GPIO A8.
if (analogTimer.check()) {
signalMsg.data = analogRead(SENSOR_PIN);
ros.publish("analog_signal", signalMsg);
}
// Задача 2: каждые 30 мс проверяем кнопку D28 и публикуем только изменения.
if (buttonTimer.check()) {
int reading = digitalRead(BUTTON_PIN);
if (reading != lastButtonState) {
lastButtonState = reading;
buttonMsg.data = (lastButtonState == HIGH);
ros.publish("button_pressed", buttonMsg);
}
}
}
Проверка в терминале
- Остановите агент в Терминале 1 (
Ctrl+C), загрузите обновлённый скетч в плату и запустите агент снова. - Не трогая кнопку
D28, проверьте список топиков в Терминале 2:
Терминал 2:
ros2 topic list -t
Топик /button_pressed [std_msgs/msg/Bool] уже присутствует в списке вместе с /analog_signal [std_msgs/msg/Int32].
- В Терминале 2 заранее подпишитесь на события кнопки:
Терминал 2:
ros2 topic echo /button_pressed
- Нажмите и отпустите кнопку
D28на плате.
Пока вы не трогаете кнопку, в терминале тишина — лишние пакеты не передаются. При самом первом нажатии D28 без потерь приходит ровно одно сообщение data: true, а при отпускании — одно сообщение data: false. В топике /analog_signal параллельно продолжают идти измерения с частотой 10 Гц.
Назад: Урок 5. Топики в RosDuino.
Дальше: Одновременная публикация и подписка.