工业网关 EtherCAT 主站（SOEM）在实时 Linux 平台上的运动控制实战

在多轴工业机器人、高精度数控机床（CNC）以及半导体封装设备中，EtherCAT（以太网控制自动化技术 / IEC 61158） 是目前全球工业现场实时性最高、抖动最低的工业以太网现场总线之一。

在 EtherCAT 网络中，主站（Master）通常通过标准的以太网物理网口连接多个从站伺服驱动器（Slaves / 如汇川、松下、倍福伺服）。
主站必须以 $1000\text{Hz}$（周期严格为 $1000\mu\text{s} = 1\text{ms}$）甚至更高的频率，周期性地向网线发送过程数据对象（PDO, Process Data Object），同步刷新所有电机的目标位置与速度指令。

然而，如果直接在标准通用 Linux 系统（如 Ubuntu / Debian 默认内核）上运行 EtherCAT 开源主站协议栈 SOEM（Simple Open EtherCAT Master）：

• 由于 Linux 内核默认采用完全公平调度器（CFS），且内核内部存在大量不可抢占的大锁临界区；
• 运行期不可避免地会发生数十毫秒的调度卡顿与时钟抖动（Jitter 高达 $20\text{ms} \sim 50\text{ms}$）；
• 导致从站伺服驱动器因连续多个周期未收到同步时钟报文，瞬间触发 “Sync0 同步信号丢失（AL Status 0x001A: Synchronization Lost）” 硬件报警并紧急停机抱闸！

构建一套基于“Linux PREEMPT_RT 硬实时补丁内核”、“开源 SOEM 主站状态机” 与 “CIA 402 伺服轴周期同步位置控制模式（CSP Mode）” 的工业运动控制系统，能够在四核 ARM 嵌入式网关上实现 周期 $1\text{ms}$ 时钟抖动 $< 15\mu\text{s}$ 的高确定性硬实时多轴同步控制。

EtherCAT 实时主站控制微观拓扑

实时 Linux EtherCAT 主站与从站物理拓扑：

【用户空间硬实时控制线程 (Master Application)】
  - 调度策略: SCHED_FIFO (实时优先级 99，绑定 CPU Core 3)
  - 物理内存锁定: mlockall(MCL_CURRENT | MCL_FUTURE) (消灭缺页异常)
  - 高精度定时器: clock_nanosleep(CLOCK_MONOTONIC, TIMER_ABSTIME)
       │ (严格每 1000.000 μs 唤醒一次！)
       ▼
+=========================================================================+
| 【SOEM 协议栈引擎 (Simple Open EtherCAT Master)】                       |
|   - 组装本周期全网过程数据帧 (TxPDO: 目标位置, 控制字)                  |
|   - 硬件 raw socket / 绕过通用 TCP/IP 协议栈直通网卡底层！               |
+=========================================================================+
       │
       ▼ (以太网广播数据帧直通网线)
+=========================================================================+
| 【从站伺服驱动器菊花链 (Slave Servo Drives Daisy-Chain)】                |
|   [ 从站 1: X 轴伺服 (CiA402) ] ──► [ 从站 2: Y 轴伺服 ] ──► [ 从站 3: Z 轴伺服 ]|
|   - 物理机理: 数据帧在流经每个从站芯片 (ESC) 时【在纳秒级时间内“飞掠式 (On-The-Fly)”写入读取！】|
+=========================================================================+

PREEMPT_RT 实时线程构建四大黄金铁律

在编写 SOEM 实时周期主循环时，必须遵循以下不可违背的底层规则：

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <time.h>
#include <sched.h>
#include <sys/mman.h>
#include <pthread.h>
#include "ethercat.h"

#define PERIOD_NS 1000000 // 周期: 1ms (1,000,000 ns)

// 1. 线程硬实时特权初始化 (降延迟核心防线！)
void Setup_Hard_Realtime_Thread(void) {
    // a. 锁定当前及未来所有虚拟内存到物理 RAM，绝对消灭运行时的缺页异常 (Page Fault)！
    if (mlockall(MCL_CURRENT | MCL_FUTURE) == -1) {
        perror("mlockall failed");
        exit(1);
    }

    // b. 线程优先级设置为 99 (Linux 最高硬实时优先级)，调度策略设为 SCHED_FIFO
    struct sched_param param;
    param.sched_priority = 99;
    if (sched_setscheduler(0, SCHED_FIFO, &param) == -1) {
        perror("sched_setscheduler failed");
        exit(1);
    }

    // c. 将当前实时线程硬绑定到隔离 CPU 核心 (如 Core 3)
    cpu_set_t cpuset;
    CPU_ZERO(&cpuset);
    CPU_SET(3, &cpuset);
    pthread_setaffinity_np(pthread_self(), sizeof(cpu_set_t), &cpuset);
}

