Перейти к основному содержимому

ROS-ноды

После загрузки Rover B7 автоматически запускается набор ROS 2-нод, обеспечивающих управление движением, взаимодействие с электронными модулями, получение данных от датчиков и работу веб-интерфейса.

Основные ноды запускаются через системный сервис ros_nodes.service. Для USB-камеры используется отдельный сервис camera.service.

Актуальный список запущенных нод можно получить командой:

ros2 node list

Для базовой конфигурации Rover B7 список выглядит следующим образом:

/bat_monitor
/camera1
/control_move
/cyphal_bridge_power
/cyphal_bridge_test
/imu
/joy
/odom
/radiolink_control
/rele_control
/rosbridge_server
/web_server
/web_video_server
Список нод

Фактический список может отличаться в зависимости от версии программного обеспечения и состояния подключённого оборудования.

Например, если камера не подключена или соответствующий сервис не запущен, нода /camera1 может отсутствовать.


Назначение нод​

Управление движением​

/joy

Нода получает данные от подключённого устройства управления, включая положения осей и состояния кнопок пульта.

Полученные значения публикуются в топик /joy в формате sensor_msgs/msg/Joy.

/radiolink_control

Нода обрабатывает сообщения из /joy и преобразует их в команды движения ровера.

На основании положения элементов управления пульта формируются линейная и угловая скорости, которые публикуются в топик /cmd_vel.

Также нода учитывает выбранный режим скорости движения и ограничения управления.

/control_move

Нода реализует кинематическую модель шестиколёсного ровера.

Она получает команды из /cmd_vel, рассчитывает требуемые угловые скорости колёс с учётом геометрических параметров шасси и публикует команды для шести приводов:

/m_vel1
/m_vel2
/m_vel3
/m_vel4
/m_vel5
/m_vel6

Команды передаются драйверам двигателей через Cyphal.


Сенсоры и одометрия​

/imu

Нода взаимодействует с инерциальным датчиком VBCores BHI360, подключённым к бортовому компьютеру через USB.

Она получает данные об ускорениях, угловых скоростях и ориентации и публикует их в топик:

/bhi360/imu

/odom

Нода рассчитывает положение ровера на основании обратной связи от приводов и данных инерциального датчика.

Для вычисления перемещения используются данные от шести колёс:

/m_odom1 ... /m_odom6

Данные IMU используются для определения ориентации ровера.

Результат публикуется в топик:

/odom_pose2d

Он содержит положение ровера на плоскости — координаты x, y и угол ориентации theta.


Мониторинг питания​

/bat_monitor

Нода контролирует напряжение аккумуляторов ровера.

Данные поступают от платы PowerBoard через Cyphal-мост в топики:

/bat_1
/bat_2

Нода отслеживает напряжение обеих батарей и управляет световой индикацией кнопки POWER.

Если напряжение обеих батарей опускается ниже установленного порога, индикатор POWER начинает мигать красным цветом. При отсутствии тревоги используется зелёная индикация.

Для управления индикатором применяется Cyphal-сервис, доступный в ROS 2 как /hmi/led.

примечание

Значение порогового напряжения и параметры мигания задаются в конфигурации brover_params.yaml.

Веб-интерфейс также использует данные из /bat_1 и /bat_2 для отображения напряжения питания.


Взаимодействие с аппаратной частью​

Обмен данными с электронными модулями осуществляется по протоколу Cyphal/CAN через устройство Ethernet-CAN.

На стороне Linux для работы с физическими CAN-шинами используются виртуальные интерфейсы vcan1.x.

/cyphal_bridge_test

Нода обеспечивает обмен данными между ROS 2 и шестью драйверами двигателей через интерфейс:

vcan1.0

Основные функции:

  • получение команд скорости из /m_vel1–/m_vel6;
  • передача команд драйверам двигателей по Cyphal;
  • получение обратной связи от драйверов;
  • публикация текущих скоростей в /m_odom1–/m_odom6.

/cyphal_bridge_power

Нода обеспечивает обмен с платой PowerBoard через интерфейс:

vcan1.1

Основные функции:

  • получение информации о двух батареях;
  • публикация данных в /bat_1 и /bat_2;
  • получение состояния пользовательских кнопок;
  • передача команд на звуковой сигнализатор;
  • управление RGB-индикацией кнопок.

