24轴EtherCAT主站：STM32F429+主站芯片1ms运动控制

把 24 个伺服轴在一个 1ms 周期里跑得整整齐齐过去的标准答案是一台工控机加一张 EtherCAT 主站卡再上一套实时系统和授权。这套方案稳但贵而且从开机到能跑运动指令要等半分钟。这两年我一直在做另一条路——用 STM32F429 加一颗 ECM-XFU 主站芯片把 EtherCAT 主站和 24 轴运动控制器的活全揽在一张巴掌大的板子上成本压到工控机方案的零头。这篇就把整套流程摊开讲为什么这么选、带宽和内存的账怎么算、硬件上哪几个引脚接错就前功尽弃、上电后第一段代码该怎么写、现场掉站和抖动怎么排查。适合正在做多轴设备、被工控机成本和启动时间折磨的同行也适合刚开始接触 EtherCAT 主站、想搞清楚主站到底在干什么的朋友。里面涉及芯片手册的具体寄存器名我会点到为止具体值以你手上的手册为准我不会把猜测当结论写。1. 24轴工控机方案的钱都花在哪了算完这笔账才知道MCU方案不是将就先说结论24 轴这个数量级恰好是工控机方案性价比曲线开始塌陷的地方。8 轴以下一张低端主站卡加一台小主机成本还能接受到了 24 轴主站卡的通道数、授权费、主机配置全部往上跳一档而实际被你用掉的算力可能连 5% 都不到。我第一次做 24 轴项目时客户看到报价单上主站那一栏直接沉默了三秒后来我们一起把 BOM 拆开看才发现钱主要花在通用性上——工控机要为图形界面、为数据库、为各种可能的扩展留余量而我们的设备只需要一个死循环里跑的那几百微秒。1.1 一台工控机撑24轴的真实成本拆解把那台机器拆开看成本大致分四块。第一块是主机本身为了塞进主站卡机箱要有足够的插槽和散热电源要够这笔钱省不掉。第二块是主站卡24 轴意味着要买高通道授权的版本而且不同品牌对轴的计费方式不一样有的按从站数算有的按实际受控轴算采购前必须问清楚。第三块是实时性Windows 下要么买带实时扩展的版本要么装内核补丁要么干脆换实时系统无论哪条路都有额外的授权和调试成本。第四块最容易被忽略开机时间。工控机从通电到能发第一条运动指令三十秒是常态产线换型频繁的场景下这三十秒乘以每天的换型次数是实打实的产能损失。对比项工控机 主站卡STM32F429 主站芯片主控硬件整机 插槽机箱一张 6~8cm 见方的控制板主站功能独立主站卡 授权一颗主站芯片实时性来源实时系统或内核补丁裸机或小型 RTOS中断即响应冷启动到可运行25~40 秒1 秒以内软件栈驱动 运行时 应用一份固件全部可控批量一致性受主机批次影响固件烧录即一致现场可维护性换整机或换卡换一块小板上表里最值钱的其实不是硬件差价而是最后两行。工控机的批次差异、驱动版本差异、系统更新带来的不确定性在多轴设备上会被放大——同一份程序在 A 客户的机器上跑得好好的到 B 客户那边因为主机批次不同周期抖动就上去了。MCU 方案把这一层变量彻底消掉了固件烧进去行为就是确定的。1.2 主站芯片把哪部分工作接了过去很多人第一次听到用 MCU 做 EtherCAT 主站第一反应是MCU 扛得住吗。扛不住的不是算力是协议栈的实时开销。标准以太网帧的组装、CRC、每个从站的转发计数、工作计数器WKC的核对、分布式时钟的漂移补偿这些事情如果全部压在 MCU 的软件里做1ms 周期下光是这些就吃掉大半主频。主站芯片的价值就在这儿它把帧的组装、发送、接收、WKC 统计、DC 时钟维护全部硬件化MCU 面对的只是一个过程数据镜像区。你往镜像区里写 24 轴的目标位置芯片自己在下一个 SYNC0 到来时把数据塞进帧里发出去收回来再写回镜像区然后给你一个中断。MCU 从头到尾不碰以太网帧只碰一个线性的内存块。这个抽象一旦建立起来整个软件架构就变得非常干净——运动控制的代码根本不需要知道底下是 EtherCAT 还是别的总线。需要说明的是不同主站芯片的镜像区组织方式差别很大有的是按从站顺序排的连续地址有的是按 PDO 条目建的寄存器表还有的提供自动模式和手动模式两套。我下面讲的流程以自动周期模式 线性镜像区这种最常见的设计为准你拿到手上的芯片如果结构不同把对应环节换掉即可整体思路不变。1.3 什么样的项目适合这么换不是所有 24 轴设备都该走这条路。我的判断标准有三条。第一运动逻辑是确定的不需要在控制器上跑视觉、跑数据库、跑联网上报——这些活交给上位机或边缘盒子控制器只管实时环路。第二轴数是固定的或者变化范围小因为 MCU 方案的引脚和内存都是按最大轴数一次性规划好的临时加轴会很痛苦。第三设备是批量产品而不是单台非标机因为 MCU 方案的开发投入集中在前期一旦摊到几百台上去成本优势才明显只做一台的话省下的硬件钱还不够补软件调试的时间。反过来如果你需要频繁改运动逻辑、需要在控制器上直接跑复杂的工艺算法、或者客户明确要求有本地界面那工控机仍然是更省事的选择别为了省成本硬上。我做过的项目里最舒服的是那种工艺固定、批量生产、现场只调参数的设备这类项目把 MCU 方案的优势发挥得最彻底。2. STM32F429够不够用先把带宽和内存的账算清楚再动手选 F429 不是因为它便宜虽然确实便宜是因为它在够用和好买之间拿到了一个很好的平衡点180MHz 主频、带单精度硬件浮点、192KB 内部 SRAM 加 64KB CCM、支持 FMC 外扩 SDRAM、SPI 能跑到 45MHz。这些参数单看没什么凑在一起刚好能撑起 24 轴 1ms 的实时环路。但在动手画板之前你必须先把两笔账算准总线带宽和内存布局。算错了后面所有的调试都会变成玄学。2.1 1ms周期下EtherCAT总线的负载实算先算过程数据。以最典型的 CiA402 伺服从站为例每个轴一个周期要收发的数据大致是这样主站发给从站控制字 2 字节、目标位置 4 字节、运行模式 1 字节走周期同步位置模式的话这 7 字节是底线如果还要发目标速度再加 4 字节。从站回给主站状态字 2 字节、实际位置 4 字节、实际速度 4 字节、错误码 2 字节合计 12 字节。按每轴 23 字节算24 轴就是 552 字节一个方向。EtherCAT 用逻辑读写LRW方式的话这一整段地址空间可以被所有从站按顺序一边读一边写只需要一个数据报数据报头 10 字节加上以太网帧头 14 字节、EtherCAT 头 2 字节、帧尾校验 4 字节整帧大约在 610 字节上下。再加上前导码和帧间隙物理层实际占用约 640 字节。640 字节在 100Mbps 链路上是 5120 个比特传输时间约 51 微秒。再算转发延迟采用直通转发的从站每个大约 0.3 到 1 微秒24 级串下来是 8 到 25 微秒。两块加起来一帧在总线上的总占用不到 80 微秒。放到 1ms 周期里总线负载不到 10%即使把周期压到 500 微秒负载也就 16% 左右余量非常充裕。这个结论很重要它告诉你24 轴 1ms 的瓶颈从来不在 EtherCAT 总线本身。总线轻松得很真正吃力的是 MCU 侧的搬运和计算。很多人在选型阶段死磕总线带宽方向就偏了。2.2 MCU与主站芯片之间的数据通道带宽这才是真正的瓶颈。每周期 MCU 要往镜像区写 552 字节、从镜像区读 552 字节一来一回 1104 字节。如果用 SPI 连接20MHz 时钟下理论速率 2.5MB/s1104 字节需要约 440 微秒——已经吃掉 1ms 周期的 44%加上命令开销和中断延迟基本没有余量给其他任务。这是我第一版板子踩的坑SPI 跑 20MHz1ms 周期下 CPU 有将近一半时间在等 SPI 传输完成稍微加点前瞻计算就开始抖。接口方式典型速率传输 1104 字节耗时占 1ms 周期比例适用场景SPI 20MHz2.5MB/s约 440µs44%8 轴以下或周期 ≥2msSPI 45MHz5.6MB/s约 196µs20%12~16 轴1ms 周期勉强可用FMC 16 位并口约 20MB/s约 55µs6%24 轴及以上推荐FMC 32 位并口约 35MB/s约 32µs3%对余量要求极高时结论很直接24 轴这个量级别用 SPI 硬扛上 FMC 并口。我第二版改成了 16 位并行总线1104 字节的搬运压缩到 55 微秒左右而且可以配 DMA 做整块搬运CPU 只需要在传输完成中断里切换一下缓冲区指针几乎不占算力。多花的十几个引脚换来的是后面所有环节的从容。2.3 F429的存储分区怎么划分才不打架F429 的内存不算多但分得比较细用好了很够用用不好天天 HardFault。我的划分方式如下区域容量用途注意事项CCM RAM64KB实时任务栈、插补中间变量、浮点运算缓冲只有 CPU 能访问DMA 碰不到别放 DMA 缓冲区SRAM1112KBPDO 双缓冲、从站配置表、状态机数据DMA 可访问注意与以太网描述符的冲突SRAM216KB通信缓冲、日志环形队列容量小别塞大数组外部 SDRAM按需8MB 起前瞻队列、路径缓存、参数文件访问延迟大不能放实时环路里的热数据最关键的纪律是实时环路里用到的每一个变量都不许放在外部 SDRAM 上。SDRAM 一次随机访问可能几十纳秒看起来不多但 24 轴插补里一个循环访问几百次累积起来就是可观的抖动而且这种抖动是不可预测的你会花很久才能定位到它。前瞻队列、G 代码缓存这类每次取一批、逐条消费的数据放 SDRAM 没问题PDO 镜像和插补中间量必须留在内部 SRAM 和 CCM。还有一个小细节CCM RAM 只能被 CPU 访问这一点常被当成缺点但在实时控制里反而成了优点——它天然不会被 DMA 抢总线访问时序是确定的。我把最紧的那部分插补计算放在 CCM 里实测周期抖动比全放 SRAM1 小了一截。3. 硬件原理图上的几个决定成败的细节软件可以慢慢调硬件画错就得重新打板而那意味着至少两周的进度。这一节讲的是我在几版板子上反复验证过的、最容易被忽略又最致命的几个点。里面有些是我自己踩出来的有些是同行提醒后我改掉的都有具体的现象可对照。3.1 主站芯片的时钟、复位与供电时序主站芯片通常需要一个外部晶振作为 EtherCAT 时钟基准常见是 25MHz。这个晶振的精度直接决定了分布式时钟的稳定性别在这种地方省钱——用普通无源晶振加两个 20pF 负载电容可以工作但负载电容匹配不好的话起振慢、频率偏移大表现出来就是某些从站的同步误差怎么调都下不来。我的做法是选 ±10ppm 以内的晶振负载电容按手册标称值取PCB 上把晶振尽量贴近芯片底下铺完整地周围不走任何高速信号。复位是第二个坑。主站芯片和 MCU 的复位必须联动而且要保证主站芯片先完成内部初始化、MCU 再去读它的 ID 寄存器。我见过一种情况MCU 复位释放比主站芯片早几毫秒上电时读 ID 读到全 0程序判定芯片不存在直接进入错误处理整机就卡在那儿了断电重启有时能好有时不能好非常迷惑。解决办法两条一是把主站芯片的复位脚接到 MCU 的一个 GPIO 上由 MCU 主动控制复位时序先拉低 10ms 再释放等 20ms 后再读 ID二是读 ID 失败时重试三次间隔 50ms。两条都做基本上就不会再出这个问题。供电方面主站芯片常见是 3.3V IO 加一路更低的核压具体看手册。要注意的是上电顺序如果核压和 IO 压同时上而上升沿差异很大可能出现闩锁电流。稳妥的做法是用带使能脚的 LDO由 MCU 控制使能保证 IO 压晚于核压建立。板上再加一颗 100nF 加一颗 10µF 做本地去耦位置紧贴电源引脚。3.2 物理层变压器、RJ45和差分走线EtherCAT 物理层就是标准以太网但现场环境比办公室恶劣得多这一块的余量必须给足。我用的是带集成变压器的 RJ45省掉外部变压器可以缩小面积但要注意选工业温度范围、带共模电感的型号。如果做成分立方案变压器和 RJ45 之间的走线要短差分对严格等长阻抗控制到 100 欧姆。差分走线上有三条硬规矩一是差分对内等长误差控制在 5mil 以内二是差分对之间保持 3 倍线宽以上的间距避免串扰三是差分对下方必须有完整的地平面不允许跨分割。第三点最容易被忽略——如果差分线中间跨过了电源平面和地平面的分割缝回流路径被打断辐射和抗扰度都会明显变差。我第一版板子就是在这儿栽的跑单机测试一切正常装到设备上旁边一变频器启动就掉站后来把分割缝改掉才稳定。另外两个 RJ45 端口如果做成菊花链进出注意端口顺序要和芯片的端口定义对上。有些芯片端口 0 和端口 1 在内部的处理逻辑略有差异接反了功能上能通但拓扑检测和冗余相关的行为会不对。这个在原理图评审阶段就要核对清楚。3.3 FMC并口还是SPI两种接法的取舍前面算带宽已经给出了倾向这里补充工程上的权衡。FMC 并口的代价是引脚多——16 位数据加十来根控制线二十多个引脚加上 SDRAM 又要二十多个引脚加起来对封装就有要求了。如果 MCU 用 144 脚封装很可能不够用得上 176 脚。这是实实在在的成本和布板面积代价。我的建议是这样如果轴数在 16 以内、周期在 1ms 以上SPI 45MHz 加 DMA 完全够用板子可以做得很小如果确定要做 24 轴甚至更多直接上 FMC 并口加 176 脚封装一次到位别做中途升级的打算因为接口一换软件驱动、时序、DMA 配置全要重写。还有第三种接法主站芯片支持 SPI 但内部有大容量镜像 RAM可以配置成MCU 只更新变化的数据。这种模式在轴数多但并非每轴每周期都更新的场景下很有效比如一部分轴在做点位运动、只有少数轴在插补。但这个优化会让软件变复杂还要维护脏标记我一般不建议在项目初期引入等主体跑通了再看要不要优化。4. 上电后的第一段代码把主站从INIT推到OP板子回来、电源正常、ID 能读到接下来就是让主站把 24 个从站从 INIT 一路带到 OP。这个过程看起来是标准流程但每一步都有能让你卡半天的地方。我把它拆成几个阶段每个阶段都给出怎么判断这一步真的成功了的判据而不是只看代码跑过去了。4.1 枚举与地址分配阶段最容易出的错上电后主站处于 INIT 状态此时所有从站都只有自动增量地址可用。标准动作是发一个广播读让每个从站在自己的位置上把增量地址写回数据区这样主站就拿到了拓扑顺序然后逐个用增量地址把从站的配置地址也就是常说的站点地址设成你想要的值通常是 1 到 24。这里第一个坑是增量地址回读的顺序。有些实现里从站是边转发边写入数据区里第 N 个位置对应第 N 个从站看起来理所当然但如果链路里有从站没上电、或者某个端口接了个不支持透传的设备回读的数据就会错位后面的地址分配全乱。稳妥的做法是把回读数据全部打印出来人工核对一遍数量是不是 24有没有出现全 0xFF 的片段。第二个坑是站点地址冲突。如果从站驱动器出厂时被设过固定站点地址你再用自动增量去改可能出现两个从站抢同一个地址。现象是枚举时数量对得上但进 PREOP 之后有一个从站死活不响应。解决办法是先用配置工具把所有从站的站点地址清成 0统一由主站分配或者在分配完成后逐个读回站点地址发现有重复就报错停机别带着隐患往下跑。第三个坑比较隐蔽从站的 EEPROM 读取速度。有些从站上电后需要几十毫秒才能把 ESI 信息从 EEPROM 加载完如果主站枚举太快读到的厂商 ID 和产品码是空的。我的做法是在枚举前加 100ms 延时并且读取失败重试三次。这个延时看起来浪费但比现场偶发性的少一个站要好得多。4.2 PDO映射必须和从站的ESI描述对齐进 PREOP 之后要做的是配置邮箱、配置过程数据区、建立 PDO 映射。这一块的核心原则只有一条主站侧认为的 PDO 布局必须和从站实际生效的 PDO 布局逐字节对齐。很多人的做法是照着从站手册上的默认 PDO 列表写死跑起来发现位置数据错位。原因往往是从站驱动器出厂时被改过 PDO 配置或者用了不同的 PDO 分配对象。我的做法是在配置阶段做两件事一是通过邮箱读一次从站实际生效的 PDO 分配对应 CiA402 里那几个分配对象和主站侧的期望值比对不一致就报错二是如果主站芯片支持直接读从站的过程数据长度和镜像区里分配的偏移量核对。镜像区的地址分配也要有纪律。我给每个轴划一段固定长度的区域长度按最大可能的过程数据算比如 32 字节不足的补空而不是紧凑排列。这样做的代价是浪费了几百字节内存好处是任何一个轴的 PDO 长度变化都不会导致后面所有轴的偏移全部平移排查问题时不会因为改了一个轴二十三个轴全乱而崩溃。这种用空间换确定性的取舍在实时控制里几乎总是划算的。4.3 分布式时钟的偏移测量与SYNC0启动24 轴要同步动作就必须用分布式时钟。不开 DC 也能跑但各轴的采样时刻会差几十微秒多轴联动的轨迹上表现为轮廓误差尤其是圆弧插补的时候肉眼都能看出不圆。DC 的配置顺序我总结成四步第一步让所有从站进入 DC 模式这是通过写从站的激活寄存器完成的第二步测量传播延迟——主站发出一个读命令从站在收到帧的瞬间把本地时间锁存到寄存器里主站读回这些时间戳逐个算出每一级相对于第一级的延迟第三步把延迟值写入各从站的系统时间偏移让所有从站的时钟对齐到同一个时间基准第四步设置 SYNC0 周期就是你的控制周期和移位量然后启动。移位量这个参数值得多说一句。SYNC0 信号是在每个周期的某个时刻产生的从站通常在这个信号后开始采样输入、应用输出。如果把移位设成 0SYNC0 和帧到达几乎同时发生从站可能还没收到本周期的新数据就开始采样了读到的是上一周期的值。常见的做法是移位设在周期的 30% 到 50% 之间留出帧传输和从站处理的时间。24 轴的话我一般从 40% 开始试然后用示波器或者从站的时间戳统计看抖动再微调。判断 DC 是否真的生效不要只看配置成功的返回值。我的验证方法是读每个从站的系统时间差寄存器在稳定运行状态下连续采样几百次如果 24 个轴的差值都在 ±100ns 以内波动说明同步是好的如果某个轴一直在漂多半是那一级的传播延迟测量有问题或者该从站本身对 DC 的支持不完整。