基于 RT-Thread + RA6M4 的 broom 引擎伺服控制器设计

• 1
  broom 引擎在伺服控制器设计中的作用
• 2
  RT-Thread 上的任务与中断布局
• 3
  控制周期与 PWM 频率的选择
• 4
  编码器与传感器反馈路径
• 5
  RT-Thread 与 RA6M4 不再适用的场景
• 6
  伺服控制器设计的控制平台对比

broom 引擎是底层运动调度器，本身不是控制律。它维护一张运动段表，决定哪一段处于活动状态，并在固定节拍把下一个设定点交给电流环。名字来自它把过期段从队列中扫除的方式，就像扫帚清扫地面。

这种拆分很重要。控制律保持小而确定，而段表在多轴运动时可增长到数百条。在 RA6M4 上，段表存放在 SRAM 中，引擎只在控制节拍之间访问它，因此电流环从不需要等待内存拷贝。

RA6M4 是 Cortex-M33 器件，带硬件三角函数单元和可由定时器事件直接触发的 12 位 ADC。该触发路径消除了电流采样中的软件抖动。在伺服控制器设计中，采样抖动往往是可闻噪声和转矩脉动的最大单一来源。

RT-Thread 位于引擎之上。它负责网络协议栈、文件系统和命令 shell，这些都不能以控制优先级运行。保持这条边界清晰，即使 Modbus 帧在运动中途到达，控制环也能保持可预测。

• 1
  引擎掌管时间它决定何时发布新设定点，而不是应用线程。
• 2
  控制律掌管形状PID、前馈和陷波滤波器在已发布的设定点上运行。
• 3
  RTOS 掌管外部通信、日志和 UI 以低于控制优先级运行。

大多数构建三级执行层就足够。电流环在最高层的定时器中断中运行，broom 引擎作为高优先级 RT-Thread 线程运行，其他一切在其下运行。增加第四层通常只会增加延迟，而不是减少延迟。

电流环应在 ADC 转换结束中断中运行，而不是在周期定时器中运行。ADC 触发来自定时器比较事件，因此电流环在 PWM 周期的固定点启动。这将采样与开关周期绑定，并在母线电压变化时保持相位裕度稳定。

在 RT-Thread 上给 broom 引擎线程优先级 8 或更高，通信线程约 20。RT-Thread 按优先级调度，仅在相同优先级之间进行时间片轮转，因此高优先级线程可干净地抢占。不要在引擎线程上启用时间片；被切片的引擎可能错过段边界。

引擎与电流环之间的共享数据应是一个由一方写入、另一方读取的结构体。使用短临界区或双缓冲，不要用互斥量。中断路径中的互斥量是等待网络繁忙时暴露的缺陷。

• 1
  在 ADC ISR 中采样由驱动 PWM 的同一定时器触发，因此抖动保持在一个时钟以内。
• 2
  引擎优先级 8+它必须抢占通信，而不是排在通信之后。
• 3
  ISR 中不用互斥量改用双缓冲或标志位。

从 1 kHz 电流环和 10 kHz PWM 载波开始。该比例使每次控制更新有十个开关周期，足以将电流纹波限制在合理范围，而不要求 MCU 每 100 μs 做大量运算。在 200 MHz M33 内核上，带两个 PI 调节器和 park 变换的磁场定向电流环可轻松满足该预算。

仅当电机电感足够低、电流纹波成为实际问题，或可闻频段重要时，才将 PWM 提高到 20 kHz。载波频率每翻倍一次，都会增加开关损耗和 ADC 建立时间。RA6M4 的 ADC 需要确定的采样窗口；20 kHz 载波加上长采样窗口可能占用大部分周期。

位置环和速度环运行更慢。1 kHz 位置环很常见，500 Hz 速度环在柔性负载上通常更平滑。broom 引擎以最快环速率发布设定点，较慢的环消费滤波后的结果。

先测量再整定。在电流 ISR 开始和结束处翻转 GPIO，用示波器观察。如果 ISR 主体超过周期的 40%，设计就没有余量支持第二轴。

• 1
  1 kHz 电流环在 200 MHz M33 内核上可容纳完整 FOC 运算。
• 2
  10 kHz PWM每次控制更新十个载波周期；保持低开关损耗。
• 3
  500 Hz 速度环对柔性负载和弹性联轴器更宽容。

RA6M4 有 32 位编码器计数器，可由外部信号提供时钟，因此增量编码器可在无 CPU 负载的情况下驱动位置。在位置环中读取计数器，而不是在电流环中读取。每 100 μs 读取一次会浪费周期且毫无收益，因为位置在十个载波周期内移动不大。

对于旋转变压器或 sin/cos 编码器，三角函数单元在硬件中完成反正切运算。这省去了软件 CORDIC 循环，并让位置环保持确定性。硬件三角函数还消除了用低阶多项式近似反正切的诱惑，这种近似会在象限边界附近引入位置误差。

注意传感器带宽。2,500 线编码器在 3,000 rpm 下经四倍频解码后，边沿速率达到低兆赫兹范围。将这些信号按差分对布线或使用屏蔽电缆，并在 MCU 侧端接。索引线上的噪声会导致最糟糕的故障：位置跳变，看起来像机械问题。

在编码器与任何辅助传感器之间增加合理性检查。如果两者偏差超过设定窗口并持续超过几毫秒，就切断驱动器使能。这能在轴失控之前发现编码器电缆断裂。

• 1
  硬件编码器计数器在慢环中读取位置，而不是在电流环中。
• 2
  旋转变压器三角函数单元确定性反正切，无多项式近似误差。
• 3
  交叉检查传感器偏差超过窗口即禁用驱动器。

该平台适合中等功率的 1 到 4 轴，控制周期可低至约 100 μs。它很适合贴片头、实验室位移台、小型 CNC 轴和泵驱动，这些场合负载已知且环境受控。

它不适合需要 50 kHz 逐周期限流的多千瓦驱动器，也不适合超过 6 个同步轴且相位对齐要求亚微秒的机器。这些任务需要 FPGA、专用运动 ASIC，或具有更快控制路径和硬件限流器的 DSP。

当产品需要连接性、文件系统或空中更新时，RT-Thread 才有价值。如果控制器只运行固定运动曲线且从不与任何设备通信，裸机循环更小且更容易认证。给不需要 RTOS 的设备加 RTOS 只会增加工作量，不会增加能力。

热设计和电源设计比软件更常限制平台。48 引脚封装、3.3 V 供电的 200 MHz 内核仍然需要干净的模拟电源、ADC 下方的完整地平面，以及不会将电流尖峰灌入该平面的栅极驱动。布局错了，再多的调参也解决不了噪声。

• 1
  适合1–4 轴，100 μs 控制周期，受控环境。
• 2
  不适合大功率驱动和 1 μs 以下的 6 轴以上同步。
• 3
  仅在需要时用 RTOS连接性、存储和更新才值得使用。