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

Синхронизация времени и диагностика связи

Помимо журнала событий, для работы в составе робота плате нужны ещё два инструмента: единое системное время с компьютером (ros.now()) и контроль исправности самого канала связи (/diagnostics). Кроме того, сам агент rosduino_agent поддерживает полезные параметры запуска. Разберём их на простых примерах.

Синхронизация времени ros.now()

Встроенный секундомер millis() считает миллисекунды только с момента включения самой платы и не знает, который сейчас час на компьютере. Чтобы все узлы робота жили по одним часам, rosduino_agent автоматически синхронизирует время микроконтроллера с часами компьютера.

При управлении реальным роботом единое время очень важно для безопасности: по метке времени узлы определяют возраст данных и отбрасывают «старые», задержавшиеся в очереди сообщения от датчиков или команд движения. Если робот начнёт принимать решения по устаревшим данным дальномера, это может привести к столкновению и аварии. В наших учебных примерах без движения робота таких жёстких требований нет, поэтому проверка меток времени не так критична, но знать об этом механизме полезно.

Функция ros.now() возвращает структуру времени ROS 2 builtin_interfaces::msg::Time с двумя полями:

  • sec — целые секунды;
  • nanosec — наносекунды.

Пока плата ещё не соединилась с агентом, t.sec равно 0. Как только связь установлена, ros.now() возвращает текущее системное время.

Простой пример проверки времени и журнала

Загрузим короткий скетч (аналог стандартного примера TimeAndLog), который раз в секунду проверяет синхронизацию времени ros.now(), мигает светодиодом D48 и отправляет запись в журнал /rosout:

#include <RosDuino.h>

const int LED_PIN = 48;

rosduino::Timer timer(1000); // каждые 1000 мс (1 Гц)
bool ledState = false;

void setup() {
  pinMode(LED_PIN, OUTPUT);
  digitalWrite(LED_PIN, LOW);

  ros.begin("time_demo_node");
}

void loop() {
  ros.update();

  if (ros.connected() && timer.check()) {
    ledState = !ledState;
    digitalWrite(LED_PIN, ledState ? HIGH : LOW);

    builtin_interfaces::msg::Time t = ros.now();
    if (t.sec != 0) {
      ros.logInfo(F("ROS 2 time is synchronized"));
    } else {
      ros.logWarn(F("Waiting for time sync"));
    }
  }
}

Если в скетче публикуются сообщения датчиков с заголовком header (например, sensor_msgs/msg/Range), то же самое время одной строкой записывается в метку измерения: msg.header.stamp = ros.now();.

Диагностика канала связи в топике /diagnostics

Как узнать, что плата стабильно держит связь, а на кабеле USB нет помех? Агент rosduino_agent каждую секунду публикует отчёт о состоянии соединения в стандартный топик /diagnostics.

Запустите агент в Терминале 1, а в Терминале 2 посмотрите одно сообщение диагностики:

Терминал 2:

ros2 topic echo /diagnostics --field status --once

В поле level агент передаёт один из трёх статусов:

  • OK (0) — плата на связи, все топики и сервисы успешно созданы;
  • WARN (1) — связь с платой потеряна (например, нажата кнопка Reset или выдернут кабель);
  • ERROR (2) — последовательный порт не удалось открыть.

В списке values этого же сообщения видны порт, выбранный профиль памяти платы (LARGE для Arduino Due), число созданных топиков и сервисов, а также счётчики принятых кадров и ошибок контрольной суммы (crc_errors).

Полезные параметры запуска rosduino_agent

До сих пор мы указывали агенту только порт (--port). При запуске из командной строки можно добавить и другие полезные флаги:

Флаг запускаЧто делаетПример
--portИмя последовательного порта платы (обязательный параметр)--port /dev/ttyACM0
--baudСкорость порта (по умолчанию 115200, должна совпадать со скетчем)--baud 115200
--namespaceПомещает все топики и сервисы платы в отдельное пространство имён--namespace front_mcu
--keep-on-disconnectНе удаляет топики из ROS 2 при кратковременной перезагрузке платы--keep-on-disconnect
--log-levelУровень подробности вывода в консоль (debug, info, warn, error)--log-level debug

Например, чтобы все топики платы автоматически получили префикс /tb_mcu/..., запустите агент так:

Терминал 1:

ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0 --namespace tb_mcu

Агент можно запускать и через готовый launch-файл из пакета rosduino_agent (это особенно удобно, когда нужно подключить сразу две платы через запятую в параметре ports):

Терминал 1:

ros2 launch rosduino_agent rosduino_agent.launch.py port:=/dev/ttyACM0

Справочный материал: отладка через Serial1

Этот раздел можно пропустить при первом прохождении. На микроконтроллере Arduino Due есть несколько аппаратных портов UART. Если в нестандартной задаче вам нужно оставить основной USB-порт Serial свободным для Serial.println(), связь с rosduino_agent можно перенести на второй порт Serial1 (пины 18 TX1 и 19 RX1 через внешний переходник USB-UART на 3,3 В):

void setup() {
  Serial.begin(115200);
  ros.begin(Serial1, "led_board");
}

При обычной работе с платой TurtleBro по одному USB-кабелю это не требуется — все отладочные сообщения передаются через ros.logInfo() в /rosout.

Назад: Журнал событий /rosout.
Дальше: Управляющий узел на Python и launch-файл.