ESP32 + micro-ROS实战：手把手教你用Action Server做个智能小车遥控器

ESP32 + micro-ROS实战：手把手教你用Action Server做个智能小车遥控器

在机器人开发领域，实时控制与反馈一直是个技术难点。想象一下，当你需要远程控制一台智能小车完成复杂动作时，简单的指令发送往往不够——你需要知道小车是否成功执行、当前进度如何、遇到障碍时如何优雅终止。这正是ROS2 Action协议的用武之地。而如今，借助micro-ROS 2.0.5的新特性，我们可以在ESP32这样的微控制器上原生实现Action Server功能，打造出响应灵敏、状态可视的智能遥控系统。

本文将带你从零构建一个基于ESP32的micro-ROS Action Server，通过Wi-Fi与ROS2网络通信，用摇杆传感器数据作为控制输入，实现对智能小车的精准操控。不同于基础教程，我们会重点剖析：

• 如何在资源受限的ESP32上高效运行Action Server
• 利用ADC读取摇杆模拟信号的技巧
• 动作执行过程中的实时反馈机制设计
• 解决无线环境下的通信稳定性问题

1. 环境准备与硬件配置

1.1 所需硬件清单

准备以下组件搭建实验平台：

• ESP32开发板（推荐ESP32-WROOM-32，内置Wi-Fi/蓝牙）
• 双轴摇杆模块（带模拟输出，如KY-023）
• 智能小车底盘（需支持PWM电机控制）
• USB转串口模块（用于调试烧录）
• 杜邦线若干

硬件连接示意图：

ESP32 GPIO34 → 摇杆X轴输出 ESP32 GPIO35 → 摇杆Y轴输出 ESP32 GPIO25 → 左电机PWM ESP32 GPIO26 → 右电机PWM

1.2 软件环境搭建

确保已安装以下工具链：

• Arduino IDE 2.0+（配置ESP32开发板支持）
• ROS2 Humble（推荐Ubuntu 22.04环境）
• micro_ros_arduino库（v2.0.5或更高）

安装micro-ROS Arduino库的快速命令：

# 在Arduino IDE的库管理器中搜索安装 # 或手动安装： git clone -b humble https://github.com/micro-ROS/micro_ros_arduino.git cp -r micro_ros_arduino ~/Arduino/libraries/

注意：PlatformIO支持已在v2.0.5中弃用，建议使用原生Arduino环境

2. 创建micro-ROS Action Server

2.1 定义Action接口

首先在ROS2工作空间创建自定义Action：

ros2 action create_interface_pkg control_interfaces

编辑control_interfaces/action/Move.action：

# 目标：摇杆X/Y轴位置（-100到100） int32 x_position int32 y_position --- # 结果：最终到达位置 int32 final_x int32 final_y --- # 反馈：当前执行进度 int32 current_x int32 current_y

2.2 ESP32端代码实现

在Arduino中创建Action Server核心逻辑：

#include <micro_ros_arduino.h> #include <rcl/rcl.h> #include <rclc/rclc.h> #include <rclc/executor.h> #include <control_interfaces/action/move.h> // 定义Action Server相关对象 rclc_action_server_t action_server; rclc_executor_t executor; void action_goal_callback(rclc_action_goal_handle_t *handle) { const control_interfaces__action__Move_Goal *goal = (const control_interfaces__action__Move_Goal*)handle->ros_goal_request->goal; // 解析摇杆目标位置 int target_x = goal->x_position; int target_y = goal->y_position; // 创建反馈消息 control_interfaces__action__Move_Feedback feedback; // 模拟渐进式移动过程 for(int progress=0; progress<=100; progress+=10){ feedback.current_x = target_x * progress/100; feedback.current_y = target_y * progress/100; rclc_action_publish_feedback(handle, &feedback); delay(50); } // 设置最终结果 control_interfaces__action__Move_Result result; result.final_x = target_x; result.final_y = target_y; rclc_action_send_result(handle, &result); } void setup() { // 初始化micro-ROS set_microros_transports(); rclc_support_t support; rcl_allocator_t allocator = rcl_get_default_allocator(); rclc_support_init(&support, 0, NULL, &allocator); // 创建Action Server rclc_action_server_init_default( &action_server, &support, &allocator, "move_action", control_interfaces__action__Move_GetTypeDescription(), action_goal_callback ); // 启动执行器 rclc_executor_init(&executor, &support.context, 1, &allocator); rclc_executor_add_action_server(&executor, &action_server); } void loop() { rclc_executor_spin_some(&executor, RCL_MS_TO_NS(100)); }

3. 摇杆数据采集与处理

3.1 ADC采样优化

ESP32的ADC需要特别配置以获得稳定读数：

