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
Перед ручным запуском нод убедитесь, что соответствующие процессы уже не работают через systemd.
Одновременный запуск нескольких экземпляров управляющих нод или Cyphal-мостов может привести к конфликтам и некорректной работе оборудования.
Перед работой с ROS 2 необходимо подключить окружение:
source /opt/ros/jazzy/setup.bash
source /home/bigrover/.ros_params
source /home/bigrover/ros2_ws/install/setup.bash