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

Управляющий узел на Python и launch-файл

До сих пор мы проверяли работу платы вручную — вводили в терминале команды ros2 topic pub и ros2 topic echo. В реальном роботе решения принимает программа на компьютере. В этой части урока мы напишем простой управляющий узел на языке Python (rclpy), который получает данные от платы TurtleBro и отправляет ей команды в ответ, а также познакомимся с запуском через launch-файл.

Разделение задач между платой и компьютером

Зашивать сложную логику и пороговые условия прямо в скетч микроконтроллера неудобно: при каждом изменении числа приходится останавливать агент, компилировать код и заново прошивать плату по кабелю.

В ROS 2 задачи делят на два уровня:

  1. Скетч на плате («драйвер железа»): только считывает датчики и кнопки, публикует их значения в топики и слушает исполнительные топики для светодиодов и сервопривода. Такой скетч прошивается в плату один раз.
  2. Python-узел на компьютере («мозг»): подписывается на топики платы, проверяет условия и отправляет команды обратно в топики светодиодов или сервопривода. Поменять условие в Python-скрипте и перезапустить его можно за секунду без перепрошивки платы.
flowchart LR
    subgraph Board["Плата TurtleBro (скетч)"]
        S["Разъём GPIO A8 / кнопка D28"]
        A["Светодиод D48 / сервопривод D2"]
    end
    subgraph PC["Компьютер с Ubuntu"]
        Py["Управляющий узел на Python"]
    end
    S -- "/analog_signal" --> Py
    Py -- "/led, /servo_angle" --> A

Шаг 1. Универсальный скетч на плате

Загрузим в плату простой универсальный скетч io_board, который:

  • каждые 100 мс публикует полученное значение с разъёма GPIO A8 (0–1023) в топик /analog_signal (std_msgs/msg/Int32);
  • по подписке на /led (std_msgs/msg/Bool) включает или выключает светодиод D48;
  • по подписке на /servo_angle (std_msgs/msg/Int32) поворачивает сервопривод на разъёме D2 и пишет уведомление в /rosout.
#include <Servo.h>
#include <RosDuino.h>
#include <std_msgs/msg/Bool.h>
#include <std_msgs/msg/Int32.h>

const int SENSOR_PIN = A8;
const int LED_PIN = 48;
const int SERVO_PIN = 2;

Servo servo;
std_msgs::Int32 signalMsg;
rosduino::Timer sensorTimer(100);  // 10 Гц

void onLed(std_msgs::Bool msg) {
  digitalWrite(LED_PIN, msg.data ? HIGH : LOW);
}

void onServoAngle(std_msgs::Int32 msg) {
  int safeAngle = constrain(msg.data, 0, 180);
  servo.write(safeAngle);
}

void setup() {
  pinMode(LED_PIN, OUTPUT);
  digitalWrite(LED_PIN, LOW);

  servo.attach(SERVO_PIN);
  servo.write(90);

  ros.begin("io_board");
  ros.subscribe("led", onLed);
  ros.subscribe("servo_angle", onServoAngle);
}

void loop() {
  ros.update();

  if (sensorTimer.check()) {
    signalMsg.data = analogRead(SENSOR_PIN);
    ros.publish("analog_signal", signalMsg);
  }
}

Загрузите этот скетч в плату. Больше менять прошивку платы в этом уроке не потребуется.

Шаг 2. Простой управляющий узел на Python (rclpy)

Напишем на компьютере короткий скрипт light_controller.py. Он подписывается на топик /analog_signal, и если полученное значение меньше порога 400, включает светодиод D48 (/led -> True) и ставит сервопривод в положение 180°, а иначе — выключает светодиод и возвращает сервопривод в 0°.

Создайте файл ~/ros2_ws/light_controller.py:

#!/usr/bin/env python3
import rclpy
from rclpy.node import Node
from std_msgs.msg import Bool, Int32

THRESHOLD = 400


class LightController(Node):
    def __init__(self):
        super().__init__('light_controller')

        # Подписка на топик аналогового сигнала с платы
        self.sub = self.create_subscription(
            Int32,
            '/analog_signal',
            self.on_sensor,
            10
        )

        # Издатели для команд светодиоду и сервоприводу
        self.led_pub = self.create_publisher(Bool, '/led', 10)
        self.servo_pub = self.create_publisher(Int32, '/servo_angle', 10)
        self.last_active = None
        self.get_logger().info('Узел light_controller запущен')

    def on_sensor(self, msg: Int32):
        is_active = msg.data < THRESHOLD

        # Отправляем команду только при смене состояния
        if is_active != self.last_active:
            self.last_active = is_active

            led_msg = Bool()
            led_msg.data = is_active
            self.led_pub.publish(led_msg)

            servo_msg = Int32()
            servo_msg.data = 180 if is_active else 0
            self.servo_pub.publish(servo_msg)

            self.get_logger().info(
                f'Сигнал={msg.data}: LED={is_active}, угол={servo_msg.data}'
            )


def main(args=None):
    rclpy.init(args=args)
    node = LightController()
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        pass
    finally:
        node.destroy_node()
        rclpy.shutdown()


if __name__ == '__main__':
    main()

Запуск и проверка

  1. В Терминале 1 запустите агент:

Терминал 1:

ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
  1. В Терминале 2 запустите ваш Python-узел:

Терминал 2:

python3 ~/ros2_ws/light_controller.py

Как только значение с разъёма GPIO A8 перейдёт через порог 400, Python-узел сам отправит команды в /led и /servo_angle, зажжёт светодиод D48 и повернёт сервопривод.

Шаг 3. Запуск одной командой через launch-файл

Чтобы не запускать rosduino_agent и Python-скрипт в двух разных терминалах вручную, в ROS 2 используют launch-файлы на языке Python.

Создайте файл ~/ros2_ws/bringup.launch.py, который запускает сразу оба процесса:

from launch import LaunchDescription
from launch.actions import DeclareLaunchArgument, ExecuteProcess
from launch.substitutions import LaunchConfiguration
from launch_ros.actions import Node


def generate_launch_description():
    port_arg = DeclareLaunchArgument(
        'port',
        default_value='/dev/ttyACM0',
        description='Последовательный порт платы TurtleBro'
    )

    agent_node = Node(
        package='rosduino_agent',
        executable='rosduino_agent',
        name='rosduino_agent',
        parameters=[{'port': LaunchConfiguration('port')}]
    )

    controller_process = ExecuteProcess(
        cmd=['python3', '/home/' + __import__('os').environ['USER'] + '/ros2_ws/light_controller.py'],
        output='screen'
    )

    return LaunchDescription([
        port_arg,
        agent_node,
        controller_process,
    ])

Теперь остановите процессы в обоих терминалах (Ctrl+C) и запустите всю систему одной командой в Терминале 1:

Терминал 1:

ros2 launch ~/ros2_ws/bringup.launch.py port:=/dev/ttyACM0

И агент rosduino_agent, и ваш управляющий Python-узел стартуют одновременно в одном окне!

Вопросы для самопроверки

  1. Какими пятью функциями объекта ros можно отправить текстовое сообщение с платы в системный журнал /rosout?
  2. Зачем нужна функция ros.now() и чем возвращаемое ею время отличается от millis()?
  3. Какой топик ROS 2 позволяет проверить связь платы с rosduino_agent и что в нём означает статус WARN?
  4. В чём преимущество размещения пороговой логики и фильтрации сигнала в Python-узле на компьютере вместо скетча на плате?
  5. Зачем нужен launch-файл и какие два процесса запускает bringup.launch.py из этого урока?

Назад: Синхронизация времени и диагностика связи.
Дальше: Домашнее задание.