Сервер сервиса на плате
В обычном скетче на C++ вы вызываете функцию внутри одной программы: передаёте ей аргументы в скобках, она выполняет действия и возвращает ответ через return. Сервис (Service) в ROS 2 устроен точно так же, только это удалённый вызов функции: функция находится на одном устройстве (например, на плате TurtleBro), а вызывает её программа на другом устройстве (на компьютере).
Как устроен удалённый вызов функции
Любой вызов сервиса состоит из двух шагов:
- Передача входных параметров (
Request— запрос): вызывающая сторона (клиент сервиса) отправляет данные, с которыми нужно выполнить функцию. - Получение результата работы (
Response— ответ): исполняющая сторона (сервер сервиса) принимает эти параметры, выполняет код функции и отправляет обратно готовый результат.
sequenceDiagram
participant C as Клиент в ROS 2 (вызывает функцию)
participant S as Сервер на плате TurtleBro (выполняет функцию)
C->>S: 1. Запрос (Request): передаём входные параметры
Note over S: Выполняет функцию с полученными параметрами
S->>C: 2. Ответ (Response): возвращаем результат работы
В библиотеке RosDuino каждый тип сервиса объединяет оба шага в одной структуре srv:
srv.request— входные параметры функции;srv.response— результат работы, который вернётся вызывающей стороне.
Пример использования: допустим, нужно узнать состояние одной из кнопок или переключателей на плате. Вместо того чтобы создавать отдельный топик для каждой кнопки, достаточно сделать один сервис: в параметрах запроса (request) компьютер передаёт номер нужной кнопки, а в ответе (response) получает её текущий статус. Один удалённый вызов функции заменяет десятки однотипных топиков.
Создание сервера сервиса на самой плате (ros.service()) поддерживается в основном дистрибутиве проекта, но в ROS 2 Jazzy недоступно из-за ограничений универсального сервера сервисов внутри rclcpp. При этом вызов внешних сервисов с платы (ros.call(), который мы разберём на следующей странице) работает во всех версиях ROS 2, включая Jazzy.
Как устроен сервер сервиса ros.service()
Разберём стандартный тип сервиса std_srvs/srv/SetBool (#include <std_srvs/srv/SetBool.h>):
- в запросе
srv.request.dataприходит логическое значениеtrueилиfalse; - в ответе плата заполняет два поля: логический флаг
srv.response.successи строкуsrv.response.message.
#include <RosDuino.h>
#include <std_srvs/srv/SetBool.h>
const int LED_PIN = 48;
// Обработчик сервиса: принимает запрос и заполняет ответ.
void onSetLed(std_srvs::SetBool& srv) {
if (srv.request.data) {
digitalWrite(LED_PIN, HIGH);
srv.response.message = "LED D48 turned ON";
} else {
digitalWrite(LED_PIN, LOW);
srv.response.message = "LED D48 turned OFF";
}
srv.response.success = true;
}
void setup() {
pinMode(LED_PIN, OUTPUT);
digitalWrite(LED_PIN, LOW);
ros.begin("led_service_node");
ros.service("set_led", onSetLed);
}
void loop() {
ros.update();
}
Обратите внимание на две важные детали:
- Передача параметра по ссылке (
&): в заголовкеvoid onSetLed(std_srvs::SetBool& srv)стоит знак амперсанда&. Благодаря этому функция записывает результат прямо в поляsrv.responseпереданного объекта, и сразу после завершения функции библиотека отправляет этот ответ обратно клиенту в ROS 2. - Быстрое выполнение обработчика: пока выполняется
onSetLed(), плата не обрабатывает другие пакеты. Поэтому внутри функции сервиса нельзя использоватьdelay()или долгие циклы ожидания.
Пошаговая проверка из терминала ROS 2
- Если
rosduino_agentзапущен в Терминале 1, остановите его клавишамиCtrl+C, загрузите скетч в плату и снова запустите агент:
Терминал 1:
ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
- В Терминале 2 проверьте список доступных сервисов вместе с их типами (флаг
-t):
Терминал 2:
ros2 service list -t
В списке появится сервис /set_led [std_srvs/srv/SetBool].
- Вызовите сервис
/set_led, чтобы включить светодиодD48:
Терминал 2:
ros2 service call /set_led std_srvs/srv/SetBool "{data: true}"
Ожидаемый ответ в терминале:
waiting for service to become available...
requester: making request: std_srvs.srv.SetBool_Request(data=True)
response:
std_srvs.srv.SetBool_Response(success=True, message='LED D48 turned ON')
Светодиод D48 на плате загорится, а терминал покажет полученный от платы ответ success=True и сообщение 'LED D48 turned ON'.
- Выключите светодиод вторым запросом:
Терминал 2:
ros2 service call /set_led std_srvs/srv/SetBool "{data: false}"
Светодиод погаснет, а в ответе вернётся строка 'LED D48 turned OFF'.
Назад: Урок 6. Сервисы в RosDuino.
Дальше: Клиент сервиса на плате.