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.

В отличие от топиков (std_msgs), где существуют десятки готовых типов на все случаи жизни, стандартных сервисов в базовых пакетах ROS 2 совсем немного. Это связано с тем, что у каждой удалённой функции свои собственные входные параметры (request) и свой формат возвращаемого ответа (response). Ниже разобрано, какие готовые типы сервисов есть в std_srvs и RosDuino, какие сервисы встречаются в других пакетах ROS 2 и как при необходимости создавать заголовки для собственных сервисов .srv с помощью генератора rosduino-gen.

1. Стандартные сервисы пакета std_srvs

В стандартном пакете std_srvs в ROS 2 предусмотрены ровно три универсальных сервиса. Все три уже встроены в библиотеку RosDuino:

Тип сервисаЗаголовочный файл в скетчеВходные параметры (request)Результат работы (response)Когда применять
std_srvs/srv/Empty<std_srvs/srv/Empty.h>нет полейнет полейПростая команда без аргументов и без текстового отчёта (например, /reset_counter)
std_srvs/srv/Trigger<std_srvs/srv/Trigger.h>нет полейbool success
string message
Запуск действия без входных параметров (например, /calibrate) или опрос статуса с возвратом флага успеха и текста
std_srvs/srv/SetBool<std_srvs/srv/SetBool.h>bool databool success
string message
Включение или выключение устройства/режима (true / false) с подтверждением результата

Пример использования std_srvs/srv/Trigger, когда функция не требует входных аргументов, но возвращает текстовый отчёт о состоянии кнопки D28:

#include <RosDuino.h>
#include <std_srvs/srv/Trigger.h>

void onCheckButton(std_srvs::Trigger& srv) {
  bool pressed = (digitalRead(28) == HIGH);
  srv.response.success = pressed;
  srv.response.message = pressed ? "Button D28 is pressed" : "Button D28 is released";
}

2. Числовой сервис из пакета example_interfaces

Помимо std_srvs, в базовую поставку RosDuino включён пакет example_interfaces, содержащий сервис example_interfaces/srv/AddTwoInts (#include <example_interfaces/srv/AddTwoInts.h>):

  • Вход (request): два 64-битных целых числа int64 a и int64 b;
  • Выход (response): одно 64-битное целое число int64 sum.

Хотя он называется AddTwoInts, поля a, b и sum — это обычные целые числа. Поэтому в учебных задачах, когда не хочется создавать отдельный пакет с собственным .srv, его удобно использовать для любой удалённой функции с целочисленными параметрами: например, передавать в request.a номер кнопки или канала (1 или 2), а в response.sum возвращать измеренное значение.

3. Какие ещё сервисы есть в стандартных пакетах ROS 2

В профильных пакетах ROS 2 сервисы созданы под конкретные подсистемы робота:

  • rcl_interfaces/srv/... (GetParameters, SetParameters, ListParameters) — чтение и изменение настроек узлов;
  • nav_msgs/srv/... (GetMap, GetPlan, SetMap) — запрос карты помещения и расчёт маршрута навигации из начальной точки в целевую;
  • sensor_msgs/srv/SetCameraInfo — сохранение калибровочных параметров камеры;
  • diagnostic_msgs/srv/SelfTest — запуск самодиагностики оборудования;
  • std_srvs / turtlesim/srv/... (Spawn, TeleportAbsolute, SetPen) — управление учебным симулятором.

Посмотреть полный список всех типов сервисов и сообщений, установленных на вашем компьютере с ROS 2, можно командой:

ros2 run rosduino_gen rosduino-gen --list

4. Как устроен файл описания своего сервиса (.srv)

Когда вашей плате нужна удалённая функция со своими именами параметров — например, запросить состояние кнопки по её номеру button_id или повернуть сервопривод servo_id на угол angle, — в пакете интерфейсов ROS 2 создаётся текстовый файл с расширением .srv.

Файл .srv состоит из двух частей, разделённых строкой из трёх дефисов ---:

  • сверху описываются входные параметры запроса (Request);
  • снизу описываются поля возвращаемого результата (Response).

Например, файл srv/ReadButton.srv для чтения кнопки по её номеру выглядит так:

int32 button_id
---
bool pressed
string message

5. Генерация заголовков для Arduino с помощью rosduino-gen

После того как пакет с вашими .srv-файлами (например, my_robot_msgs) собран в рабочем пространстве ROS 2 через colcon build, утилита rosduino-gen из репозитория rosduino_ros переводит их в готовые C++-заголовки для Arduino IDE.

Выполните в терминале одну команду, указав имя пакета и путь к папке библиотеки RosDuino:

ros2 run rosduino_gen rosduino-gen --package my_robot_msgs --out "$HOME/Arduino/libraries/RosDuino/src"

Генератор создаст заголовочный файл my_robot_msgs/srv/ReadButton.h, который сразу можно подключить в скетче платы:

#include <RosDuino.h>
#include <my_robot_msgs/srv/ReadButton.h>

void onReadButton(my_robot_msgs::ReadButton& srv) {
  if (srv.request.button_id == 1) {
    srv.response.pressed = (digitalRead(28) == HIGH);
    srv.response.message = "Button 1 (D28)";
  } else if (srv.request.button_id == 2) {
    srv.response.pressed = (digitalRead(15) == HIGH);
    srv.response.message = "Button 2 (D15)";
  } else {
    srv.response.pressed = false;
    srv.response.message = "Unknown button_id";
  }
}

Если же вы хотите добавить стандартный пакет из комплекта ROS 2 (например, nav_msgs или diagnostic_msgs), укажите его имя во флаге --package или допишите нужный тип в файл rosduino_gen/arduino_types.txt и запустите ros2 run rosduino_gen rosduino-gen --all --out "$HOME/Arduino/libraries/RosDuino/src".

Вопросы для самопроверки

  1. Зачем в ROS 2 нужны сервисы, если в системе уже есть топики, и как один сервис с входным параметром помогает избежать создания множества топиков?
  2. Почему в обработчике сервера сервиса void onSetLed(std_srvs::SetBool& srv) параметр принимается по ссылке (&) и почему внутри этой функции нельзя делать долгие паузы?
  3. Чем отличается роль платы при вызове ros.service() от её роли при вызове ros.call()?
  4. Почему вызов ros.call("add_two_ints", adder, onSumAnswer) не останавливает работу loop() во время ожидания ответа от компьютера?

Назад: Клиент сервиса на плате.
Дальше: Домашнее задание.