Управляющий узел на Python и launch-файл
До сих пор мы проверяли работу платы вручную — вводили в терминале команды ros2 topic pub и ros2 topic echo. В реальном роботе решения принимает программа на компьютере. В этой части урока мы напишем простой управляющий узел на языке Python (rclpy), который получает данные от платы TurtleBro и отправляет ей команды в ответ, а также познакомимся с запуском через launch-файл.
Разделение задач между платой и компьютером
Зашивать сложную логику и пороговые условия прямо в скетч микроконтроллера неудобно: при каждом изменении числа приходится останавливать агент, компилировать код и заново прошивать плату по кабелю.
В ROS 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 мспубликует полученное значение с разъёма GPIOA8(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:
ros2 run rosduino_agent rosduino_agent --port /dev/ttyACM0
- В Терминале 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-узел стартуют одновременно в одном окне!
Вопросы для самопроверки
- Какими пятью функциями объекта
rosможно отправить текстовое сообщение с платы в системный журнал/rosout? - Зачем нужна функция
ros.now()и чем возвращаемое ею время отличается отmillis()? - Какой топик ROS 2 позволяет проверить связь платы с
rosduino_agentи что в нём означает статусWARN? - В чём преимущество размещения пороговой логики и фильтрации сигнала в Python-узле на компьютере вместо скетча на плате?
- Зачем нужен launch-файл и какие два процесса запускает
bringup.launch.pyиз этого урока?
Назад: Синхронизация времени и диагностика связи.
Дальше: Домашнее задание.