CiA 402 周期同步位置模式（CSP Mode）状态机与 C 源码实战

伺服驱动器在进入运动控制前，必须通过 EtherCAT PDO 将状态机从 Switch On Disabled 推进到 Operation Enabled：

// CiA 402 核心控制字与状态字掩码
#define CONTROL_WORD_SWITCH_ON_ENABLE 0x000F // 伺服使能运行
#define STATUS_WORD_OPERATION_ENABLED 0x0237

// 伺服电机 TxPDO (主站下发) 结构体
typedef struct __attribute__((packed)) {
    uint16_t control_word;      // CiA 402 控制字 (0x6040)
    int32_t  target_position;   // 目标位置 (0x607A)
    int8_t   modes_of_operation;// 运行模式 (0x6060: 8 代表 CSP 模式)
} Servo_TxPDO_t;

// 伺服电机 RxPDO (从站反馈) 结构体
typedef struct __attribute__((packed)) {
    uint16_t status_word;       // CiA 402 状态字 (0x6041)
    int32_t  actual_position;   // 实际当前编码器位置 (0x6064)
} Servo_RxPDO_t;

void* EthercatMasterThread(void* arg) {
    Setup_Hard_Realtime_Thread();

    // 1. 初始化以太网物理网口 (如 eth0) 并探测从站
    if (ec_init("eth0") <= 0) {
        pr_err("[SOEM] No EtherCAT slaves found!\n");
        return NULL;
    }

    // 配置 IO 映射并将从站状态机推进到 SAFE_OP 状态
    ec_config_init(FALSE);
    ec_config_map(&IOmap);
    ec_statecheck(0, EC_STATE_SAFE_OP, EC_TIMEOUTSTATE);

    // 将所有从站推进到 OPERATION 正常运行态 (OP Mode)
    ec_slave[0].state = EC_STATE_OPERATIONAL;
    ec_writestate(0);
    ec_statecheck(0, EC_STATE_OPERATIONAL, EC_TIMEOUTSTATE);

    pr_info("[SOEM] Slaves entered OPERATIONAL state! Launching 1ms motion loop...\n");

    struct timespec next_period;
    clock_gettime(CLOCK_MONOTONIC, &next_period);

    int32_t motion_pos = 0;

    // 2. 1ms 硬实时绝对时间周期控制大循环
    while (1) {
        // 核心原语: 绝对纳秒级睡眠，彻底杜绝相对延时的误差累加！
        next_period.tv_nsec += PERIOD_NS;
        if (next_period.tv_nsec >= 1000000000) {
            next_period.tv_nsec -= 1000000000;
            next_period.tv_sec += 1;
        }
        clock_nanosleep(CLOCK_MONOTONIC, TIMER_ABSTIME, &next_period, NULL);

        // a. 接收上一周期从站反馈的 RxPDO
        ec_receive_processdata(EC_TIMEOUTRET);

        // 获取第一个从站的 PDO 映射指针
        Servo_TxPDO_t* tx_pdo = (Servo_TxPDO_t*)ec_slave[1].outputs;
        Servo_RxPDO_t* rx_pdo = (Servo_RxPDO_t*)ec_slave[1].inputs;

        // b. 推进 CiA 402 状态机并计算目标轨迹 (例如正弦轨迹插补)
        tx_pdo->control_word = CONTROL_WORD_SWITCH_ON_ENABLE;
        tx_pdo->modes_of_operation = 8; // CSP 周期同步位置模式
        
        motion_pos += 100; // 每毫秒前进 100 个脉冲
        tx_pdo->target_position = motion_pos;

        // c. 发送本周期的 TxPDO 到物理以太网线！
        ec_send_processdata();
    }

    ec_close();
    return NULL;
}

工业实测性能对战

在四核 ARM Cortex-A55 嵌入式工控板卡上，针对 4 个伺服从站连续运行 48 小时（累计执行超过 1.7 亿次 1ms 周期通信）进行实时抖动严密监测：

通过 PREEMPT_RT 实时内核改造、内存物理锁定与 SCHED_FIFO 核心隔离，SOEM EtherCAT 主站在嵌入式 Linux 平台上展现出了媲美专用硬实时 PLC 的微秒级确定性控制品质。