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

Домашнее задание

На предыдущей странице мы отправляли из ROS 2 логические значения true и false для включения светодиода. В этом задании вы создадите узел управления сервоприводом, который принимает целочисленный угол из топика /servo_angle, проверяет допустимые границы 0°–180° и зажигает светодиод D48, если присланный угол вышел за пределы диапазона.

Перед подключением сервопривода к разъёму D2 отключите USB-кабель от платы и сверьте контакты −, +, S с цветами проводов.

Что должно получиться

  1. Плата регистрирует в ROS 2 узел с именем servo_driver_node.
  2. Узел подписывается на топик servo_angle с типом сообщения std_msgs/msg/Int32 (заголовочный файл #include <std_msgs/msg/Int32.h>, число хранится в поле msg.data).
  3. После включения платы сервопривод на разъёме D2 встаёт в среднее положение 90°, а светодиод D48 погашен.
  4. Когда в топик /servo_angle приходит новое сообщение:
    • если значение msg.data находится в допустимых пределах от 0 до 180 включительно — сервопривод поворачивается на угол msg.data, а светодиод D48 выключается (LOW);
    • если значение msg.data меньше 0 или больше 180 (например, -30 или 220) — программа ограничивает угол безопасным пределом (0° или 180°) с помощью constrain(msg.data, 0, 180), поворачивает сервопривод на этот ограниченный угол и включает светодиод ошибки D48 (HIGH).

Требования к программе

  • Подключены библиотеки <Servo.h>, <RosDuino.h> и <std_msgs/msg/Int32.h>.
  • В функции loop() вызывается ros.update() без использования delay().
  • Перед загрузкой скетча агент rosduino_agent останавливается клавишами Ctrl+C.

Как составить алгоритм

  1. Возьмите за основу скетч со страницы управления светодиодом и добавьте подключение <Servo.h> и <std_msgs/msg/Int32.h>.
  2. Объявите константы SERVO_PIN = 2, ERROR_LED_PIN = 48 и объект Servo servo;.
  3. Напишите функцию-обработчик void onServoAngle(std_msgs::Int32 msg):
    • проверьте условие if (msg.data < 0 || msg.data > 180) (оператор || означает «логическое ИЛИ»);
    • если условие истинно — включите светодиод D48 (HIGH), иначе — выключите его (LOW);
    • вычислите безопасный угол int safeAngle = constrain(msg.data, 0, 180); и передайте его в servo.write(safeAngle);.
  4. В setup() настройте пин светодиода, привяжите сервопривод servo.attach(SERVO_PIN), поставьте начальный угол 90°, вызовите ros.begin("servo_driver_node") и зарегистрируйте подписку ros.subscribe("servo_angle", onServoAngle).
  5. В loop() оставьте вызов ros.update().

Как проверить результат из терминала ROS 2

  1. Загрузите скетч в плату и запустите rosduino_agent в Терминале 1.
  2. В Терминале 2 проверьте, что появились узел /servo_driver_node и топик /servo_angle с типом std_msgs/msg/Int32.
  3. Отправьте допустимый угол 45: Терминал 2:
    ros2 topic pub --once /servo_angle std_msgs/msg/Int32 "{data: 45}"
    
    Сервопривод повернётся на 45°, светодиод D48 останется погашенным.
  4. Отправьте угол за пределами диапазона, например 220: Терминал 2:
    ros2 topic pub --once /servo_angle std_msgs/msg/Int32 "{data: 220}"
    
    Сервопривод остановится на безопасной границе 180°, а светодиод D48 загорится, сигнализируя о некорректной команде.
  5. Снова отправьте допустимый угол 90 — сервопривод вернётся в середину, а светодиод ошибки D48 погаснет.

Посмотреть решение и разбор

Назад: Управление светодиодом из ROS.
Дальше: Урок 5. Топики в RosDuino.