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

Урок 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);
    }
  }
}

Как устроено решение

  1. Два независимых таймера rosduino::Timer: объект sensorTimer(100) отвечает за равномерную отправку значений analogRead(A8) 10 раз в секунду, а buttonTimer(30) считывает кнопку раз в 30 мс, отсекая механический дребезг контактов без остановки loop().
  2. Предварительная регистрация и экономия канала для кнопки: вызов ros.advertise("button_state", buttonMsg) в setup() создаёт топик /button_state сразу при подключении агента, не отправляя сообщение. А в loop() вызов ros.publish("button_state", buttonMsg) находится внутри проверки if (reading != lastButtonState): пакеты уходят в ROS 2 только в момент нажатия (true) и отпускания (false), причём самое первое нажатие доставляется без потерь.
  3. Управление линейкой светодиодов (onLedLevel): когда из ROS 2 приходит сообщение в топик /led_level, функция constrain(msg.data, 0, LED_COUNT) защищает программу от чисел меньше 0 и больше 4, а знакомая по уроку 2 функция showLitCount() включает нужное число светодиодов.

Как проверить решение

  1. Остановите rosduino_agent в Терминале 1 (Ctrl+C), загрузите скетч в плату и снова запустите агент:
    ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
    
  2. Не нажимая кнопку 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]
    
  3. Запустите просмотр ros2 topic echo /button_state и нажмите кнопку D28 — уже первое нажатие выведет data: true, а отпускание — data: false. Затем проверьте частоту публикации аналогового сигнала:
    ros2 topic hz /sensor_value
    
  4. Проверьте зажигание светодиодов 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}"
    

Ответы на вопросы для самопроверки

  1. Какую задачу решает класс rosduino::Timer и почему с ним не нужно вручную хранить переменную lastTime для millis()?
    Класс rosduino::Timer хранит интервал и время последнего срабатывания внутри самого объекта. Метод timer.check() сам сравнивает текущее время millis() с сохранённым и возвращает true, когда интервал истёк, поэтому код остаётся коротким и не блокирует ros.update().

  2. Что происходит при самом первом вызове ros.publish() без предварительной регистрации и зачем для кнопки в setup() вызывают ros.advertise()?
    Без предварительной регистрации первый вызов ros.publish("имя_топика", msg) только регистрирует издателя в агенте (по типу переменной msg), поэтому до этого вызова топика не видно в ros2 topic list, а само первое сообщение теряется. Для периодического датчика это не страшно, так как следом сразу идут новые измерения. Для кнопки же вызов ros.advertise("button", pressed) в setup() создаёт топик сразу при подключении агента без отправки сообщения, благодаря чему топик сразу виден в ROS 2 и первое нажатие не пропадает.

  3. Какой командой в терминале можно измерить фактическую частоту публикации сообщений в топике /sensor_percent?
    Командой ros2 topic hz /sensor_percent.

  4. Почему для события нажатия кнопки лучше вызывать ros.publish() только при смене состояния пина, а не отправлять поток сообщений при удержании или в каждом цикле loop()?
    При отправке в каждом loop() плата перегрузит последовательный порт сотнями одинаковых пакетов в секунду, а при отправке по таймеру во время удержания даже одно короткое нажатие породит несколько дублирующих сообщений подряд. Публикация только при смене состояния передаёт ровно одно сообщение в момент нажатия и одно в момент отпускания.

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