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

Сервер сервиса на плате

В обычном скетче на C++ вы вызываете функцию внутри одной программы: передаёте ей аргументы в скобках, она выполняет действия и возвращает ответ через return. Сервис (Service) в ROS 2 устроен точно так же, только это удалённый вызов функции: функция находится на одном устройстве (например, на плате TurtleBro), а вызывает её программа на другом устройстве (на компьютере).

Как устроен удалённый вызов функции

Любой вызов сервиса состоит из двух шагов:

  1. Передача входных параметров (Request — запрос): вызывающая сторона (клиент сервиса) отправляет данные, с которыми нужно выполнить функцию.
  2. Получение результата работы (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 2

Создание сервера сервиса на самой плате (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();
}

Обратите внимание на две важные детали:

  1. Передача параметра по ссылке (&): в заголовке void onSetLed(std_srvs::SetBool& srv) стоит знак амперсанда &. Благодаря этому функция записывает результат прямо в поля srv.response переданного объекта, и сразу после завершения функции библиотека отправляет этот ответ обратно клиенту в ROS 2.
  2. Быстрое выполнение обработчика: пока выполняется onSetLed(), плата не обрабатывает другие пакеты. Поэтому внутри функции сервиса нельзя использовать delay() или долгие циклы ожидания.

Пошаговая проверка из терминала ROS 2

  1. Если rosduino_agent запущен в Терминале 1, остановите его клавишами Ctrl+C, загрузите скетч в плату и снова запустите агент:

Терминал 1:

ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
  1. В Терминале 2 проверьте список доступных сервисов вместе с их типами (флаг -t):

Терминал 2:

ros2 service list -t

В списке появится сервис /set_led [std_srvs/srv/SetBool].

  1. Вызовите сервис /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'.

  1. Выключите светодиод вторым запросом:

Терминал 2:

ros2 service call /set_led std_srvs/srv/SetBool "{data: false}"

Светодиод погаснет, а в ответе вернётся строка 'LED D48 turned OFF'.

Назад: Урок 6. Сервисы в RosDuino.
Дальше: Клиент сервиса на плате.