Для управления индикацией и звуковым сигнализатором используются ROS 2-сервисы.

/rele_control

Нода отвечает за управление платой IO Board, подключённой через интерфейс:

vcan1.3

Плата управляет реле и фарами ровера, а также передаёт данные об их текущем состоянии.

Для управления предусмотрены ROS 2-сервисы:

СервисНазначение
/releВключение и выключение реле
/lightВключение и выключение фар
/rele_control/stateПолучение текущего состояния выходов платы

Получить текущее состояние реле и фар можно командой:

ros2 service call /rele_control/state std_srvs/srv/Trigger "{}"

В ответе возвращается массив из двух значений:

[состояние фар, состояние реле]

Значение 1 соответствует логическому уровню HIGH, а 0 — LOW.


Работа с камерой и видео​

/camera1

Нода отвечает за получение изображения с USB-камеры, подключённой непосредственно к x86-компьютеру.

Видеокадры публикуются в ROS 2, в частности в топик:

/camera1/image_raw

Камера запускается отдельным системным сервисом:

camera.service

Это позволяет перезапускать камеру независимо от основного набора ROS-нод.

/web_video_server

Нода получает изображения из ROS-топиков и предоставляет доступ к видеопотоку по HTTP.

В базовой конфигурации используется порт:

9999

Благодаря этому изображение с камеры можно просматривать непосредственно в веб-интерфейсе ровера.


Взаимодействие с веб-интерфейсом​

/rosbridge_server

Нода обеспечивает обмен данными между ROS 2 и внешними приложениями через WebSocket.

В базовой конфигурации используется порт:

9090

Передача сообщений осуществляется в формате JSON.

Через rosbridge веб-интерфейс ровера может:

  • получать данные из ROS-топиков;
  • отправлять команды движения;
  • вызывать доступные ROS-сервисы;
  • получать информацию о состоянии оборудования.

/web_server

Нода запускает веб-сервер интерфейса управления Rover B7.

В базовой конфигурации веб-интерфейс доступен по адресу:

http://IP_РОВЕРА:8080

Сервер предоставляет страницу управления, через которую пользователь может управлять движением ровера, просматривать изображение с камеры и доступные данные телеметрии.


Получение информации о нодах​

Просмотр запущенных нод​

Для получения списка всех обнаруженных ROS 2-нод выполните:

ros2 node list

Информация о конкретной ноде​

Для просмотра подробной информации используется команда:

ros2 node info <имя_ноды>

Например:

ros2 node info /odom

Команда позволяет узнать:

  • топики, в которые нода публикует сообщения;
  • топики, на которые она подписана;
  • предоставляемые сервисы;
  • используемые клиенты сервисов;
  • доступные действия ROS 2.

Просмотр ROS-топиков​

Получить список доступных топиков:

ros2 topic list

Просмотреть данные инерциального датчика:

ros2 topic echo /bhi360/imu

Просмотреть данные одометрии:

ros2 topic echo /odom_pose2d

Проверить напряжение первой батареи:

ros2 topic echo /bat_1

Проверить напряжение второй батареи:

ros2 topic echo /bat_2

Для остановки вывода сообщений нажмите Ctrl + C.

Просмотр ROS-сервисов​

Получить список доступных сервисов:

ros2 service list

Для просмотра типов сервисов:

ros2 service list -t

Проверка автоматического запуска​

Основные ROS-ноды запускаются автоматически через ros_nodes.service.

Проверить состояние сервиса можно командой:

systemctl status ros_nodes.service --no-pager

Для просмотра журнала:

journalctl -u ros_nodes.service -b --no-pager -n 100

Камера запускается отдельно. Проверить её состояние можно командой:

systemctl status camera.service --no-pager
Ручной запуск ROS-нод

Перед ручным запуском нод убедитесь, что соответствующие процессы уже не работают через systemd.

Одновременный запуск нескольких экземпляров управляющих нод или Cyphal-мостов может привести к конфликтам и некорректной работе оборудования.

Если ROS-команды недоступны

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

source /opt/ros/jazzy/setup.bash
source /home/bigrover/.ros_params
source /home/bigrover/ros2_ws/install/setup.bash