整体架构一览

一台智能机器人底盘需要同时控制电机、读取编码器、采集激光雷达数据并把这些信息通过ROS2发布出去。嵌入式主控通常是一块主频几百MHz的MCU（比如STM32H743），跑FreeRTOS做实时任务，然后通过UART或CAN桥接到运行完整ROS2的工控机（如树莓派或Jetson）。实际开发中，大部分团队会在MCU上跑微ROS客户端（micro-ROS），直接在MCU上创建话题和服务节点，通过序列化层把数据推给上位机。 我把这个案例拆成三个层级，从裸机驱动到通讯链路，再到业务节点。第一层是硬件抽象（驱动层），第二层是微ROS的Executor（任务层），第三层是发布/订阅的数据流。

驱动层封装与微ROS桥接

先看一个典型的电机控制任务。我把编码器数据采集放在一个高优先级定时器中断里，每1ms一次。数据准备好后，通过一个FreeRTOS消息队列发送给微ROS发布任务。

// 编码器中断回调
void HAL_TIM_IC_CaptureCallback(TIM_HandleTypeDef *htim) {
    static int32_t pulse_count = 0;
    pulse_count++;
    // 每10个脉冲发布一次消息
    if (pulse_count % 10 == 0) {
        odom_msg.delta_angle = 0.001f; // 简化：每个脉冲对应0.001rad
        xQueueSendFromISR(odom_queue, &odom_msg, 0);
    }
}

// 微ROS发布任务
void micro_ros_publish_task(void *params) {
    rcl_publisher_t publisher;
    rcl_node_t node;
    // ... 初始化节点和发布者
    while (1) {
        if (xQueueReceive(odom_queue, &odom_msg, portMAX_DELAY) == pdPASS) {
            rcl_ret_t ret = rcl_publish(&publisher, &odom_msg, NULL);
            if (ret != RCL_RET_OK) {
                // 处理错误：重连或丢弃
            }
        }
    }
}

这里有个隐藏的坑：在ISR中调用了xQueueSendFromISR，对应的接收任务必须用xQueueReceive阻塞等待，不能在ISR里直接调用rcl_publish（微ROS的发布函数不是中断安全的）。如果非要在一个中断服务里做发布，可以用一个队列做解耦。我在第一次做原型时忽略了这一点，导致随机死锁，排查了两天才发现。

通信链路配置与优化

微ROS客户端默认用UART走串口协议，波特率一般设921600。如果数据量超过几千字节每秒，就得考虑使用CAN FD或USB CDC。我测试过，在921600波特率下，发布一条包含100个激光点的LaserScan消息（约1.2KB）耗时约15ms。对于10Hz的激光雷达，这个延迟可以接受。但如果你要跑30Hz的雷达数据，就得切到高速串口甚至用USB虚拟串口。

传输方式	最大吞吐量	适用场景
UART (921600)	≈90KB/s	里程计、简易传感器、低速控制命令
USB CDC	≈1MB/s	激光雷达、摄像头图像压缩流
CAN FD	≈5MB/s	多电机协同、高实时性控制环路

微ROS的传输层支持自定义，实际开发中大部分团队会用一个UART + DMA双缓冲的方案。具体做法是在MCU侧开两个长度为256字节的接收缓冲区，一个给DMA用，一个给微ROS协议栈解析用。当DMA半满或全满时触发中断，通知协议栈读取新数据。

实时性保障：Executor与任务优先级

ROS2的Executor在PC上很成熟，但在嵌入式场景下，微ROS的Executor是单线程事件循环。你不能同时阻塞两个发布任务——必须用一个状态机把多个传感器数据的发布调度开。 Executor循环内部是这样工作的：调用rcl_wait_set_fill等待所有订阅、发布和服务句柄，然后调用rcl_wait（内部包含超时）。等待结束后，依次调用每个句柄对应的回调函数。如果你有两个传感器，一个激光雷达（10Hz）和一个里程计（100Hz），最好把这两个发布放在同一个回调函数里，让Executor只触发一次，然后通过队列分发。 我踩过一个坑：在Executor回调中调用了HAL_Delay(10)，结果导致180ms后才处理订阅者的命令。这在底盘控制上是致命的——机器人会突然加速或停车。正确的做法是把控制命令放在一个实时任务中，用队列从中断或回调中接收。

完整系统集成示例

把上面讲的点全部串起来，一个典型的嵌入式底盘节点流程如下： 1. 上电后初始化FreeRTOS，创建三个任务：传感器采集（优先级3）、控制计算（优先级4）、微ROS通信（优先级2）。微ROS任务的优先级最低，因为它的实时性要求最低——消息延迟几毫秒不会让机器人失控，但控制计算延迟几毫秒就可能撞墙。 2. 激光雷达（RPLidar A1）通过串口2输出数据，每5ms产生一个中断。中断服务函数里把数据放入一个循环缓冲区，然后在传感器采集任务中每10ms解码一次，构造LaserScan消息。 3. 里程计来自两个编码器（正交编码器模式）。我在项目中遇到一个问题：编码器计数在高速旋转时会溢出（32位计数器，5000rpm时几分钟就溢出）。解决办法是启用定时器的自动重装载功能，同时在定时器更新中断里记录溢出次数，通过软件扩展成48位计数。 4. 微ROS节点通过UART1连接到树莓派4B，树莓派运行ros2 daemon和nav2导航栈。MCU发布/odom和/scan，订阅/cmd_vel。

// 订阅速度命令示例
void cmd_vel_callback(const void *msgin) {
    const geometry_msgs__msg__Twist *speed = 
        (const geometry_msgs__msg__Twist *)msgin;
    // 通过队列发送给控制任务
    target_speed.linear  = speed->linear.x;
    target_speed.angular = speed->angular.z;
    xQueueSend(speed_queue, &target_speed, 0);
}

// 在主循环中注册回调
rcl_subscription_t sub;
rcl_subscription_init(&sub, &node, &type_support, "/cmd_vel");
rclc_executor_add_subscription(&executor, &sub, &msg, &cmd_vel_callback, ON_NEW_DATA);