周期抖動2μs！RK3576的IgH EtherCAT工業級主站方案很厲害

在工業自動化領域，如何在通用Linux系統上實現微秒級的硬實時控制，一直是機器人、多軸運動控制等高精度場景落地的關鍵挑戰。開源的IgH EtherCAT Master協議棧，憑借其卓越的高實時性與低抖動特性，成為了連接工業現場總線與上層應用的核心橋梁。然而，要釋放其全部潛能，離不開Preempt-RT實時內核的強力加持。

本文將基于飛凌嵌入式OK3576-C開發板，通過1ms周期同步速度模式與125μs周期同步轉矩模式的實測對比，展示在CPU隔離核與滿負載壓力下，系統如何將通訊抖動控制在微秒級，為您呈現一套可落地的高性能實時工業控制完整方案。

先說結論，表現很強悍！

周期同步速度模式，周期抖動由6.3080μs降低為3.5790μs；

周期同步轉矩模式，周期抖動由50.0470μs降低為2.1130μs！

1、IgH EtherCAT Master是什么？

在解答這個問題之前，先來看一下什么是EtherCAT ？EtherCAT是發展最快的工業以太網協議之一，采用硬件驅動型架構，具有速度快、傳輸數據量大、傳輸距離長、更新周期小、連接設備數量多等多重優勢。

IgH EtherCAT則是運行于Linux系統的開源EtherCAT主站程序，IgH EtherCAT主站通過構建Linux字符設備，應用程序通過對字符設備的訪問實現與EtherCAT主站模塊的通信。

它主要包括以下三部分：

1. Master Module

角色：EtherCAT 主站的“大腦”和內核。

功能：負責管理 EtherCAT 總線通信，實現主站與從站間的數據交換與同步。它包含主站實例及供底層驅動和上層應用調用的接口。

2. Device Modules

角色：經過實時性優化的“網卡驅動”（如瑞芯微RK平臺的 stmmac）。

功能：作為主站與物理網口的橋梁。它能智能分流：被主站選中的設備用于收發 EtherCAT 幀；未被選中的設備則作為普通以太網設備走常規協議棧，實現 EtherCAT 與普通網絡的并行工作。

3. Application

角色：業務邏輯的執行者（用戶編寫或生成）。

功能：通過應用接口向主站申請總線控制權。一旦獲準，即可配置總線并進行周期性的過程數據交換。應用程序既可以是內核模塊，也可以是通過庫（EtherCAT/RTDM）調用的用戶空間程序。

評論區留言【資料】，即可獲得IgH EtherCAT Master官方源碼及技術手冊的下載方式。

2、實時內核Preempt-RT

1. 獨具優勢：

IgH EtherCAT Master要保證高實時性，需要在實時操作系統上運行。Preempt-RT是一種針對實時性能進行了優化的Linux內核，與普通的Linux內核相比，Preempt-RT的優勢很明顯：

① 硬實時保障：

具備硬實時能力，能確保關鍵任務在嚴格規定的時限內完成，不受其他任務干擾，滿足工業自動化、航空航天等對時間精度極高的場景需求。

② 高效調度與低延遲：

采用基于優先級的搶占式調度算法，高優先級任務可立即搶占低優先級任務；同時深度優化中斷處理機制，大幅縮短響應時間，消除系統抖動。

③ 高精度定時：

提供微秒級的內核定時器精度，配合實時擴展機制，支持用戶對內核進行定制，精準滿足EtherCAT通信的周期性數據交換需求。

2. 實時性測試

本次測試參考Rockchip RealTime Linux Performance Test Report，分為空載測試和壓力測試。測試的環境如下：

① 工具：cyclictest

② 硬件平臺：OK3576-C開發板

③ 內核版本：6.1.118-rt36

④ Path：SDK/docs/rk35xx/Patches/Real-Time-Performance/PREEMPT_RT/kernel-6.1/kernel-6.1.118

a. 配置Preempt-RT內核，可以參考用戶資料：/1-手冊/OK35xx-Linux6.1.118-配置實時內核方法.pdf

b. 不同硬件平臺的實時性測試結果，可以參考用戶資料：/1-手冊/OK35xx-Linux6.1.118-實時性測試.pdf

空載測試：

cyclictest -c 0 -m -t 8 -p99 -D12H

參數介紹：

• -c 0：選擇時鐘源為CLOCK_MONOTONIC
• -m：鎖定內存，防止內存頁交換到磁盤
• -t 8：創建8個測試線程
• -p 99：設置線程的優先級為99
• -D 12h：設置測試持續時間為12h

壓力測試：

stress-ng -c8 --io 8 --cpu-load 100 -vm 4 --vm-bytes 512M --timeout 10000000s &

參數介紹：

