Создание сообщений для сервисов
Этот раздел предназначен для дополнительного изучения и справочной работы. При первом прохождении курса его можно пропустить и сразу перейти к домашнему заданию: для выполнения всех практических заданий курса достаточно встроенных типов сервисов, которые уже установлены вместе с библиотекой 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 successstring message | Запуск действия без входных параметров (например, /calibrate) или опрос статуса с возвратом флага успеха и текста |
std_srvs/srv/SetBool | <std_srvs/srv/SetBool.h> | bool data | bool successstring 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".
Вопросы для самопроверки
- Зачем в ROS 2 нужны сервисы, если в системе уже есть топики, и как один сервис с входным параметром помогает избежать создания множества топиков?
- Почему в обработчике сервера сервиса
void onSetLed(std_srvs::SetBool& srv)параметр принимается по ссылке (&) и почему внутри этой функции нельзя делать долгие паузы? - Чем отличается роль платы при вызове
ros.service()от её роли при вызовеros.call()? - Почему вызов
ros.call("add_two_ints", adder, onSumAnswer)не останавливает работуloop()во время ожидания ответа от компьютера?
Назад: Клиент сервиса на плате.
Дальше: Домашнее задание.