Linux下IgH EtherCAT主站：从网卡绑定到CiA402伺服实时控制

简介面向工业机器人与运动控制方向的开发者、学生及工程技术人员这份资源围绕 Linux 平台下的 EtherCAT 开源主站 IgH 展开结合汇川 SV630N 伺服的实际调试场景讲解主站程序的运行流程与主从通信要点并对六自由度机械臂基于 EtherCAT 的实时运动控制论文进行导读帮助读者建立从协议原理到主站实现、再到伺服联调的完整认知。压缩包内为 1 个 PDF 文件约 1.63MB便于随取随查。目前已有 5228 人学习下载说明其在同类资料中具有较好的参考基础。内容涉及 IgH 主站的编译与启动流程、Xenomai 实时内核的增强作用、主从站通信调试思路以及基于三度 B 样条插值的轨迹规划与改进 D-H 参数法逆运动学求解仿真与实验结果表明逆解计算速度快、机械臂运动连续平滑适合作为入门梳理与项目落地时的对照材料。1. 一台伺服、一块网卡、一台工控机Linux 下 IgH 主站到底能把 EtherCAT 跑到什么程度拿到一台支持 CiA402 的国产伺服桌上只有一块普通网卡和一台装了 Ubuntu 的工控机想让它跟着六轴机械臂跑插补——大多数人第一次都会卡在网卡绑定和状态机逐级切换这两步。IgH 这套 Linux 下的开源 EtherCAT 主站程序本质上是把“用户写一行读位置”翻译成“内核在上一帧报文里塞进 0x6064 的值”再把实时循环挪到 Xenomai 或 RT-Preempt 上让一个周期稳稳压在毫秒级。它解决的是买不起商用配置软件这个前提下的真问题从站扫描、PDO 映射、分布式时钟、伺服使能全部用 C 代码和一组命令行工具跑通。适合手上有伺服、有网卡、愿意啃源码的嵌入式与运动控制从业者不适合只想点几下鼠标出结果的人。2. EtherCAT 状态机与 IgH 主站的分层结构先把 ecrt 接口的调用时机搞对再动键盘2.1 五态状态机与主站必须在每个阶段做的事EtherCAT 从站的状态机ESM有五个状态INIT、PREOP、SAFEOP、OP、BOOT。前四个是每个合规从站都必须支持的BOOT 是可选的固件下载态。这个顺序不是走个过场每一级迁移时主站要下发不同的配置少一步就上不去。INIT 态从站还没建立邮箱通信主站只能通过寄存器访问拿不到 SDO 也读不到 PDO。PREOP 态邮箱通道建立主站可以读写 SDO开始配置站地址、SM0/SM1 邮箱参数、SM2/SM3 过程数据区。SAFEOP 态过程数据开始交换但从站只发出输入数据TxPDO输出RxPDO被禁止。这一态是“只读观察”的黄金窗口。OP 态输入输出都打开伺服才真正听你的 0x6040 和 0x607A。BOOT 态从 INIT 或 PREOP 进入用于刷固件。IgH 在ecrt_request_master之后并不会立刻推进状态真正的迁移发生在ecrt_master_activate那一刻主站根据你在ecrt_master_slave_config和ecrt_slave_config_pdos里登记的配置依次把每个从站从 INIT 推到 OP。常见做法是在配置阶段就把 SDO 写入比如模式 0x6060、限位 0x607D一并提交这样主站在 PREOP 阶段会替你下发省去后面单独调ethercat download的麻烦。需要提前知道一个边界如果从站配了分布式时钟DC主站在 SAFEOP 到 OP 之间会做一次启动时间检查此时 SYNC0 周期必须已经从主站下发并且偏移量在容差内否则这一跳会超时状态就那么悬在 SAFEOP 不动日志里只有一句含糊的 timeout。2.2 IgH 的三层结构内核模块、字符设备、用户态库IgH 不是单文件库它分三层理解分层才知道排错时该看哪儿。最底下是内核模块ec_master.ko加一块网卡驱动模块ec_generic、ec_igb、ec_e1000e这类。网卡一旦被ec_master接管就绕开了 Linux 协议栈直接收发以太网原始帧所以那块口不能再配 IP、不能插普通交换机做业务通信。中间层是字符设备/dev/EtherCAT0用户态和内核的唯一通道。最上面是libethercat.so也就是你写代码时调用的ecrt_*系列函数再加一个/opt/etherlab/bin/ethercat命令行工具。这个结构带来的直接后果是ethercat命令行工具和你的 C 程序抢的是同一个/dev/EtherCAT0。程序还在跑的时候去敲ethercat slaves要么被拒绝要么两边都出怪状态。排查时要么先停程序要么干脆就在程序里打日志不要两手同时抓。另一个边界是所有权。ecrt_request_master(0)是排他打开第二个进程再调就返回空指针。如果看到ecrt_request_master失败先ps aux | grep ethercat看看是不是上次调试的残留进程没杀干净。2.3 用 ethercat 命令行给从站做一次体检写第一行 C 代码之前先把这组命令跑一遍。它的价值在于所有后面会在代码里出现的数字这里都能提前看到不用等编译失败再去猜。# 主站状态看 MAC 是否绑对、从站数量、AL 状态是否全 OP ethercat master # 从站清单位置、别名、厂商 ID、产品码、当前状态 ethercat slaves # 每个从站支持哪些 PDO 条目映射有没有空 ethercat pdos # 直接导出 ecrt_slave_config_pdos 能用的 C 结构体复制粘贴即可 ethercat cstruct # 列出对象字典查 0x6060/0x6064/0x607A 在不在 ethercat sdos # 直接读写 SDO绕过 PDO 通道做对照 ethercat upload 1 0x6064 0 # 读从站 1 的实际位置 ethercat download 1 0x607D 1 0xFFFFF000 # 写负向软限位 # 看分布式时钟的接收时间与偏移 ethercat dc 1这一段里最被低估的是ethercat cstruct。它会把从站当前的 PDO 映射原样翻译成ec_pdo_entry_info_t和ec_sync_info_t的初始化代码实际项目里几乎不用手写映射表导出后改改变量名就能用。手写映射最容易翻车的地方是 subindex0x607A 是 0x00 还是 0x01不同固件真的不一样抄别人的代码必然出错。ethercat dc的输出也要会看。它会列出每个从站的参考时钟、系统时间差、以及 SYNC0 的偏移。六个轴同时跑的时候如果各从站的偏移量差异超过几个微秒圆弧插补的末端就会出现肉眼可见的抖动这个问题在单轴测试时完全暴露不出来。3. 把 IgH 编进 Linux 内核实时补丁、头文件版本、网卡驱动这三件事必须一次定对3.1 实时内核怎么选Xenomai、RT-Preempt 与不打补丁的差别这一步选错后面所有调参都是白费。不打补丁的普通内核调度粒度在毫秒到十几毫秒之间浮动1ms 周期跑起来看着能用但抖动经常窜到几百微秒。伺服侧的表现是位置跟随误差间歇性报警或者干脆报同步丢失。功能调试阶段可以忍带载跑一定翻车。RT-Preempt 是单内核方案把内核里大部分不可抢占区改造成可抢占编译简单Ubuntu 官方源里就有现成包。它的抖动通常在几十微秒量级配合--enable-hrtimer能到十几微秒做 1ms 周期的六轴插补够用。Xenomai 是双内核方案在 Linux 旁边跑一个实时核Cobalt实时任务直接跑在 Cobalt 上抖动可以压到个位数微秒。代价是内核版本适配很挑补丁对不上就得自己改而且用户态程序要链接libcobaltprintf、malloc这类调用在实时上下文里要格外小心。论文里提到的那套方案就是走 Xenomai 路线理由是伺服控制在高速段对同步要求高。我一般的顺序是先用 RT-Preempt 把功能全跑通确认协议层、映射、使能序列都没问题再切 Xenomai 做性能压榨。反过来做的话功能问题和实时问题混在一起排错成本至少翻倍这是实打实的血泪经验。3.2 配置、编译、安装的完整流程# 依赖。头文件必须是正在跑的那个内核的不是最新版 sudo apt install -y git autoconf automake libtool pkg-config \ linux-headers-$(uname -r) # 拉源码分支按手头版本走 git clone https://gitlab.com/etherlab.org/ethercat.git cd ethercat git checkout stable-1.5 # 关键配置项逐条解释见下 ./bootstrap ./configure \ --prefix/opt/etherlab \ --disable-8139too \ --enable-generic \ --enable-hrtimer \ --with-linux-dir/usr/src/linux-headers-$(uname -r) make -j$(nproc) sudo make modules_install install sudo depmod -a参数说明--prefix/opt/etherlab装到独立目录将来想换版本直接删目录不会污染/usr。--disable-8139too这是块上古百兆网卡芯片的驱动留着大概率编译报错直接关掉。--enable-generic走内核现成的通用网卡驱动加中断兼容性最好代价是延迟比专用驱动高。第一轮验证必开。--enable-hrtimer用高精度定时器替代内核 tick周期低于 1ms 时必须开不开的话ecrt_master_send的实际节奏会被 tick 带偏。--with-linux-dir这一项填错是最常见的编译失败原因。用uname -r查当前内核版本再到/usr/src/下找对应目录不要用/lib/modules/$(uname -r)/build之外随便挑一个。编译完之后还有一步容易漏ethercat命令行工具在/opt/etherlab/bin/libethercat.so在/opt/etherlab/lib/。要让系统找到库要么写进/etc/ld.so.conf.d/要么在编译自己的程序时用-L/opt/etherlab/lib -I/opt/etherlab/include显式指定。用pkg-config更省事export PKG_CONFIG_PATH/opt/etherlab/lib/pkgconfig:$PKG_CONFIG_PATH gcc main.c -o main $(pkg-config --cflags --libs libethercat)3.3 网卡绑定通用驱动、原生驱动与自建驱动的取舍驱动方式适用网卡典型抖动编译要求什么时候用ec_generic内核能识别的所有网卡550 µs无--enable-generic即可方案验证、非量产原生驱动ec_igb、ec_e1000e等特定芯片15 µs需单独编译模块与内核版本强耦合性能调优、量产自建驱动任意看实现工作量大一般不建议绑定的完整流程# 1. 把网卡从网络管理器手里抢回来否则报文会被协议栈吞掉 sudo nmcli dev set enp3s0 managed no 2/dev/null || true sudo ip addr flush dev enp3s0 sudo ip link set enp3s0 down # 2. 加载主站模块MAC 全小写、冒号分隔一位都不能错 sudo modprobe ec_master main_devices00:1b:21:aa:bb:cc # 3. 或者走配置文件 启动脚本适合现场部署 # /opt/etherlab/etc/ethercat.conf 里填 MASTER0_DEVICE00:1b:21:aa:bb:cc # MASTER0_DRIVERgeneric sudo /opt/etherlab/etc/init.d/ethercat start # 4. 验证 ethercat mastermain_devices这个参数不填ec_master会去自动挑一块网卡多网口的机器上挑错概率极高挑错了就是永远扫不到从站而且报错信息完全不指向根因。所以这条参数属于“宁可多打一行也不能省”。还有一点绑定的网卡必须在ethercat start之前就处于 down 状态并且没有 IPv4/IPv6 地址。网卡上挂着地址内核的邻居子系统会往这个口里塞 ARP 报文混在过程数据里轻则影响周期重则直接判定链路异常。4. 主站程序骨架从 request_master 到周期循环的每一行在做什么4.1 初始化六步与 PDO 映射的注册顺序下面这段是可以直接抄的初始化骨架变量声明、映射表、调用顺序都在里面。#include ecrt.h #include stdint.h #include stdio.h #define CYCLE_NS 1000000 /* 1 ms 周期 */ #define VENDOR_ID 0x00000000 /* 换成 ethercat slaves 里看到的厂商 ID */ #define PRODUCT_ID 0x00000000 /* 换成实际产品码 */ static ec_master_t *master NULL; static ec_domain_t *domain NULL; static ec_slave_config_t *sc NULL; static uint8_t *domain_pd NULL; /* PDO 偏移量交给注册表回填不要手填数字 */ static unsigned int off_ctrl, off_tpos, off_mode, off_stat, off_apos, off_vel, off_torq; /* 注意第三、四列厂商/产品码填 0 表示不校验验证阶段可以这么写 */ static ec_pdo_entry_reg_t domain_regs[] { {0, 1, 0, 0, 0x6040, 0x00, off_ctrl, NULL}, /* 控制字 */ {0, 1, 0, 0, 0x607A, 0x00, off_tpos, NULL}, /* 目标位置 */ {0, 1, 0, 0, 0x6060, 0x00, off_mode, NULL}, /* 运行模式 */ {0, 1, 0, 0, 0x6041, 0x00, off_stat, NULL}, /* 状态字 */ {0, 1, 0, 0, 0x6064, 0x00, off_apos, NULL}, /* 实际位置 */ {0, 1, 0, 0, 0x606C, 0x00, off_vel, NULL}, /* 实际速度 */ {0, 1, 0, 0, 0x6077, 0x00, off_torq, NULL}, /* 实际转矩 */ {} }; int app_init(void) { master ecrt_request_master(0); /* /dev/EtherCAT0 */ if (!master) { fprintf(stderr, request master failed\n); return -1; } domain ecrt_master_create_domain(master); if (!domain) return -1; sc ecrt_master_slave_config(master, 0, 1, VENDOR_ID, PRODUCT_ID); if (!sc) return -1; /* 用 SDO 提前把模式钉死成 8 CSP不要在周期里改 6060 */ ecrt_slave_config_sdo8(sc, 0x6060, 0x00, 8); /* 分布式时钟SYNC0 SYNC1周期 1ms偏移 0 */ ecrt_slave_config_dc(sc, 0x0300, CYCLE_NS, 0, 0, 0); /* 必须在 activate 之前注册 */ if (ecrt_domain_reg_pdo_entry_list(domain, domain_regs)) return -1; if (ecrt_master_activate(master)) return -1; /* activate 之后指针才有效 */ domain_pd ecrt_domain_data(domain); return domain_pd ? 0 : -1; }顺序上的三个硬约束ecrt_master_slave_config的第二个参数是 alias第三个参数是 position。从站没配别名时 alias 填 0用 position 定位position 从 0 开始数和ethercat slaves输出里的编号一致。两者都填不对返回的就是空指针。ecrt_domain_reg_pdo_entry_list必须在ecrt_master_activate之前调用。反过来做映射不会生效off_apos会一直是 0。ecrt_domain_data必须在activate之后调用之前调拿到的是野指针写进去直接段错误。4.2 实时循环里的收发顺序receive → process → queue → sendwhile (running) { ecrt_master_receive(master); /* 1. 取回上一周期发出的帧 */ ecrt_domain_process(domain); /* 2. 标记哪些 PDO 条目本周期有效 */ /* 3. 先读反馈再算输出 */ uint16_t status EC_READ_U16(domain_pd off_stat); int32_t apos EC_READ_S32(domain_pd off_apos); uint16_t ctrl cia402_step(status); int32_t tpos next_setpoint(); EC_WRITE_U16(domain_pd off_ctrl, ctrl); EC_WRITE_S32(domain_pd off_tpos, tpos); /* 4. 配了 DC 才需要这两行没配就删掉 */ ecrt_master_application_time(master, app_time_ns()); ecrt_master_sync_reference_clock(master); ecrt_domain_queue(domain); /* 5. 把待发数据挂到 domain 上 */ ecrt_master_send(master); /* 6. 发出去 */ wait_next_period(); /* 7. 等下一周期 */ }几个容易误解的点ecrt_domain_process不负责取数据。它做的是刷新 domain 内部的有效标志位告诉上层哪些 PDO 条目在这个周期真正更新了。不调它EC_READ_*读到的可能是上一周期甚至更早的陈旧值而且不会报错只会让你怀疑是不是编码器坏了。EC_READ_S32和EC_WRITE_U16是带字节序处理的内联函数。在小端机器上直接memcpy也能跑通换到别的架构上就是数据全乱所以不要图省事手写指针强转。最后那行wait_next_period是整个系统的命门。普通内核上用clock_nanosleep(CLOCK_MONOTONIC, TIMER_ABSTIME, ...)Xenomai 上用rt_task_wait_period。用usleep的话累计误差会随着运行时间线性增大跑十分钟就能看到周期从 1ms 漂到 1.1ms。4.3 伺服使能6040/6041 状态字与 CSP 模式的进入条件CiA402 的使能是一套等级森严的状态机跳级直接被拒。状态字 0x6041 的关键位状态字低字节状态含义下一步该写什么0x08故障0x0080 复位0x40上电默认禁止合闸0x0006 Shutdown0x21待机可以合主回路0x0007 Switch on0x23主回路已合未使能0x000F Enable operation0x27运行使能接受位置指令0x000F 保持对应的控制字 0x6040 就这几个值在轮流0x06、0x07、0x0F、0x80。写成函数/* 根据状态字推下一步控制字按 6 → 7 → F 爬 */ static uint16_t cia402_step(uint16_t status) { if (status 0x0008) return 0x0080; /* 故障优先复位 */ switch (status 0x006F) { case 0x0040: return 0x0006; /* shutdown */ case 0x0021: return 0x0007; /* switch on */ case 0x0023: return 0x000F; /* enable op */ case 0x0027: return 0x000F; /* 已使能保持 */ default: return 0x0006; /* 未知态回到头 */ } }这段代码的边界要清楚它是按标准 CiA402 写的实际驱动器的状态字掩码可能略有差异掩码 0x006F 里的位组合要先拿ethercat upload 1 0x6041 0对着看一遍再定。模式这块0x6060 设为 8 是 CSP循环同步位置9 是 CSV10 是 CST。六轴机械臂插补一般用 CSP。关键经验模式最好用 SDO 在 PREOP 阶段写好不要在运行中动态改 0x6060。有的驱动器切模式会短暂退出使能态位置环断一拍末端抖一下——肉眼看不见但在精密场合就是一次废件。4.4 分布式时钟让六轴在同一微秒上采样DC 的作用是让所有从站用同一个时间基准。不配的话各从站按各自晶振采样六个轴之间存在几十微秒的相位差。单轴调试完全无感六轴跑圆弧时末端点位就对不上误差随速度线性放大。配置侧就一行/* SYNC0 SYNC1周期 1ms偏移 0参考时钟选第一个从站 */ ecrt_slave_config_dc(sc, 0x0300, CYCLE_NS, 0, 0, 0);六个轴每个都要调一次。第一个参数里的0x0300意思是同时激活 SYNC0 和 SYNC1 信号第二个参数是同步周期必须和你的循环周期一致写成 999999 ns 或者 1000001 ns主站在 SAFEOP→OP 检查时就会超时。运行侧每周期两行ecrt_master_application_time(master, app_time_ns()); ecrt_master_sync_reference_clock(master);app_time_ns取的是单调时钟且必须是绝对时间不能用相对时间。主站会拿这个值去算偏移并写进从站的 0x0910/0x0918 寄存器。写错时间基准从站的时间会一路漂走ethercat dc里看到的偏移量会从几微秒涨到几十毫秒然后所有从站集体退出 OP。如果六轴里有一个从站不支持 DC或者你不打算用 DC那就把上面两行和ecrt_slave_config_dc一起删掉不要在配了一半的状态下跑。半个 DC 比没有 DC 更麻烦主站会等一个永远不会来的同步信号。5. 排查实录五个把我卡到凌晨的现象与各自的原因5.1 扫不到从站ethercat slaves一片空白现象ethercat master显示Link downethercat slaves什么都不输出从站面板上 RUN/ERR 灯常亮红灯。原因排下来通常就四条绑错网卡多网口机器最常见main_devices填了一个实际接线在另一个口网卡还在被 NetworkManager 管着原始帧被协议栈截走从站 IN/OUT 口接反主站出去的线插到了环形拓扑的 OUT 口网线是自己压的1/2 和 3/6 线对没按标准走。解决先ethercat master核对 MAC 是不是实际接线的那块口ip addr show确认该口没有 IPethtool iface看 Link detected 是不是 yes拓扑上主站永远接第一个从站的 IN最后一个从站的 OUT 空着或回到主站做冗余。这四条依次排除还没通就换一根成品线自己压的线在新方案里出问题的概率比想象中高得多。5.2 卡在 PREOP 上不去 SAFEOP现象ethercat slaves里状态显示PREOP等一分钟也不动主站日志里只有状态迁移超时。原因ecrt_master_slave_config里的厂商 ID 和产品码填错了主站找不到对应的配置自然不会推它或者 SM2/SM3 没配上过程数据PDO 映射为空再或者从站换过固件但 ESI 文件没更新主站按旧描述下发的配置被拒。解决ethercat slaves里能看到厂商 ID 和产品码逐位核对代码里的宏定义差一位都不行ethercat pdos看该从站下有没有 PDO 条目空的话说明ecrt_slave_config_pdos没生效或者没调ethercat sdos读 0x1C12 和 0x1C13看同步管理器分配是否为空。这三步走完还没好去读从站的错误寄存器 0x0134能拿到具体的拒绝原因码。5.3 周期抖动大伺服报跟随误差或位置偏差过大现象空跑没事带载跑几分钟就停驱动器面板显示 F 类故障读 0x603F 拿到一个错误码。原因没上实时补丁printf、malloc这类调用把周期撑开了或者用了usleep这类相对时间等待误差累积再或者循环里做了文件写入、日志打印这种不可预测耗时的操作。解决切 RT-Preempt 或 Xenomai等待改成绝对时间把日志改成写环形缓冲区主循环退出后再统一打印。有个很具体的经验值——一个printf能把 1ms 周期干到 3ms 以上两个就能干到 10ms。另外malloc在实时上下文里可能触发页错误所有缓冲区在初始化阶段本文还有配套的精品资源点击获取