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

Чтобы компьютер робота знал, что происходит вокруг платы, микроконтроллер должен регулярно отправлять полученные значения датчиков в топики 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);
  }
}

Обратите внимание на три особенности:

  1. Автоматическое создание топика при первом вызове: когда ros.publish("analog_signal", signalMsg) выполняется впервые, библиотека запрашивает у агента регистрацию нового топика. Пока топик регистрируется, само первое сообщение не отправляется. Для датчика, который передаёт измерения каждые 100 мс, потеря самого первого отсчёта при старте незаметна — уже через десятую долю секунды в топик пойдут следующие значения.
  2. Тип топика определяется автоматически: поскольку переменная signalMsg имеет тип std_msgs::Int32, в ROS 2 создаётся топик с типом std_msgs/msg/Int32.
  3. Безопасное поведение без агента: пока rosduino_agent на компьютере ещё не запущен, функция ros.publish() просто возвращает код rosduino::Result::NotConnected и не зависает. При желании связь можно проверить заранее условием if (ros.connected()).

Шаг 1. Публикация аналогового сигнала с частотой 10 Гц

Загрузим приведённый выше скетч в плату и проверим поток данных на компьютере. Напомним: если к разъёму GPIO A8 подключён потенциометр из урока 3, вы сможете плавно менять значения ручкой; если ничего не подключено — analogRead(A8) будет передавать меняющиеся значения электрических наводок.

  1. Если в Терминале 1 запущен rosduino_agent, остановите его клавишами Ctrl+C.
  2. Загрузите скетч в плату TurtleBro через Arduino IDE 2.
  3. Запустите агент в Терминале 1:

Терминал 1:

ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
  1. Во втором окне терминала (Терминал 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]
  1. Выведите приходящие сообщения на экран:

Терминал 2:

ros2 topic echo /analog_signal

Ожидаемый результат

В Терминале 2 бежит поток сообщений с полем data: ... в диапазоне 0–1023. Поверните ручку потенциометра или поднесите палец к разъёму GPIO A8 — полученные значения в топике сразу изменятся. Нажмите Ctrl+C, чтобы остановить вывод echo.

  1. Теперь проверим, действительно ли таймер 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. Остановите агент в Терминале 1 (Ctrl+C), загрузите скетч в плату и запустите агент снова.
  2. Не нажимая кнопку D28, проверьте список топиков в Терминале 2:

Терминал 2:

ros2 topic list -t

Топика /button в списке ещё нет: программа ни разу не зашла внутрь блока if (digitalRead(BUTTON_PIN) == HIGH) и не вызвала ros.publish().

  1. Теперь нажмите и удерживайте кнопку 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. Остановите агент в Терминале 1 (Ctrl+C), загрузите обновлённый скетч в плату и запустите агент снова.
  2. Не трогая кнопку D28, проверьте список топиков в Терминале 2:

Терминал 2:

ros2 topic list -t

Топик /button_pressed [std_msgs/msg/Bool] уже присутствует в списке вместе с /analog_signal [std_msgs/msg/Int32].

  1. В Терминале 2 заранее подпишитесь на события кнопки:

Терминал 2:

ros2 topic echo /button_pressed
  1. Нажмите и отпустите кнопку D28 на плате.

Ожидаемый результат

Пока вы не трогаете кнопку, в терминале тишина — лишние пакеты не передаются. При самом первом нажатии D28 без потерь приходит ровно одно сообщение data: true, а при отпускании — одно сообщение data: false. В топике /analog_signal параллельно продолжают идти измерения с частотой 10 Гц.

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