• -c 8：模擬8個CPU邏輯核心滿負荷運行
• --io 8：模擬磁盤I/O壓力
• --cpu-load 100：設定 CPU 的目標負載為 100%
• --vm 4 --vm-bytes 512M：模擬內存壓力
• --timeout 10000000s：設置測試持續時間為10000000秒

3、演示案例

本節的演示選取周期同步速度模式（通訊周期時間為1ms）與周期同步轉矩模式（通訊周期時間為125μs）驅動伺服電機轉動。

1. 環境介紹

開發環境：

• Kernel：6.1.118-rt36
• IgH EtherCAT Master：IgH EtherCAT master 1.6.0-rc1
• EtherCAT主站：OK3576-C
• EtherCAT從站：
• （1）EtherCAT耦合器EK1100
• （2）數字量輸出模塊EL2008
• （3）伺服驅動器IS620NS1R6I + 伺服電機MS1H1-10B30CB A330Z

拓撲結構圖：

主站通過網線連接EtherCAT耦合器EK1100，EK1100通過E-Bus連接數字量輸出模塊EL2008、通過網線連接伺服驅動器IS620N，交流伺服電機MS1H1-10B30CB通過動力線和編碼線與伺服驅動器IS620N相連。

使用EtherCat調試工具輸出識別到的從站：

使用EtherCat調試工具輸出總線拓撲：

2. 伺服模式

IS620N 支持 7 種伺服模式，分別為輪廓位置模式（PP）、輪廓速度模式（PV）、輪廓轉矩模式（PT）、回零模式（HM）、周期同步位置模式（CSP）、周期同步速度模式（CSV）、周期同步轉矩模式（CST）。

不同模式支持的通訊周期不同，如下所示：

3. 主站性能測試方法

以下定義參考：Definitions of Jitter and Latency

參考官方示例代碼：

examples/dc_user/main.c · stable-1.5 · EtherLab / EtherCAT Master · GitLab

里面有實現統計一個通訊周期的所花費的最大值和最小值。以1s為周期循環打印該區間EtherCAT通訊周期時間的最大值和最小值。

演示一：周期同步速度模式(1ms)

周期同步速度模式下，上位控制器將計算好的目標速度 60FF 周期性同步發送給伺服驅動器，速度、轉矩調節由伺服內部執行。

基本配置：

使用EtherCat調試工具輸出的pdo信息：

操作步驟：

步驟1：設定模式，OD 6060h = 09h，周期同步速度模式。

步驟2：設定目標速度，OD 60FFh = 0。由于速度模式下，一旦切至 Servo On (步驟 3)，伺服電機就會開始運轉，因此設定 0 是確保在 Servo On 時先保持 0 rpm 而不作動。

步驟3：設定控制指令 OD 6040h，請依照以下步驟操作。步驟 3.1 與 3.2 是為了使驅動器的狀態機 (state machine) 進入準備狀態。

步驟4：設定目標速度 OD 60FFh。

性能指標：

① 壓力測試（6h）

stress -c 4 --io 2 --vm 1 --vm-bytes 256M --timeout 1000000s&

./igh_ethercat_motor_csv

② 隔離測試+隔離核（6h）

stress -c 4 --io 2 --vm 1 --vm-bytes 256M --timeout 1000000s &

taskset -c 7 ./igh_ethercat_motor_csv

演示二：周期同步轉矩模式(125μs)

此模式下，上位控制器將計算好的目標轉矩 6071h 周期性同步的發送給伺服驅動器，轉矩調節由伺服內部執行。當速度達到限幅值后將進入調速階段。

基本配置：

使用EtherCat調試工具輸出的pdo信息：

操作步驟：

步驟1：設定模式，OD 6060h = 0Ah，周期同步轉矩模式。

步驟2：設定目標扭矩，OD 6071h = 0。由于扭矩模式下，一旦切至Servo On (步驟 3)，伺服目標扭矩即作用，因此先設定 0，以確保安全。

步驟3：設定控制指令，OD 6040h，請依照以下步驟操作。步驟 3.1 與 3.2 是為了使驅動器的狀態機 (state machine) 進入準備狀態。

步驟4：設定目標扭矩 OD 6071h。

性能指標：

① 壓力測試（6h）

stress -c 4 --io 2 --vm 1 --vm-bytes 256M --timeout 1000000s&

./igh_ethercat_motor_cst

② 壓力測試+隔離核（6h）

stress -c 4 --io 2 --vm 1 --vm-bytes 256M --timeout 1000000s &

taskset -c 7 ./igh_ethercat_motor_cst

以上測試對未及時收回來的數據幀時統計的周期樣本進行剔除，在跑125μs周期，幀未及時收回來的情況會更加頻繁。

兩種演示的性能測試，應用程序都采用FIFO調度+內存鎖定；在采取隔離核策略時，系統的周期抖動降低。

• 周期同步速度模式，周期抖動由6.3080μs降低為3.5790μs。
• 周期同步轉矩模式，周期抖動由50.0470μs降低為2.1130μs。

方案展示：