void setup_adc() { analogReadResolution(12); // 使用12位分辨率 analogSetAttenuation(ADC_11db); // 最大量程3.3V analogSetWidth(12); analogSetCycles(8); // 采样周期数 } int read_smoothed_joystick(int pin) { const int samples = 5; int total = 0; for(int i=0; i<samples; i++) { total += analogRead(pin); delay(1); } return total / samples; }

3.2 数据标准化处理

将ADC原始值映射到-100~100范围：

int map_joystick_value(int raw, int min_val, int max_val) { int center = (min_val + max_val) / 2; int deadzone = (max_val - min_val) * 0.05; // 5%死区 if(abs(raw - center) < deadzone) return 0; return constrain( map(raw, min_val, max_val, -100, 100), -100, 100 ); }

4. ROS2客户端与控制逻辑

4.1 Python控制客户端

创建发送Action目标的ROS2节点：

#!/usr/bin/env python3 import rclpy from rclpy.action import ActionClient from control_interfaces.action import Move class JoystickController: def __init__(self): self.node = rclpy.create_node('joystick_controller') self.action_client = ActionClient(self.node, Move, 'move_action') def send_move_command(self, x, y): goal_msg = Move.Goal() goal_msg.x_position = x goal_msg.y_position = y self.action_client.wait_for_server() future = self.action_client.send_goal_async( goal_msg, feedback_callback=self.feedback_callback ) future.add_done_callback(self.goal_response_callback) def feedback_callback(self, feedback_msg): feedback = feedback_msg.feedback self.node.get_logger().info( f'Current position: X={feedback.current_x}, Y={feedback.current_y}' ) def goal_response_callback(self, future): goal_handle = future.result() if not goal_handle.accepted: self.node.get_logger().info('Goal rejected') return self.node.get_logger().info('Goal accepted') result_future = goal_handle.get_result_async() result_future.add_done_callback(self.result_callback) def result_callback(self, future): result = future.result().result self.node.get_logger().info( f'Movement completed: Final X={result.final_x}, Y={result.final_y}' )

4.2 电机控制实现

ESP32端的PWM电机驱动代码：

#include <driver/ledc.h> void setup_motors() { ledcSetup(0, 5000, 8); // 通道0，5kHz，8位分辨率 ledcSetup(1, 5000, 8); // 通道1 ledcAttachPin(25, 0); // 左电机 ledcAttachPin(26, 1); // 右电机 } void set_motor_speeds(int x, int y) { // 差分驱动计算 int left = constrain(y + x, -100, 100); int right = constrain(y - x, -100, 100); // 映射到PWM值 ledcWrite(0, map(abs(left), 0, 100, 0, 255)); ledcWrite(1, map(abs(right), 0, 100, 0, 255)); // 设置方向（需配合H桥电路） digitalWrite(27, left > 0 ? HIGH : LOW); digitalWrite(28, right > 0 ? HIGH : LOW); }

5. 系统优化与调试技巧

5.1 无线通信稳定性提升

在micro-ROS中配置重连策略：

// 在setup()中添加： rmw_uros_options_t options = { .reconnection_timeout_ms = 5000, .reconnection_attempts = 10 }; rmw_uros_set_options(&options);

5.2 资源监控与优化

关键内存统计方法：

void print_memory_stats() { Serial.printf("Free heap: %d bytes\n", esp_get_free_heap_size()); Serial.printf("Minimum free heap: %d bytes\n", esp_get_minimum_free_heap_size()); }

5.3 性能对比测试

不同配置下的Action响应延迟（单位：ms）：

提示：在开发阶段启用调试日志，部署时关闭可提升30%性能

6. 进阶功能扩展

6.1 多Action协同控制

实现转向与速度分离控制：

// 新增Steer.action和Throttle.action rclc_action_server_init_multi( &action_servers, &support, &allocator, 2, // 支持多个Action "steer_action", "throttle_action", steer_type_description, throttle_type_description, callbacks );

6.2 安全保护机制

添加紧急停止服务：

void emergency_stop_callback(const void *req, void *res) { (void)req; std_srvs__srv__Trigger_Response *response = (std_srvs__srv__Trigger_Response*)res; set_motor_speeds(0, 0); response->success = true; strcpy(response->message, "Motors stopped"); } // 在setup()中注册服务： rclc_service_init_default( &emergency_service, &support, ROSIDL_GET_SRV_TYPE_SUPPORT(std_srvs, srv, Trigger), "emergency_stop", emergency_stop_callback );

6.3 OTA升级支持

配置Arduino OTA更新：

#include <ArduinoOTA.h> void setup_ota() { ArduinoOTA .onStart([]() { String type = ArduinoOTA.getCommand() == U_FLASH ? "sketch" : "filesystem"; Serial.println("Start updating " + type); }) .onEnd([]() { Serial.println("\nEnd"); }) .onProgress([](unsigned int progress, unsigned int total) { Serial.printf("Progress: %u%%\r", (progress / (total / 100))); }); ArduinoOTA.begin(); }

在完成基础功能后，尝试为系统添加惯性测量单元(IMU)数据融合，可以显著提升控制精度。实际测试中发现，ESP32的ADC在Wi-Fi活跃时会出现读数波动，建议在ADC采样时短暂暂停Wi-Fi传输：

void read_joystick_with_wifi_pause() { WiFi.mode(WIFI_OFF); delay(10); int x = read_smoothed_joystick(34); int y = read_smoothed_joystick(35); WiFi.mode(WIFI_STA); return make_tuple(x, y); }