4. 运动控制软件架构：RTOS选型、任务调度与分层设计

做运动控制这么多年，我最大的体会就是：软件架构决定了系统的上限。算法再牛，如果跑在混乱的软件上，照样出问题。今天咱们就聊聊运动控制软件的核心——实时操作系统（RTOS）的选型、任务调度、中断管理，还有软件分层设计。

4.1 实时操作系统（RTOS）选型

选RTOS，说白了就是选「能不能按时干活」。运动控制对实时性要求极高——你想想看，电机转一圈可能就几毫秒，指令晚到一丁点，位置就偏了。

我常用的几个RTOS：

RTOS	特点	适合场景
FreeRTOS	轻量、开源、生态好	中小型运动控制，比如3D打印机、机械臂
RT-Thread	国产、组件丰富、支持POSIX	需要网络、GUI的复杂运动控制
μC/OS-III	商业级、稳定、文档全	工业级、高可靠性场景
VxWorks	硬实时、军工级	航天、高端数控

我个人习惯：项目初期先用FreeRTOS，因为它上手快、坑少。等系统复杂了，再考虑换RT-Thread或μC/OS。我在一个六轴机械臂项目里，一开始用了裸机，结果中断一多就乱套。后来换成FreeRTOS，任务调度一上，问题全解决了。

4.2 任务调度策略

运动控制里，任务调度是灵魂。你想想看：位置环、速度环、电流环，哪个先跑？哪个能等？

我常用的调度策略：

• 优先级抢占式调度：高优先级任务随时打断低优先级。适合电流环、位置环这种硬实时任务。
• 时间片轮转：同等优先级的任务轮流跑。适合通信、日志这类软实时任务。
• 固定周期调度：每个任务固定时间执行一次。适合控制环路。

举个例子，一个典型的运动控制任务优先级分配：

任务优先级分配（数值越小优先级越高）：
优先级 0：电流环控制（1kHz）—— 硬实时
优先级 1：位置环控制（500Hz）—— 硬实时
优先级 2：速度环控制（200Hz）—— 硬实时
优先级 3：通信任务（CAN/EtherCAT）—— 软实时
优先级 4：状态监控、日志 —— 非实时
优先级 5：用户界面 —— 最低优先级

我曾经在一个项目中，把通信任务优先级设高了，结果电流环被频繁打断，电机抖得像筛子。后来把电流环提到最高优先级，问题立刻消失。嗯，这里要注意：硬实时任务必须独占最高优先级。

4.3 中断管理

中断是RTOS的「快速通道」。运动控制里，中断用来处理最紧急的事情——比如编码器脉冲、限位开关触发、故障信号。

中断管理原则：

• 中断服务程序（ISR）要短：ISR里只做最必要的事，比如读寄存器、置标志位。复杂处理交给任务。
• 中断优先级要合理：运动控制的中断优先级通常高于所有任务。
• 避免中断嵌套：除非必要，否则关掉中断嵌套。嵌套多了容易出bug。

我习惯的做法：ISR里只做三件事——读数据、清标志、发信号量。剩下的计算、逻辑判断，统统交给任务去干。为什么？因为ISR里不能调用阻塞函数，也不能做复杂运算。你想想看，ISR里跑个浮点运算，其他中断全堵死了。

// 一个典型的ISR写法
void Encoder_ISR(void) {
    BaseType_t xHigherPriorityTaskWoken = pdFALSE;
    
    // 1. 读取编码器计数值
    uint32_t pulse = TIM->CNT;
    
    // 2. 发送信号量给位置计算任务
    xSemaphoreGiveFromISR(xPosSemaphore, &xHigherPriorityTaskWoken);
    
    // 3. 如果需要，触发任务切换
    portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
}

4.4 软件分层设计

软件分层，说白了就是各司其职。运动控制软件我习惯分三层：驱动层、算法层、应用层。每层只管自己的事，别越界。

下面这张图是我常用的分层架构：

各层职责：

• 驱动层：直接操作硬件。比如读写寄存器、配置PWM、读取编码器。这一层要尽量薄，只做硬件抽象。
• 算法层：跑控制算法。位置环、速度环、电流环都在这里。这一层是核心，要保证实时性。
• 应用层：处理非实时任务。比如用户界面、通信协议、日志记录。这一层可以慢一点，但不能阻塞算法层。

我见过最糟糕的代码：应用层直接操作寄存器。结果改个UI，电机就不转了。分层设计的好处就是：改应用层，驱动层和算法层不用动。改算法层，驱动层不用动。各层之间通过接口函数通信，别直接传全局变量。

4.5 实际项目中的经验总结

说了这么多，我总结几条实战经验：

1. RTOS选型别纠结：先选个成熟的，比如FreeRTOS。项目做大了再换，别一开始就追求完美。
2. 任务优先级宁高勿低：控制环路的优先级，能设多高设多高。我吃过亏——优先级设低了，电机抖得没法看。
3. 中断里别干重活：ISR里只做三件事——读数据、清标志、发信号量。其他全扔给任务。
4. 分层要严格：驱动层、算法层、应用层，各管各的。别让应用层直接操作硬件。
5. 调试接口要留好：每个任务留一个状态输出，方便调试。我习惯用串口打印任务运行时间、堆栈使用情况。

---