4、机器人控制器软件架构：实时操作系统（RTOS）选型、任务调度、中断管理、内存管理

好，我们进入第四章。这一章我打算聊聊机器人控制器里最核心的软件骨架——实时操作系统。说白了，RTOS 就是给机器人装上一个「准时干活」的大脑。没有它，你的电机控制、传感器采集、通信协议全都乱套。

我在做第一个轮式机器人项目时，一开始图省事用了裸机循环。结果呢？轮子转着转着，超声波数据就丢了。嗯，从那以后，我再也不敢轻视 RTOS 的选型了。

4.1 RTOS 选型：别只看跑分，要看「脾气」

市面上 RTOS 很多，FreeRTOS、RT-Thread、uC/OS、Zephyr……选哪个？我个人习惯先看三点：

• 确定性：中断响应时间是不是可预测的？机器人控制最怕「这次 10us，下次 50us」。
• 资源占用：RAM 和 ROM 吃多少？嵌入式设备寸土寸金。
• 生态与社区：遇到 bug 有人管吗？文档全不全？

我建议你做个简单的对比表，把候选 RTOS 的关键指标列出来：

特性	FreeRTOS	RT-Thread	uC/OS-III
最小 RAM 需求	~1KB	~3KB	~2KB
任务切换时间	~2us (Cortex-M4)	~3us	~1.5us
安全认证	无	部分	有
许可证	MIT	Apache 2.0	商业

4.2 任务调度：让每个任务「刚刚好」

机器人控制器里任务很多：电机控制（1kHz）、IMU 读取（500Hz）、路径规划（50Hz）、UI 刷新（20Hz）……怎么安排它们？

我一般用优先级抢占式调度。高优先级任务（比如电机控制）来了，低优先级的（比如 UI）就得让路。但这里有个坑——优先级反转。

任务周期怎么定？我有个简单公式：

任务周期 = 传感器采样周期 / 2
// 比如 IMU 输出 500Hz，那 IMU 读取任务周期设为 1ms

为什么？因为你要留出余量处理抖动。你想想看，如果采样周期和任务周期一样，稍微抖一下就会丢数据。

4.3 中断管理：别让中断「喧宾夺主」

中断是 RTOS 的命脉。机器人里中断来源太多了：编码器脉冲、定时器溢出、CAN 总线消息……

我有个原则：中断服务程序（ISR）里只做最轻量的事。比如编码器中断，我只在 ISR 里计数，然后把数据通过消息队列发给任务去处理。

// 错误示范：在 ISR 里做复杂运算
void Encoder_ISR(void) {
    static float speed = 0;
    speed = (float)counter / (float)TIMER_PERIOD;  // 浮点运算！太慢了
    SendToControlTask(speed);
}

// 正确做法：ISR 只做标记
void Encoder_ISR(void) {
    BaseType_t xHigherPriorityTaskWoken = pdFALSE;
    xQueueSendFromISR(xEncoderQueue, &counter, &xHigherPriorityTaskWoken);
    portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
}

中断优先级怎么设？我建议：时间敏感的中断（如电机 PWM）设最高，数据采集的中断（如 IMU）设中等，通信中断（如 UART）设最低。这样能保证控制环路不被干扰。

4.4 内存管理：别让内存「碎片化」

嵌入式系统的内存是稀缺资源。RTOS 里的内存管理，说白了就是怎么分、怎么回收。

我见过太多人直接用 malloc/free，结果跑几天后系统就崩了——内存碎片太多。在 RTOS 里，我推荐用静态内存分配：

• 任务栈：在创建任务时就分配好固定大小
• 消息队列：用静态数组，不用动态链表
• 内存池：预分配几个固定大小的块，按需取用

// 静态内存池示例
#define POOL_SIZE 10
#define BLOCK_SIZE 64

static uint8_t memory_pool[POOL_SIZE][BLOCK_SIZE];
static uint8_t pool_used[POOL_SIZE] = {0};

void* pool_alloc(void) {
    for (int i = 0; i < POOL_SIZE; i++) {
        if (!pool_used[i]) {
            pool_used[i] = 1;
            return &memory_pool[i][0];
        }
    }
    return NULL;  // 池满了
}

内存泄漏怎么查？我有个土办法：在任务里定期打印剩余堆大小。如果数值一直往下掉，那肯定有地方泄漏了。

void MemoryMonitorTask(void *pvParameters) {
    while(1) {
        printf("Free heap: %d bytes\n", xPortGetFreeHeapSize());
        vTaskDelay(pdMS_TO_TICKS(1000));
    }
}

4.5 总结：架构设计的三条铁律

讲了这么多，我总结三条铁律，你记下来：

1. 任务别太贪心：一个任务只做一件事，做精做快。别把电机控制和 UI 刷新塞一起。
2. 中断别太啰嗦：ISR 里只做标记和传递数据，复杂逻辑交给任务。
3. 内存别太随意：能用静态就别用动态，能用池就别用堆。

嗯，这一章就到这里。下一章我们聊聊通信协议——怎么让机器人的各个部件「说同一种语言」。