Синхронизация времени и диагностика связи
Помимо журнала событий, для работы в составе робота плате нужны ещё два инструмента: единое системное время с компьютером (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-файл.