現(xiàn)EtherCAT主站：從編譯到運(yùn)動(dòng)控制實(shí)戰(zhàn))
1. 為什么是QT加SOEM一個(gè)老牌主站庫(kù)的二次生命力做嵌入式上位機(jī)開發(fā)這些年我踩過不少協(xié)議棧的坑最后在EtherCAT主站這個(gè)方向上SOEMSimple Open EtherCAT Master是我目前最推薦用來搭配QT做上位機(jī)的一套組合。原因很簡(jiǎn)單SOEM是開源庫(kù)代碼量適中移植性極強(qiáng)而且它不依賴Linux內(nèi)核補(bǔ)丁——這意味著你可以輕松地在Windows、Linux、甚至RTOS上跑起來而QT恰好又是跨平臺(tái)界面開發(fā)的首選兩者配合起來幾乎是無縫銜接。先說一個(gè)很多人容易混淆的點(diǎn)EtherCAT主站協(xié)議棧和從站協(xié)議棧完全是兩碼事。從站一般由從站控制器ESC硬件來完成比如LAN9252、AX58100這類芯片芯片出廠就固化了EtherCAT從站協(xié)議的處理邏輯你不用去碰協(xié)議棧的底層。而主站這邊就不一樣了主站的任務(wù)是生成報(bào)文、管理從站狀態(tài)機(jī)、處理分布式時(shí)鐘、維護(hù)過程數(shù)據(jù)映射這些邏輯全部要跑在CPU上所以主站的“協(xié)議?！焙脡闹苯記Q定了整個(gè)運(yùn)動(dòng)控制系統(tǒng)的實(shí)時(shí)性和穩(wěn)定性。SOEM最初是由德國(guó)的一家自動(dòng)化公司貢獻(xiàn)給開源社區(qū)的后來被納入了IgH的生態(tài)體系?？赡苡腥藭?huì)問既然IgHEtherLab那么有名為什么不去用IgH我的實(shí)測(cè)體會(huì)是IgH功能雖然全但它是基于Linux內(nèi)核模塊實(shí)現(xiàn)的驅(qū)動(dòng)模型復(fù)雜編譯和加載都要在內(nèi)核態(tài)完成而且每次內(nèi)核升級(jí)都要重新編譯這對(duì)很多做產(chǎn)品的人來說是件很頭疼的事情。SOEM則完全是用戶態(tài)的庫(kù)API簡(jiǎn)潔編譯出來就是一個(gè)靜態(tài)庫(kù)或者動(dòng)態(tài)庫(kù)QT工程里直接引用就行開發(fā)效率高得多。還有一點(diǎn)很關(guān)鍵SOEM對(duì)嵌入式平臺(tái)的適配相當(dāng)好。我試過STM32MP1、i.MX8M Plus、瑞薩RZ/G2L這些平臺(tái)SOEM都能很好地跑起來。對(duì)于需要做HMI人機(jī)界面的項(xiàng)目比如點(diǎn)膠機(jī)、貼片機(jī)、機(jī)器人控制柜QT畫界面SOEM跑實(shí)時(shí)通信這套架構(gòu)在生產(chǎn)線上已經(jīng)經(jīng)過了大量驗(yàn)證。這篇文章我就從頭到尾梳理一遍從庫(kù)的編譯到QT工程的集成再到實(shí)際應(yīng)用中的關(guān)鍵細(xì)節(jié)和踩坑記錄幫助大家少走彎路。2. SOEM主站協(xié)議庫(kù)的架構(gòu)與核心機(jī)制2.1 主站協(xié)議棧的分層思想理解SOEM之前先得理解EtherCAT主站協(xié)議棧的層次劃分。EtherCAT的通信模型其實(shí)很簡(jiǎn)潔主站發(fā)送一個(gè)以太網(wǎng)幀幀里面串聯(lián)了所有從站的數(shù)據(jù)每個(gè)從站從幀中提取自己的輸出數(shù)據(jù)同時(shí)把輸入數(shù)據(jù)插入到幀的相應(yīng)位置然后幀繼續(xù)傳給下一個(gè)從站。整個(gè)過程是“飛讀飛寫”也就是所謂的過程數(shù)據(jù)Process Data交換。SOEM的核心代碼主要分為這幾個(gè)層次底層套接字層負(fù)責(zé)原始以太網(wǎng)幀的收發(fā)在Linux下走的是AF_PACKET協(xié)議族在Windows下走的是WinPcap/Npcap庫(kù)這一層是平臺(tái)相關(guān)的。鏈路層抽象SOEM通過ecx_setup系列函數(shù)來初始化網(wǎng)卡和從站掃描真正把以太網(wǎng)幀封裝成EtherCAT報(bào)文。應(yīng)用層接口這一層是我們最常碰到的包括狀態(tài)機(jī)管理郵箱通信、狀態(tài)轉(zhuǎn)換、過程數(shù)據(jù)映射、分布式時(shí)鐘等。在SOEM中有一個(gè)全局的結(jié)構(gòu)體ecx_context它把整個(gè)主站運(yùn)行狀態(tài)都封裝在里面。對(duì)于多線程應(yīng)用SOEM允許你創(chuàng)建多個(gè)ecx_context實(shí)例從而實(shí)現(xiàn)多主站并行——比如一個(gè)主站控制關(guān)節(jié)伺服另一個(gè)主站控制IO模塊這在復(fù)雜機(jī)器人系統(tǒng)里非常實(shí)用。2.2 SOEM與IGH的定位差異很多人一上來就會(huì)問SOEM和IGH到底選哪個(gè)我個(gè)人的結(jié)論是如果追求絕對(duì)最高的實(shí)時(shí)性并且團(tuán)隊(duì)有Linux內(nèi)核開發(fā)能力項(xiàng)目周期長(zhǎng)那IGH確實(shí)可以做得很極致。如果追求快速落地、跨平臺(tái)、嵌入式友好尤其是要搭配QT做上位機(jī)/觸控屏那么SOEM絕對(duì)是性價(jià)比最高的選擇。IGH把主站做成內(nèi)核模塊實(shí)時(shí)性確實(shí)是用戶態(tài)方案比不了的但付出的代價(jià)是調(diào)試?yán)щy、移植麻煩、GUI集成費(fèi)勁。SOEM走的是用戶態(tài)雖然實(shí)時(shí)性上限略低但通過配合PREEMPT_RT補(bǔ)丁或者綁定CPU核心CPU Affinity在百微秒級(jí)別的周期控制中完全夠用。對(duì)于絕大多數(shù)使用EtherCAT的場(chǎng)景——伺服周期1ms、4ms、甚至8ms都常見——SOEM的性能毫無壓力。2.3 狀態(tài)機(jī)與通信流程EtherCAT通信的核心是狀態(tài)機(jī)從站設(shè)備在上電之后要依次經(jīng)過Init、Pre-Operational、Safe-Operational、Operational四個(gè)狀態(tài)主站負(fù)責(zé)驅(qū)動(dòng)這些狀態(tài)轉(zhuǎn)換。SOEM的API封裝了這些狀態(tài)轉(zhuǎn)換ec_statechange檢查狀態(tài)變化ec_writestate讓從站切換到目標(biāo)狀態(tài)ec_readstate讀取所有從站的當(dāng)前狀態(tài)每一個(gè)狀態(tài)都有各自允許的通信服務(wù)Init只能進(jìn)行寄存器讀寫用來獲取從站信息。Pre-Op郵箱通信開啟可以配置PDO映射、加載Coe對(duì)象字典。Safe-Op過程數(shù)據(jù)開始刷新但此時(shí)從站不輸出只處理輸入。Op完全運(yùn)行狀態(tài)輸出有效伺服使能。我在調(diào)試時(shí)習(xí)慣寫一個(gè)狀態(tài)機(jī)等待函數(shù)在切換狀態(tài)之后輪詢所有從站是否都到了預(yù)期狀態(tài)如果超時(shí)就把錯(cuò)誤寄存器讀出來這樣能快速定位從站配置的問題。3. 從零開始編譯SOEM庫(kù)3.1 源碼準(zhǔn)備與CMake構(gòu)建SOEM的源碼托管在GitHub上倉(cāng)庫(kù)地址是OpenEtherCATsociety/SOEM。建議不要直接下載master分支的代碼而是選擇一個(gè)穩(wěn)定的release標(biāo)簽版本目前我常用的是1.4.0版本這個(gè)版本在ARM平臺(tái)和x86平臺(tái)上的測(cè)試都比較充分。源碼下載回來之后解壓到本地目錄SOEM本身采用CMake構(gòu)建系統(tǒng)這也是它能輕松集成到QT工程的前提之一。在Linux平臺(tái)下構(gòu)建過程很簡(jiǎn)單mkdir build cd build cmake .. make sudo make install但這里有幾個(gè)細(xì)節(jié)需要注意。默認(rèn)的CMake配置會(huì)生成動(dòng)態(tài)庫(kù)和示例程序如果你想得到一個(gè)精簡(jiǎn)的靜態(tài)庫(kù)用于嵌入式平臺(tái)可以在cmake時(shí)加上參數(shù)cmake -DBUILD_SHARED_LIBSOFF -DSOEM_BUILD_TESTSOFF -DSOEM_BUILD_EXAMPLESOFF ..這樣得到的就是一個(gè)純凈的libsoem.a靜態(tài)庫(kù)體積很小適合直接丟到嵌入式ARM的交叉編譯工具鏈里面去鏈接。SOEM支持兩種構(gòu)建方式一種是在主機(jī)上編譯然后通過交叉編譯工具鏈重新構(gòu)建另一種是直接把SOEM源碼加入QT工程一并編譯。對(duì)于產(chǎn)品化項(xiàng)目我更推薦后者理由后面細(xì)說。3.2 Windows平臺(tái)上的編譯特殊性Windows平臺(tái)下編譯SOEM會(huì)比Linux多一些步驟。SOEM的底層套接字在Windows上依賴WinPcap或Npcap的SDK原因在于EtherCAT主站需要自己構(gòu)造以太網(wǎng)幀的MAC地址和EtherType0x88A4標(biāo)準(zhǔn)的Windows Socket API是干不了這件事的必須借助Npcap的底層抓包接口。你需要先安裝Npcap并勾選“安裝SDK”的選項(xiàng)然后在CMake配置時(shí)指定Npcap SDK的路徑。如果直接用QT的MinGW工具鏈要特別留意Npcap SDK和MinGW的兼容性。實(shí)測(cè)下來MSVC2019配合Npcap是最穩(wěn)定的組合MinGW環(huán)境下偶爾會(huì)出現(xiàn)頭文件找不到的情況解決辦法是手動(dòng)把Npcap的Include目錄和Lib目錄加進(jìn)工程文件。3.3 引入QT工程的兩種姿勢(shì)把SOEM用到QT工程中主要有兩種方式。第一種是把SOEM編譯成靜態(tài)庫(kù)然后在QT的.pro文件里通過LIBS 來引用。這種方式的優(yōu)點(diǎn)是工程結(jié)構(gòu)清晰QT只負(fù)責(zé)界面和業(yè)務(wù)邏輯SOEM作為獨(dú)立的庫(kù)存在缺點(diǎn)是當(dāng)你想修改SOEM源碼時(shí)需要單獨(dú)編譯庫(kù)。第二種方式是把SOEM的全部源文件soem/目錄下直接加入到QT工程中參與整體編譯。這種方式對(duì)源碼的調(diào)試非常方便打斷點(diǎn)直接就能進(jìn)入SOEM的內(nèi)部函數(shù)對(duì)于想深入學(xué)習(xí)EtherCAT主站協(xié)議的人來說特別有價(jià)值。我自己的項(xiàng)目就采用的第二種方式在.pro文件里添加INCLUDEPATH $$PWD/soem/soem SOURCES \ $$PWD/soem/soem/ethercat.c \ $$PWD/soem/soem/ethercatcoe.c \ $$PWD/soem/soem/ethercatdc.c \ $$PWD/soem/soem/ethercatfoe.c \ $$PWD/soem/soem/ethercatmain.c \ $$PWD/soem/soem/ethercatprint.c \ $$PWD/soem/soem/ethercatsoe.c \ $$PWD/soem/soem/osal/osal.c \ $$PWD/soem/soem/osal/osal_win32.c注意文件列表要根據(jù)平臺(tái)調(diào)整Windows下需要osal_win32.cLinux下則需要osal_linux.c。另外Npcap的依賴也要加進(jìn)去win32 { INCLUDEPATH C:/Program Files/Npcap LIBS -LC:/Program Files/Npcap/Lib -lwpcap -lPacket }直接參與編譯還有一個(gè)好處是可以用上QT的構(gòu)建套件Kit比如你在Qt Creator里配置了交叉編譯套件那么SOEM也會(huì)跟著交叉編譯到目標(biāo)平臺(tái)完全不用手動(dòng)維護(hù)交叉編譯鏈的環(huán)境變量。4. 核心API應(yīng)用實(shí)戰(zhàn)主站掃描、配置與過程數(shù)據(jù)交換4.1 初始化網(wǎng)卡與從站掃描無論多復(fù)雜的EtherCAT系統(tǒng)起步操作都是類似的打開網(wǎng)卡、掃描總線、獲取從站信息。SOEM提供了一個(gè)極其實(shí)用的API以下是典型的初始化流程#include ethercat.h #include QDebug char IOmap[4096]; int slaveCount 0; bool setupEtherCAT(const QString ifname) { // 打開網(wǎng)卡返回套接字句柄 if (ec_init(ifname.toLocal8Bit().data()) 0) { qCritical() Failed to initialize NIC: ifname; return false; } qInfo() NIC initialized: ifname; // 掃描總線上所有從站 slaveCount ec_config_init(FALSE); if (slaveCount 0) { qCritical() No slaves found on the bus.; return false; } qInfo() Total slaves: slaveCount; // 配置過程數(shù)據(jù)映射 int result ec_config_map(IOmap); if (result 0) { qCritical() PDO mapping failed.; return false; } qInfo() PDO mapping done, bytes used: result; // 請(qǐng)求切換到OP狀態(tài) ec_slave[0].state EC_STATE_OPERATIONAL; ec_writestate(0); return true; }這里有幾個(gè)關(guān)鍵點(diǎn)。ec_config_init(TRUE)中的參數(shù)表示是否使用保留地址reserved address進(jìn)行配置一般設(shè)為FALSE即可。掃描完成后總線上的每個(gè)從站信息會(huì)填充到全局?jǐn)?shù)組ec_slave[]中每個(gè)元素的eep_id、eep_man、eep_rev這些字段存儲(chǔ)的就是從站的Vendor ID、Product ID等信息。ec_config_map(IOmap)這個(gè)函數(shù)是理解EtherCAT從站映射的關(guān)鍵它會(huì)為每個(gè)從站計(jì)算PDO的映射關(guān)系返回所有從站輸出和輸入數(shù)據(jù)占用的總字節(jié)數(shù)。IOmap這個(gè)緩沖區(qū)就是你接下來讀寫過程數(shù)據(jù)的“舞臺(tái)”。4.2 理解Vendor ID與從站配置的坑在調(diào)試新從站時(shí)很多人會(huì)遇到一個(gè)“詭異”現(xiàn)象從站明明被掃描到了但狀態(tài)始終切不到OP。這時(shí)大概率是從站的配置信息不完整尤其是FMMU映射出了問題。FMMUFieldbus Memory Management Unit是EtherCAT從站內(nèi)部用來把過程數(shù)據(jù)映射到本地地址的機(jī)制SOEM在ec_config_map時(shí)會(huì)按EEPROM里的配置自動(dòng)設(shè)置但是如果從站的EEPROM沒有燒錄或者配置錯(cuò)誤映射就會(huì)失敗。這時(shí)可以用SOEM提供的工具函數(shù)讀取從站的EEPROM信息qDebug() Slave i Vendor: hex ec_slave[i].eep_man Product: hex ec_slave[i].eep_id Revision: hex ec_slave[i].eep_rev;通常從站出廠時(shí)廠商會(huì)把這些信息寫好。但如果是自己開發(fā)的從站比如基于LAN9252或者AX58100的板子在初次調(diào)試時(shí)就要特別留意很多從站不支持自動(dòng)配置FMMU必須在上位機(jī)中顯式地設(shè)置PDO的映射參數(shù)。這種情況下光靠SOEM的自動(dòng)映射是不夠的你可能需要直接操作ESC寄存器來手動(dòng)配置。一個(gè)我非常推薦的做法是在正式控制邏輯之前先打印所有從站的輸入輸出長(zhǎng)度和映射地址確認(rèn)每個(gè)從站占用的IOmap偏移是否正確for (int i 1; i slaveCount; i) { qDebug() Slave i InputStart: ec_slave[i].Istart OutputStart: ec_slave[i].Ostart InputBits: ec_slave[i].Ibits OutputBits: ec_slave[i].Obits; }這個(gè)過程能幫你發(fā)現(xiàn)在后續(xù)訪問過程數(shù)據(jù)時(shí)該把指針指向哪個(gè)偏移位置尤其是總線上有多個(gè)不同類型的從站時(shí)這一步絕不能省。4.3 過程數(shù)據(jù)的讀寫PDO映射完成之后我們就可以通過IOmap來讀寫數(shù)據(jù)了。SOEM的思想是把所有從站的輸入輸出緊湊排列在一段連續(xù)的內(nèi)存中然后由協(xié)處理器和主站代碼通過指針來操作。為了方便管理我在實(shí)際項(xiàng)目中會(huì)為每個(gè)從站定義一個(gè)結(jié)構(gòu)體再把這些結(jié)構(gòu)體按映射順序重疊到IOmap中。比如常見的伺服驅(qū)動(dòng)器通常使用CiA402協(xié)議控制字Controlword、狀態(tài)字Statusword、目標(biāo)位置Target Position和實(shí)際位置Actual Position這些對(duì)象都是標(biāo)準(zhǔn)化的于是我可以這樣定義typedef struct { uint16_t controlword; int32_t target_position; int32_t target_velocity; uint16_t mode_of_operation; } ServoOutput_t; typedef struct { uint16_t statusword; int32_t actual_position; int32_t actual_velocity; uint16_t mode_of_operation_display; } ServoInput_t; ServoOutput_t* servoOut[16]; ServoInput_t* servoIn[16]; // 在配置完成后按每個(gè)從站的IOmap偏移綁定地址 for (int i 1; i slaveCount; i) { servoOut[i] (ServoOutput_t*)(IOmap ec_slave[i].Ostart); servoIn[i] (ServoInput_t*)(IOmap ec_slave[i].Istart); }這樣綁定之后讀寫過程數(shù)據(jù)就成了結(jié)構(gòu)體成員訪問那么簡(jiǎn)單。比如要讓1號(hào)伺服進(jìn)入位置模式并開始運(yùn)動(dòng)我只需要servoOut[1]-controlword 0x000F; servoOut[1]-mode_of_operation 0x01; // CSP模式 servoOut[1]-target_position 100000; // 單位取決于電子齒輪比然后調(diào)用ec_send_processdata()和ec_receive_processdata(0)把這一幀數(shù)據(jù)發(fā)送出去。這里要特別強(qiáng)調(diào)一個(gè)細(xì)節(jié)SOEM的ec_send_processdata()和ec_receive_processdata(0)必須成對(duì)調(diào)用并且建議在一個(gè)獨(dú)立的實(shí)時(shí)線程中以固定周期循環(huán)調(diào)用。發(fā)送函數(shù)構(gòu)造報(bào)文接收函數(shù)解析從站反饋兩者的間隔通常在幾十微秒以內(nèi)超時(shí)會(huì)返回EC_ERR。為了監(jiān)控通信質(zhì)量我習(xí)慣在接收之后檢查返回值如果在連續(xù)多個(gè)周期內(nèi)返回錯(cuò)誤就觸發(fā)報(bào)警。4.4 從站狀態(tài)切換的狀態(tài)機(jī)封裝從站從啟動(dòng)到進(jìn)入OP狀態(tài)中間要經(jīng)歷多次狀態(tài)切換每一次切換都要給從站留出足夠的時(shí)間去處理郵箱通信和PDO配置。SOEM官方示例中的方式比較初級(jí)只是簡(jiǎn)單地把目標(biāo)狀態(tài)寫進(jìn)ec_slave[0].state然后調(diào)用ec_writestate而實(shí)際項(xiàng)目中每臺(tái)從站的狀態(tài)切換速度不一樣尤其是一些復(fù)雜的伺服驅(qū)動(dòng)器可能需要幾百毫秒才能完成參數(shù)初始化。因此我在QT工程里封裝了一個(gè)帶超時(shí)管理的狀態(tài)切換函數(shù)bool waitForState(int slaveIndex, uint16_t targetState, int timeoutMs) { QElapsedTimer timer; timer.start(); while (timer.elapsed() timeoutMs) { ec_slave[slaveIndex].state targetState; ec_writestate(slaveIndex); // 讀取實(shí)際狀態(tài) ec_readstate(); uint16_t actual ec_slave[slaveIndex].state; // 檢查是否到達(dá)目標(biāo)狀態(tài) if (actual targetState) { return true; } // 如果從站報(bào)錯(cuò)讀取AL狀態(tài)碼 if (actual EC_STATE_ERROR) { uint16_t alStatusCode ec_slave[slaveIndex].ALstatuscode; qWarning() Slave slaveIndex error, AL status code: hex alStatusCode; return false; } QThread::msleep(10); } qWarning() Slave slaveIndex state timeout; return false; }從站無法進(jìn)入OP狀態(tài)時(shí)SOEM會(huì)在ec_slave[i].ALstatuscode中給出具體原因常見的有AL狀態(tài)碼含義處理建議0x0012無效的郵箱配置檢查SMSyncManager配置0x0013無效的PDO映射檢查PDO映射并重新配置0x0014同步錯(cuò)誤檢查DC時(shí)鐘配置0x001E從站本地錯(cuò)誤查看從站手冊(cè)確認(rèn)錯(cuò)誤來源有了這個(gè)等待函數(shù)切OP之前的流程就清晰可查了先切Pre-Op然后寫入PDO映射再切Safe-Op最后切Op。每一層都能驗(yàn)證。5. 分布式時(shí)鐘與同步讓多軸動(dòng)得整齊劃一5.1 為什么需要同步EtherCAT最吸引人的地方之一就是它的分布式時(shí)鐘Distributed Clock簡(jiǎn)稱DC。如果沒有DC同步總線上每個(gè)從站都是按照各自的晶振節(jié)拍來采樣和輸出晶振的頻率誤差雖然不大但累積到一定時(shí)間就會(huì)導(dǎo)致軸與軸之間出現(xiàn)明顯的偏移。在高精度的運(yùn)動(dòng)控制場(chǎng)合這種時(shí)間偏差會(huì)直接表現(xiàn)為軌跡跟隨的抖動(dòng)。DC的原理簡(jiǎn)單來說就是第一個(gè)具有DC功能的從站作為參考時(shí)鐘主站周期性發(fā)送時(shí)鐘同步報(bào)文其他從站讀取參考時(shí)鐘的時(shí)間戳并通過本地時(shí)鐘補(bǔ)償算法來校準(zhǔn)自身的本地時(shí)間。這樣一來所有從站的采樣時(shí)刻就對(duì)齊到了同一個(gè)時(shí)間基準(zhǔn)上。SOEM對(duì)DC的支持很到位在ec_config_map之后只需要調(diào)用以下幾個(gè)函數(shù)就可以完成DC初始化ec_configdc();這個(gè)函數(shù)會(huì)自動(dòng)檢測(cè)從站的DC能力并對(duì)有DC功能的從站進(jìn)行時(shí)鐘同步設(shè)置。如果總線上混合了有DC和無DC的從站SOEM會(huì)以第一個(gè)支持DC的從站的時(shí)鐘作為參考也就是所謂的SYNC0事件由DC0來觸發(fā)。5.2 周期同步與SYNC信號(hào)在實(shí)際項(xiàng)目中伺服驅(qū)動(dòng)器的位置環(huán)、速度環(huán)甚至電流環(huán)都需要依賴從站的SYNC事件來觸發(fā)。SYNC事件是DC時(shí)鐘在到達(dá)預(yù)設(shè)時(shí)刻時(shí)生成的硬件中斷信號(hào)驅(qū)動(dòng)內(nèi)部的數(shù)字信號(hào)處理器DSP會(huì)響應(yīng)這個(gè)中斷進(jìn)行采樣和計(jì)算。也就是說周期控制的精度直接取決于DC同步鏈路的質(zhì)量和SYNC信號(hào)周期的設(shè)置。在SOEM中可以通過ec_dcsync0來設(shè)置SYNC0的周期和偏移// slaveIndex為參考從站索引 // cycleTimeNs為周期時(shí)間單位是納秒 // shiftTimeNs為偏移時(shí)間 ec_dcsync0(slaveIndex, TRUE, cycleTimeNs, shiftTimeNs);例如對(duì)于1ms的控制周期ec_dcsync0(1, TRUE, 1000000, 0);這里有一個(gè)心得SYNC0的偏移時(shí)間不要一律設(shè)置為0。在總線上有多個(gè)從站時(shí)如果所有從站都在同一個(gè)時(shí)間點(diǎn)觸發(fā)SYNC可能會(huì)造成總線上瞬時(shí)電流峰值過大尤其在伺服驅(qū)動(dòng)器的使能瞬間。通常我會(huì)把偏移時(shí)間錯(cuò)開幾十微秒讓各驅(qū)動(dòng)器的采樣點(diǎn)稍微錯(cuò)開能有效減少總線上的干擾。5.3 DC同步誤差的觀察與調(diào)優(yōu)怎么判斷DC同步是否正常一個(gè)可行的辦法是循環(huán)讀取參考從站的時(shí)鐘時(shí)間戳和本地從站的系統(tǒng)時(shí)間計(jì)算時(shí)間偏差。SOEM提供了ec_dcreg相關(guān)的寄存器讀取函數(shù)可以讀取從站的0x092CSystem Time寄存器和0x0920Receive Time寄存器實(shí)時(shí)打印偏差。我在調(diào)試時(shí)發(fā)現(xiàn)當(dāng)DC同步正常時(shí)時(shí)間偏差一般能穩(wěn)定在幾百納秒以內(nèi)如果偏差出現(xiàn)毫秒級(jí)的漂移那就要檢查參考時(shí)鐘從站的選擇是否正確或者從站之間的線纜連接是不是接觸不良。還有一點(diǎn)容易被忽略如果總線上有非DC能力的從站它的報(bào)文轉(zhuǎn)發(fā)延遲會(huì)對(duì)DC同步產(chǎn)生可見的影響這種情況下盡量把DC參考點(diǎn)設(shè)在離主站最近的DC從站上或者調(diào)整DC偏移參數(shù)來補(bǔ)償。同步是所有運(yùn)動(dòng)控制系統(tǒng)的生命線SOEM在這塊已經(jīng)封裝得很好但用戶必須理解這些參數(shù)的含義才能合理使用。切忌直接復(fù)制網(wǎng)上的參數(shù)不同品牌伺服、不同拓?fù)浣Y(jié)構(gòu)最優(yōu)配置是不同的。6. 基于QT的完整應(yīng)用框架設(shè)計(jì)6.1 界面線程與實(shí)時(shí)線程如何協(xié)作很多初次接觸QT結(jié)合EtherCAT的人最容易犯的錯(cuò)誤就是把通信直接塞進(jìn)GUI線程。QT的GUI線程運(yùn)行著事件循環(huán)一旦被長(zhǎng)時(shí)間阻塞界面就會(huì)卡死這是絕對(duì)不可接受的。正確做法是把EtherCAT周期通信放在一個(gè)單獨(dú)的實(shí)時(shí)線程中用信號(hào)槽機(jī)制與界面線程通信。在設(shè)計(jì)這個(gè)框架時(shí)我會(huì)把功能分成三層界面層負(fù)責(zé)顯示狀態(tài)、接收用戶輸入比如目標(biāo)位置、速度完全不接觸任何EtherCAT API?？刂茖右粋€(gè)獨(dú)立的QThread運(yùn)行周期通信循環(huán)調(diào)用SOEM的收發(fā)函數(shù)并維護(hù)一個(gè)簡(jiǎn)化的狀態(tài)機(jī)。數(shù)據(jù)層定義好控制指令和反饋數(shù)據(jù)的結(jié)構(gòu)體用互斥鎖或者隊(duì)列在控制層和界面層之間傳遞數(shù)據(jù)。對(duì)于運(yùn)動(dòng)控制系統(tǒng)我通常定義一個(gè)EtherCATWorker類繼承自QObject并把它移動(dòng)到QThread中執(zhí)行class EtherCATWorker : public QObject { Q_OBJECT public: explicit EtherCATWorker(QObject* parent nullptr); public slots: void start(); void stop(); void setTargetPosition(int axis, int32_t pos); signals: void statusUpdated(const QString status); void positionUpdated(int axis, int32_t pos); void errorOccurred(const QString error); private: void cycleLoop(); bool runningFlag; };start()插槽里執(zhí)行前面說到的初始化和狀態(tài)切換然后進(jìn)入一個(gè)while循環(huán)以QElapsedTimer控制周期節(jié)拍在循環(huán)內(nèi)部調(diào)用ec_send_processdata和ec_receive_processdata。這里有個(gè)性能細(xì)節(jié)周期循環(huán)中不要使用QThread::msleep()來粗略延時(shí)因?yàn)樗木炔蛔阋灾?ms以下的控制周期而且受系統(tǒng)調(diào)度影響很大。更可靠的做法是使用QElapsedTimer做自旋等待或者干脆加上std::this_thread::sleep_for(std::chrono::microseconds(...))配合高精度定時(shí)器。如果是在Linux平臺(tái)還可以配合timerfd或者clock_nanosleep這些實(shí)時(shí)接口。6.2 跨線程數(shù)據(jù)傳遞不丟不重在EtherCATWorker中更新的伺服位置、狀態(tài)字等數(shù)據(jù)界面需要實(shí)時(shí)刷新。直接用普通成員變量跨線程讀寫有數(shù)據(jù)競(jìng)爭(zhēng)的風(fēng)險(xiǎn)用QT信號(hào)槽傳輸又可能出現(xiàn)高頻下的丟包或延遲。我的做法是在Worker內(nèi)部用三個(gè)環(huán)形緩沖區(qū)分別存儲(chǔ)位置、狀態(tài)和報(bào)警數(shù)據(jù)界面線程按需取用用QMutex保護(hù)讀寫指針。void EtherCATWorker::cycleLoop() { while (runningFlag) { // 等待周期節(jié)拍 // 發(fā)起過程數(shù)據(jù)交換 ec_send_processdata(); int wkc ec_receive_processdata(0); // 讀取各從站的反饋 for (int i 1; i slaveCount; i) { int32_t pos servoIn[i]-actual_position; uint16_t status servoIn[i]-statusword; mutex.lock(); posBuffer[i] pos; statusBuffer[i] status; mutex.unlock(); } // 向界面發(fā)信號(hào)刷新的通知 emit dataRefreshed(); // 周期節(jié)拍控制 } }界面端的刷新槽函數(shù)只需要加鎖拷貝數(shù)據(jù)然后更新控件即可。這樣的設(shè)計(jì)下不管界面刷新頻率快慢底層通信都不會(huì)受到影響。當(dāng)然有人會(huì)說直接用emit positionUpdated(axis,pos)不是更簡(jiǎn)單嗎在軸數(shù)少、通信周期慢的場(chǎng)景下確實(shí)夠用但是在16軸甚至32軸、1ms周期的系統(tǒng)里高頻信號(hào)的發(fā)射和槽函數(shù)的調(diào)用會(huì)引入不必要的線程切換開銷。環(huán)形緩沖區(qū)加通知信號(hào)的方案在這類場(chǎng)景下明顯更穩(wěn)。6.3 日志記錄與在線升級(jí)產(chǎn)品化的系統(tǒng)不能只跑通就完事。我們需要日志來追蹤異常需要OTA升級(jí)能力來修復(fù)現(xiàn)場(chǎng)問題。SOEM的FOEFile over EtherCAT協(xié)議可以在EtherCAT總線上傳輸文件最常見的就是給從站升級(jí)固件。SOEM提供了ec_foe_write和ec_foe_read函數(shù)使用起來很直接uint32_t err ec_FOEwrite(1, filename, password, buffer, size, timeout);返回值為0代表成功非0值則是從站返回的錯(cuò)誤碼。在給伺服驅(qū)動(dòng)器升級(jí)固件時(shí)注意事項(xiàng)比較多升級(jí)前必須確保從站處于Pre-Op狀態(tài)過程數(shù)據(jù)交換要暫停升級(jí)期間不要斷電?？偩€上多個(gè)從站升級(jí)時(shí)務(wù)必一臺(tái)上完再切下一臺(tái)絕不能“并發(fā)”。日志方面QT的qInstallMessageHandler可以把運(yùn)行日志同時(shí)輸出到控制臺(tái)、文件和網(wǎng)絡(luò)配合SOEM的通信錯(cuò)誤返回值記錄這樣現(xiàn)場(chǎng)如果出了問題能快速定位是通信鏈路問題還是控制邏輯問題。我見過太多項(xiàng)目因?yàn)槿鄙偃罩粳F(xiàn)場(chǎng)調(diào)試像大海撈針一樣。7. 實(shí)戰(zhàn)中的常見問題與排查技巧7.1 網(wǎng)卡選型與實(shí)時(shí)性優(yōu)化SOEM跑不好很多時(shí)候問題不出在協(xié)議棧本身而是網(wǎng)卡選錯(cuò)了。EtherCAT主站對(duì)網(wǎng)卡的要求非常嚴(yán)格網(wǎng)卡必須支持接收所有以太網(wǎng)幀混雜模式并且發(fā)送和接收的時(shí)間戳越精確越好。普通消費(fèi)級(jí)USB網(wǎng)卡是絕對(duì)不可用的延遲大還不穩(wěn)定。目前做EtherCAT主站最常用的方案是Intel的I210、I211以及部分瑞昱的千兆網(wǎng)卡芯片。I210因?yàn)橹С钟布r(shí)間戳在DC同步精度要求高的場(chǎng)合幾乎是首選。英特爾的I210網(wǎng)卡成本不算高很多工控主板也直接板載。在Linux下可以通過ethtool -i查看網(wǎng)卡驅(qū)動(dòng)如果是igb驅(qū)動(dòng)那基本上就沒問題了。為了提高通信穩(wěn)定性我還會(huì)做以下幾個(gè)優(yōu)化在多核處理器上把EtherCAT線程綁定到獨(dú)立CPU核心避免線程被系統(tǒng)調(diào)度到其他核上。在Linux下使用chrt命令把實(shí)時(shí)線程設(shè)為SCHED_FIFO優(yōu)先級(jí)保證周期調(diào)度的確定性。關(guān)閉網(wǎng)卡的節(jié)能模式、中斷合并Interrupt Moderation盡量降低報(bào)文延遲。這些優(yōu)化看似不起眼但對(duì)系統(tǒng)的長(zhǎng)期穩(wěn)定運(yùn)行非常關(guān)鍵。7.2 總線掉線、丟幀與從站超時(shí)EtherCAT總線上最怕的就是掉從站。運(yùn)行中一旦某個(gè)從站斷線主站發(fā)出的幀就無法正常返回所有從站過程數(shù)據(jù)都可能失效。SOEM的ec_receive_processdata返回值是“工作計(jì)數(shù)器”Working Counter的總和通過檢查它可以判斷這一幀通信是否成功。我封裝過一個(gè)檢查函數(shù)bool checkWorkingCounter(int expectedWkc) { int wkc ec_receive_processdata(0); if (wkc expectedWkc) { qWarning() WKC mismatch, expected: expectedWkc actual: wkc; // 可以在這里記錄是哪一幀、哪個(gè)從站失聯(lián) return false; } return true; }如果報(bào)文丟失頻繁首要懷疑點(diǎn)就是網(wǎng)線接頭。EtherCAT要求使用屏蔽雙絞線至少Cat5e且屏蔽層要良好接地。很多現(xiàn)場(chǎng)問題最終都查出來是網(wǎng)線壓接不合格這一段我踩過很多次?？偩€末端必須接上終結(jié)電阻否則信號(hào)反射會(huì)導(dǎo)致通信不穩(wěn)定。7.3 從站EEPROM異?；謴?fù)還有一種常見的現(xiàn)場(chǎng)故障從站的EEPROM損壞或者數(shù)據(jù)被意外改寫導(dǎo)致SOEM掃描時(shí)上報(bào)錯(cuò)誤的從站信息甚至根本掃描不到。針對(duì)這種情況SOEM提供了寄存器級(jí)的訪問接口可以強(qiáng)制讀寫EEPROM。在實(shí)際操作中只要從站的ESC芯片本身沒有損壞就可以通過ec_escread和ec_escrwrite直接訪問EEPROM接口恢復(fù)出廠配置。不過要注意裸操作EEPROM風(fēng)險(xiǎn)較大如果誤改了廠商區(qū)域的數(shù)據(jù)從站可能無法正常運(yùn)行。最穩(wěn)妥的方式是聯(lián)系從站廠商獲取原廠配置工具而不是自行修復(fù)?，F(xiàn)場(chǎng)應(yīng)急時(shí)可以把錯(cuò)誤從站隔離然后重新掃描其他從站至少保證單站故障不拖垮整條線。7.4 QT串口界面卡死與崩潰最后聊一個(gè)很常見的QT層面的坑。很多人在用QT開發(fā)監(jiān)控界面時(shí)習(xí)慣在槽函數(shù)里直接更新表格控件比如QTableWidget的行列變化。但如果數(shù)據(jù)刷新頻率太高控件頻繁重建內(nèi)存碎片化會(huì)導(dǎo)致界面越來越卡甚至直接崩潰。我建議的做法是在界面上使用模型/視圖架構(gòu)Model/View預(yù)先分配足夠大的表格數(shù)據(jù)模型刷新時(shí)只更新數(shù)據(jù)而不重建控件。對(duì)于大量波形類數(shù)據(jù)的監(jiān)控建議用QCustomPlot或QCharts的增量刷新模式而不是整個(gè)圖重繪。如果界面線程和EtherCAT線程之間通過信號(hào)槽傳遞高頻數(shù)據(jù)記得用Qt::DirectConnection連接方式并且信號(hào)參數(shù)用const QByteArray這種隱式共享類型減少拷貝開銷。8. 一個(gè)完整的起步項(xiàng)目單軸伺服的點(diǎn)動(dòng)控制為了讓大家把前面的知識(shí)串起來我給出一個(gè)最簡(jiǎn)單的完整示例QT界面上放一個(gè)按鈕和一個(gè)進(jìn)度條按下按鈕后1號(hào)伺服以固定速度運(yùn)行到指定位置。8.1 界面與業(yè)務(wù)邏輯分離界面很簡(jiǎn)單一個(gè)QPushButton用于觸發(fā)運(yùn)動(dòng)一個(gè)QLabel顯示當(dāng)前位置。整個(gè)QT工程的關(guān)鍵代碼集中在Worker線程。void MainWindow::on_startButton_clicked() { if (worker nullptr) { worker new EtherCATWorker(); thread new QThread(); worker-moveToThread(thread); connect(thread, QThread::started, worker, EtherCATWorker::start); connect(worker, EtherCATWorker::positionUpdated, this, MainWindow::updatePosition); connect(worker, EtherCATWorker::statusUpdated, this, MainWindow::updateStatus); connect(worker, EtherCATWorker::errorOccurred, this, MainWindow::showError); thread-start(); } // 發(fā)一個(gè)位置指令 worker-setTargetPosition(1, 50000); }EtherCATWorker::start()先初始化SOEM成功之后進(jìn)入周期循環(huán)。設(shè)置目標(biāo)位置時(shí)注意給數(shù)據(jù)加鎖void EtherCATWorker::setTargetPosition(int axis, int32_t pos) { QMutexLocker locker(cmdMutex); targetPositionMap[axis] pos; }然后在周期循環(huán)里讀取這個(gè)目標(biāo)位置并寫入PDOint32_t pos; { QMutexLocker locker(cmdMutex); pos targetPositionMap[1]; } servoOut[1]-target_position pos; servoOut[1]-controlword 0x000F;這樣單軸點(diǎn)動(dòng)控制的骨架就出來了。8.2 防止誤觸發(fā)的安全邏輯控制類軟件里“防止誤觸發(fā)”是必須考慮的功能。我在按鈕槽函數(shù)里加入了一個(gè)鎖定機(jī)制只有從站狀態(tài)都正常、伺服使能成功、急停信號(hào)未觸發(fā)時(shí)按鈕才有效。bool MainWindow::checkSystemReady() { if (isEmergencyStop) { showError(Emergency stop active!); return false; } if (!worker-isOperational()) { showError(EtherCAT not in OP state); return false; } return true; }很多初學(xué)者在調(diào)試時(shí)會(huì)忽略急停信號(hào)。實(shí)際上EtherCAT的AL狀態(tài)機(jī)和急停邏輯是兩回事——急停信號(hào)通常通過硬接線接入IO模塊或者伺服驅(qū)動(dòng)器的STOSafe Torque Off端子軟件層面只能檢測(cè)和報(bào)警不能替代硬件的安全功能。這一點(diǎn)必須提醒大家安全回路的設(shè)計(jì)一定不要依賴上位機(jī)軟件這是人命關(guān)天的事情不能有任何僥幸心理。8.3 從簡(jiǎn)單到復(fù)雜的演進(jìn)路線如果你是從零開始接觸這套架構(gòu)我建議的路徑是先跑通官方示例simple_test再用QT封裝一個(gè)單軸點(diǎn)動(dòng)然后擴(kuò)展成多軸聯(lián)動(dòng)最后加入DC同步和FOE升級(jí)。不要一上來就追求大而全否則出了Bug你根本不知道是協(xié)議棧的問題還是自己代碼的問題。單軸跑通之后再嘗試在兩臺(tái)伺服上做同步運(yùn)動(dòng)對(duì)比DC同步開啟和關(guān)閉時(shí)的曲線差異。有了實(shí)際的實(shí)驗(yàn)數(shù)據(jù)你對(duì)EtherCAT的同步機(jī)制才會(huì)有真正的體感。9. 個(gè)人經(jīng)驗(yàn)總結(jié)寫這篇文章的時(shí)候我回想這幾年在EtherCAT主站上走過的彎路最想傳達(dá)的一點(diǎn)是SOEM雖然叫“Simple”但它的內(nèi)部機(jī)制并不簡(jiǎn)單只是把復(fù)雜性封裝得比較友好而已。真正用好的關(guān)鍵還是要把EtherCAT的協(xié)議原理和從站的行為摸透。QT加SOEM這套組合在目前的開源生態(tài)里可以說是“能打”的。QT負(fù)責(zé)跨平臺(tái)的界面、豐富的控件庫(kù)和完善的調(diào)試工具SOEM提供輕量、高效、可嵌入的EtherCAT主站能力兩者疊加無論是做實(shí)驗(yàn)室原型還是量產(chǎn)設(shè)備都有足夠的底子。最后分享一個(gè)很小的技巧在開發(fā)和調(diào)試階段把SOEM的調(diào)試打印打開能看到每個(gè)從站的寄存器讀寫過程對(duì)理解協(xié)議和排查問題幫助極大。SOEM在編譯時(shí)用DEBUG宏來控制這些輸出QT工程中可以在.pro里加一句DEFINES DEBUG來啟用。等你在實(shí)際項(xiàng)目中積累了自己的工具函數(shù)庫(kù)和模板工程之后開發(fā)效率會(huì)飛躍一個(gè)臺(tái)階。希望這篇實(shí)戰(zhàn)指南能幫你把QT加SOEM的框架從編譯到落地完整搭建起來少踩一些我當(dāng)年踩過的坑。 QT集成SOEM實(shí)現(xiàn)EtherCAT主站：從編譯到運(yùn)動(dòng)控制實(shí)戰(zhàn)
1. 為什么是QT加SOEM一個(gè)老牌主站庫(kù)的二次生命力做嵌入式上位機(jī)開發(fā)這些年我踩過不少協(xié)議棧的坑最后在EtherCAT主站這個(gè)方向上SOEMSimple Open EtherCAT Master是我目前最推薦用來搭配QT做上位機(jī)的一套組合。原因很簡(jiǎn)單SOEM是開源庫(kù)代碼量適中移植性極強(qiáng)而且它不依賴Linux內(nèi)核補(bǔ)丁——這意味著你可以輕松地在Windows、Linux、甚至RTOS上跑起來而QT恰好又是跨平臺(tái)界面開發(fā)的首選兩者配合起來幾乎是無縫銜接。先說一個(gè)很多人容易混淆的點(diǎn)EtherCAT主站協(xié)議棧和從站協(xié)議棧完全是兩碼事。從站一般由從站控制器ESC硬件來完成比如LAN9252、AX58100這類芯片芯片出廠就固化了EtherCAT從站協(xié)議的處理邏輯你不用去碰協(xié)議棧的底層。而主站這邊就不一樣了主站的任務(wù)是生成報(bào)文、管理從站狀態(tài)機(jī)、處理分布式時(shí)鐘、維護(hù)過程數(shù)據(jù)映射這些邏輯全部要跑在CPU上所以主站的“協(xié)議?！焙脡闹苯記Q定了整個(gè)運(yùn)動(dòng)控制系統(tǒng)的實(shí)時(shí)性和穩(wěn)定性。SOEM最初是由德國(guó)的一家自動(dòng)化公司貢獻(xiàn)給開源社區(qū)的后來被納入了IgH的生態(tài)體系?？赡苡腥藭?huì)問既然IgHEtherLab那么有名為什么不去用IgH我的實(shí)測(cè)體會(huì)是IgH功能雖然全但它是基于Linux內(nèi)核模塊實(shí)現(xiàn)的驅(qū)動(dòng)模型復(fù)雜編譯和加載都要在內(nèi)核態(tài)完成而且每次內(nèi)核升級(jí)都要重新編譯這對(duì)很多做產(chǎn)品的人來說是件很頭疼的事情。SOEM則完全是用戶態(tài)的庫(kù)API簡(jiǎn)潔編譯出來就是一個(gè)靜態(tài)庫(kù)或者動(dòng)態(tài)庫(kù)QT工程里直接引用就行開發(fā)效率高得多。還有一點(diǎn)很關(guān)鍵SOEM對(duì)嵌入式平臺(tái)的適配相當(dāng)好。我試過STM32MP1、i.MX8M Plus、瑞薩RZ/G2L這些平臺(tái)SOEM都能很好地跑起來。對(duì)于需要做HMI人機(jī)界面的項(xiàng)目比如點(diǎn)膠機(jī)、貼片機(jī)、機(jī)器人控制柜QT畫界面SOEM跑實(shí)時(shí)通信這套架構(gòu)在生產(chǎn)線上已經(jīng)經(jīng)過了大量驗(yàn)證。這篇文章我就從頭到尾梳理一遍從庫(kù)的編譯到QT工程的集成再到實(shí)際應(yīng)用中的關(guān)鍵細(xì)節(jié)和踩坑記錄幫助大家少走彎路。2. SOEM主站協(xié)議庫(kù)的架構(gòu)與核心機(jī)制2.1 主站協(xié)議棧的分層思想理解SOEM之前先得理解EtherCAT主站協(xié)議棧的層次劃分。EtherCAT的通信模型其實(shí)很簡(jiǎn)潔主站發(fā)送一個(gè)以太網(wǎng)幀幀里面串聯(lián)了所有從站的數(shù)據(jù)每個(gè)從站從幀中提取自己的輸出數(shù)據(jù)同時(shí)把輸入數(shù)據(jù)插入到幀的相應(yīng)位置然后幀繼續(xù)傳給下一個(gè)從站。整個(gè)過程是“飛讀飛寫”也就是所謂的過程數(shù)據(jù)Process Data交換。SOEM的核心代碼主要分為這幾個(gè)層次底層套接字層負(fù)責(zé)原始以太網(wǎng)幀的收發(fā)在Linux下走的是AF_PACKET協(xié)議族在Windows下走的是WinPcap/Npcap庫(kù)這一層是平臺(tái)相關(guān)的。鏈路層抽象SOEM通過ecx_setup系列函數(shù)來初始化網(wǎng)卡和從站掃描真正把以太網(wǎng)幀封裝成EtherCAT報(bào)文。應(yīng)用層接口這一層是我們最常碰到的包括狀態(tài)機(jī)管理郵箱通信、狀態(tài)轉(zhuǎn)換、過程數(shù)據(jù)映射、分布式時(shí)鐘等。在SOEM中有一個(gè)全局的結(jié)構(gòu)體ecx_context它把整個(gè)主站運(yùn)行狀態(tài)都封裝在里面。對(duì)于多線程應(yīng)用SOEM允許你創(chuàng)建多個(gè)ecx_context實(shí)例從而實(shí)現(xiàn)多主站并行——比如一個(gè)主站控制關(guān)節(jié)伺服另一個(gè)主站控制IO模塊這在復(fù)雜機(jī)器人系統(tǒng)里非常實(shí)用。2.2 SOEM與IGH的定位差異很多人一上來就會(huì)問SOEM和IGH到底選哪個(gè)我個(gè)人的結(jié)論是如果追求絕對(duì)最高的實(shí)時(shí)性并且團(tuán)隊(duì)有Linux內(nèi)核開發(fā)能力項(xiàng)目周期長(zhǎng)那IGH確實(shí)可以做得很極致。如果追求快速落地、跨平臺(tái)、嵌入式友好尤其是要搭配QT做上位機(jī)/觸控屏那么SOEM絕對(duì)是性價(jià)比最高的選擇。IGH把主站做成內(nèi)核模塊實(shí)時(shí)性確實(shí)是用戶態(tài)方案比不了的但付出的代價(jià)是調(diào)試?yán)щy、移植麻煩、GUI集成費(fèi)勁。SOEM走的是用戶態(tài)雖然實(shí)時(shí)性上限略低但通過配合PREEMPT_RT補(bǔ)丁或者綁定CPU核心CPU Affinity在百微秒級(jí)別的周期控制中完全夠用。對(duì)于絕大多數(shù)使用EtherCAT的場(chǎng)景——伺服周期1ms、4ms、甚至8ms都常見——SOEM的性能毫無壓力。2.3 狀態(tài)機(jī)與通信流程EtherCAT通信的核心是狀態(tài)機(jī)從站設(shè)備在上電之后要依次經(jīng)過Init、Pre-Operational、Safe-Operational、Operational四個(gè)狀態(tài)主站負(fù)責(zé)驅(qū)動(dòng)這些狀態(tài)轉(zhuǎn)換。SOEM的API封裝了這些狀態(tài)轉(zhuǎn)換ec_statechange檢查狀態(tài)變化ec_writestate讓從站切換到目標(biāo)狀態(tài)ec_readstate讀取所有從站的當(dāng)前狀態(tài)每一個(gè)狀態(tài)都有各自允許的通信服務(wù)Init只能進(jìn)行寄存器讀寫用來獲取從站信息。Pre-Op郵箱通信開啟可以配置PDO映射、加載Coe對(duì)象字典。Safe-Op過程數(shù)據(jù)開始刷新但此時(shí)從站不輸出只處理輸入。Op完全運(yùn)行狀態(tài)輸出有效伺服使能。我在調(diào)試時(shí)習(xí)慣寫一個(gè)狀態(tài)機(jī)等待函數(shù)在切換狀態(tài)之后輪詢所有從站是否都到了預(yù)期狀態(tài)如果超時(shí)就把錯(cuò)誤寄存器讀出來這樣能快速定位從站配置的問題。3. 從零開始編譯SOEM庫(kù)3.1 源碼準(zhǔn)備與CMake構(gòu)建SOEM的源碼托管在GitHub上倉(cāng)庫(kù)地址是OpenEtherCATsociety/SOEM。建議不要直接下載master分支的代碼而是選擇一個(gè)穩(wěn)定的release標(biāo)簽版本目前我常用的是1.4.0版本這個(gè)版本在ARM平臺(tái)和x86平臺(tái)上的測(cè)試都比較充分。源碼下載回來之后解壓到本地目錄SOEM本身采用CMake構(gòu)建系統(tǒng)這也是它能輕松集成到QT工程的前提之一。在Linux平臺(tái)下構(gòu)建過程很簡(jiǎn)單mkdir build cd build cmake .. make sudo make install但這里有幾個(gè)細(xì)節(jié)需要注意。默認(rèn)的CMake配置會(huì)生成動(dòng)態(tài)庫(kù)和示例程序如果你想得到一個(gè)精簡(jiǎn)的靜態(tài)庫(kù)用于嵌入式平臺(tái)可以在cmake時(shí)加上參數(shù)cmake -DBUILD_SHARED_LIBSOFF -DSOEM_BUILD_TESTSOFF -DSOEM_BUILD_EXAMPLESOFF ..這樣得到的就是一個(gè)純凈的libsoem.a靜態(tài)庫(kù)體積很小適合直接丟到嵌入式ARM的交叉編譯工具鏈里面去鏈接。SOEM支持兩種構(gòu)建方式一種是在主機(jī)上編譯然后通過交叉編譯工具鏈重新構(gòu)建另一種是直接把SOEM源碼加入QT工程一并編譯。對(duì)于產(chǎn)品化項(xiàng)目我更推薦后者理由后面細(xì)說。3.2 Windows平臺(tái)上的編譯特殊性Windows平臺(tái)下編譯SOEM會(huì)比Linux多一些步驟。SOEM的底層套接字在Windows上依賴WinPcap或Npcap的SDK原因在于EtherCAT主站需要自己構(gòu)造以太網(wǎng)幀的MAC地址和EtherType0x88A4標(biāo)準(zhǔn)的Windows Socket API是干不了這件事的必須借助Npcap的底層抓包接口。你需要先安裝Npcap并勾選“安裝SDK”的選項(xiàng)然后在CMake配置時(shí)指定Npcap SDK的路徑。如果直接用QT的MinGW工具鏈要特別留意Npcap SDK和MinGW的兼容性。實(shí)測(cè)下來MSVC2019配合Npcap是最穩(wěn)定的組合MinGW環(huán)境下偶爾會(huì)出現(xiàn)頭文件找不到的情況解決辦法是手動(dòng)把Npcap的Include目錄和Lib目錄加進(jìn)工程文件。3.3 引入QT工程的兩種姿勢(shì)把SOEM用到QT工程中主要有兩種方式。第一種是把SOEM編譯成靜態(tài)庫(kù)然后在QT的.pro文件里通過LIBS 來引用。這種方式的優(yōu)點(diǎn)是工程結(jié)構(gòu)清晰QT只負(fù)責(zé)界面和業(yè)務(wù)邏輯SOEM作為獨(dú)立的庫(kù)存在缺點(diǎn)是當(dāng)你想修改SOEM源碼時(shí)需要單獨(dú)編譯庫(kù)。第二種方式是把SOEM的全部源文件soem/目錄下直接加入到QT工程中參與整體編譯。這種方式對(duì)源碼的調(diào)試非常方便打斷點(diǎn)直接就能進(jìn)入SOEM的內(nèi)部函數(shù)對(duì)于想深入學(xué)習(xí)EtherCAT主站協(xié)議的人來說特別有價(jià)值。我自己的項(xiàng)目就采用的第二種方式在.pro文件里添加INCLUDEPATH $$PWD/soem/soem SOURCES \ $$PWD/soem/soem/ethercat.c \ $$PWD/soem/soem/ethercatcoe.c \ $$PWD/soem/soem/ethercatdc.c \ $$PWD/soem/soem/ethercatfoe.c \ $$PWD/soem/soem/ethercatmain.c \ $$PWD/soem/soem/ethercatprint.c \ $$PWD/soem/soem/ethercatsoe.c \ $$PWD/soem/soem/osal/osal.c \ $$PWD/soem/soem/osal/osal_win32.c注意文件列表要根據(jù)平臺(tái)調(diào)整Windows下需要osal_win32.cLinux下則需要osal_linux.c。另外Npcap的依賴也要加進(jìn)去win32 { INCLUDEPATH C:/Program Files/Npcap LIBS -LC:/Program Files/Npcap/Lib -lwpcap -lPacket }直接參與編譯還有一個(gè)好處是可以用上QT的構(gòu)建套件Kit比如你在Qt Creator里配置了交叉編譯套件那么SOEM也會(huì)跟著交叉編譯到目標(biāo)平臺(tái)完全不用手動(dòng)維護(hù)交叉編譯鏈的環(huán)境變量。4. 核心API應(yīng)用實(shí)戰(zhàn)主站掃描、配置與過程數(shù)據(jù)交換4.1 初始化網(wǎng)卡與從站掃描無論多復(fù)雜的EtherCAT系統(tǒng)起步操作都是類似的打開網(wǎng)卡、掃描總線、獲取從站信息。SOEM提供了一個(gè)極其實(shí)用的API以下是典型的初始化流程#include ethercat.h #include QDebug char IOmap[4096]; int slaveCount 0; bool setupEtherCAT(const QString ifname) { // 打開網(wǎng)卡返回套接字句柄 if (ec_init(ifname.toLocal8Bit().data()) 0) { qCritical() Failed to initialize NIC: ifname; return false; } qInfo() NIC initialized: ifname; // 掃描總線上所有從站 slaveCount ec_config_init(FALSE); if (slaveCount 0) { qCritical() No slaves found on the bus.; return false; } qInfo() Total slaves: slaveCount; // 配置過程數(shù)據(jù)映射 int result ec_config_map(IOmap); if (result 0) { qCritical() PDO mapping failed.; return false; } qInfo() PDO mapping done, bytes used: result; // 請(qǐng)求切換到OP狀態(tài) ec_slave[0].state EC_STATE_OPERATIONAL; ec_writestate(0); return true; }這里有幾個(gè)關(guān)鍵點(diǎn)。ec_config_init(TRUE)中的參數(shù)表示是否使用保留地址reserved address進(jìn)行配置一般設(shè)為FALSE即可。掃描完成后總線上的每個(gè)從站信息會(huì)填充到全局?jǐn)?shù)組ec_slave[]中每個(gè)元素的eep_id、eep_man、eep_rev這些字段存儲(chǔ)的就是從站的Vendor ID、Product ID等信息。ec_config_map(IOmap)這個(gè)函數(shù)是理解EtherCAT從站映射的關(guān)鍵它會(huì)為每個(gè)從站計(jì)算PDO的映射關(guān)系返回所有從站輸出和輸入數(shù)據(jù)占用的總字節(jié)數(shù)。IOmap這個(gè)緩沖區(qū)就是你接下來讀寫過程數(shù)據(jù)的“舞臺(tái)”。4.2 理解Vendor ID與從站配置的坑在調(diào)試新從站時(shí)很多人會(huì)遇到一個(gè)“詭異”現(xiàn)象從站明明被掃描到了但狀態(tài)始終切不到OP。這時(shí)大概率是從站的配置信息不完整尤其是FMMU映射出了問題。FMMUFieldbus Memory Management Unit是EtherCAT從站內(nèi)部用來把過程數(shù)據(jù)映射到本地地址的機(jī)制SOEM在ec_config_map時(shí)會(huì)按EEPROM里的配置自動(dòng)設(shè)置但是如果從站的EEPROM沒有燒錄或者配置錯(cuò)誤映射就會(huì)失敗。這時(shí)可以用SOEM提供的工具函數(shù)讀取從站的EEPROM信息qDebug() Slave i Vendor: hex ec_slave[i].eep_man Product: hex ec_slave[i].eep_id Revision: hex ec_slave[i].eep_rev;通常從站出廠時(shí)廠商會(huì)把這些信息寫好。但如果是自己開發(fā)的從站比如基于LAN9252或者AX58100的板子在初次調(diào)試時(shí)就要特別留意很多從站不支持自動(dòng)配置FMMU必須在上位機(jī)中顯式地設(shè)置PDO的映射參數(shù)。這種情況下光靠SOEM的自動(dòng)映射是不夠的你可能需要直接操作ESC寄存器來手動(dòng)配置。一個(gè)我非常推薦的做法是在正式控制邏輯之前先打印所有從站的輸入輸出長(zhǎng)度和映射地址確認(rèn)每個(gè)從站占用的IOmap偏移是否正確for (int i 1; i slaveCount; i) { qDebug() Slave i InputStart: ec_slave[i].Istart OutputStart: ec_slave[i].Ostart InputBits: ec_slave[i].Ibits OutputBits: ec_slave[i].Obits; }這個(gè)過程能幫你發(fā)現(xiàn)在后續(xù)訪問過程數(shù)據(jù)時(shí)該把指針指向哪個(gè)偏移位置尤其是總線上有多個(gè)不同類型的從站時(shí)這一步絕不能省。4.3 過程數(shù)據(jù)的讀寫PDO映射完成之后我們就可以通過IOmap來讀寫數(shù)據(jù)了。SOEM的思想是把所有從站的輸入輸出緊湊排列在一段連續(xù)的內(nèi)存中然后由協(xié)處理器和主站代碼通過指針來操作。為了方便管理我在實(shí)際項(xiàng)目中會(huì)為每個(gè)從站定義一個(gè)結(jié)構(gòu)體再把這些結(jié)構(gòu)體按映射順序重疊到IOmap中。比如常見的伺服驅(qū)動(dòng)器通常使用CiA402協(xié)議控制字Controlword、狀態(tài)字Statusword、目標(biāo)位置Target Position和實(shí)際位置Actual Position這些對(duì)象都是標(biāo)準(zhǔn)化的于是我可以這樣定義typedef struct { uint16_t controlword; int32_t target_position; int32_t target_velocity; uint16_t mode_of_operation; } ServoOutput_t; typedef struct { uint16_t statusword; int32_t actual_position; int32_t actual_velocity; uint16_t mode_of_operation_display; } ServoInput_t; ServoOutput_t* servoOut[16]; ServoInput_t* servoIn[16]; // 在配置完成后按每個(gè)從站的IOmap偏移綁定地址 for (int i 1; i slaveCount; i) { servoOut[i] (ServoOutput_t*)(IOmap ec_slave[i].Ostart); servoIn[i] (ServoInput_t*)(IOmap ec_slave[i].Istart); }這樣綁定之后讀寫過程數(shù)據(jù)就成了結(jié)構(gòu)體成員訪問那么簡(jiǎn)單。比如要讓1號(hào)伺服進(jìn)入位置模式并開始運(yùn)動(dòng)我只需要servoOut[1]-controlword 0x000F; servoOut[1]-mode_of_operation 0x01; // CSP模式 servoOut[1]-target_position 100000; // 單位取決于電子齒輪比然后調(diào)用ec_send_processdata()和ec_receive_processdata(0)把這一幀數(shù)據(jù)發(fā)送出去。這里要特別強(qiáng)調(diào)一個(gè)細(xì)節(jié)SOEM的ec_send_processdata()和ec_receive_processdata(0)必須成對(duì)調(diào)用并且建議在一個(gè)獨(dú)立的實(shí)時(shí)線程中以固定周期循環(huán)調(diào)用。發(fā)送函數(shù)構(gòu)造報(bào)文接收函數(shù)解析從站反饋兩者的間隔通常在幾十微秒以內(nèi)超時(shí)會(huì)返回EC_ERR。為了監(jiān)控通信質(zhì)量我習(xí)慣在接收之后檢查返回值如果在連續(xù)多個(gè)周期內(nèi)返回錯(cuò)誤就觸發(fā)報(bào)警。4.4 從站狀態(tài)切換的狀態(tài)機(jī)封裝從站從啟動(dòng)到進(jìn)入OP狀態(tài)中間要經(jīng)歷多次狀態(tài)切換每一次切換都要給從站留出足夠的時(shí)間去處理郵箱通信和PDO配置。SOEM官方示例中的方式比較初級(jí)只是簡(jiǎn)單地把目標(biāo)狀態(tài)寫進(jìn)ec_slave[0].state然后調(diào)用ec_writestate而實(shí)際項(xiàng)目中每臺(tái)從站的狀態(tài)切換速度不一樣尤其是一些復(fù)雜的伺服驅(qū)動(dòng)器可能需要幾百毫秒才能完成參數(shù)初始化。因此我在QT工程里封裝了一個(gè)帶超時(shí)管理的狀態(tài)切換函數(shù)bool waitForState(int slaveIndex, uint16_t targetState, int timeoutMs) { QElapsedTimer timer; timer.start(); while (timer.elapsed() timeoutMs) { ec_slave[slaveIndex].state targetState; ec_writestate(slaveIndex); // 讀取實(shí)際狀態(tài) ec_readstate(); uint16_t actual ec_slave[slaveIndex].state; // 檢查是否到達(dá)目標(biāo)狀態(tài) if (actual targetState) { return true; } // 如果從站報(bào)錯(cuò)讀取AL狀態(tài)碼 if (actual EC_STATE_ERROR) { uint16_t alStatusCode ec_slave[slaveIndex].ALstatuscode; qWarning() Slave slaveIndex error, AL status code: hex alStatusCode; return false; } QThread::msleep(10); } qWarning() Slave slaveIndex state timeout; return false; }從站無法進(jìn)入OP狀態(tài)時(shí)SOEM會(huì)在ec_slave[i].ALstatuscode中給出具體原因常見的有AL狀態(tài)碼含義處理建議0x0012無效的郵箱配置檢查SMSyncManager配置0x0013無效的PDO映射檢查PDO映射并重新配置0x0014同步錯(cuò)誤檢查DC時(shí)鐘配置0x001E從站本地錯(cuò)誤查看從站手冊(cè)確認(rèn)錯(cuò)誤來源有了這個(gè)等待函數(shù)切OP之前的流程就清晰可查了先切Pre-Op然后寫入PDO映射再切Safe-Op最后切Op。每一層都能驗(yàn)證。5. 分布式時(shí)鐘與同步讓多軸動(dòng)得整齊劃一5.1 為什么需要同步EtherCAT最吸引人的地方之一就是它的分布式時(shí)鐘Distributed Clock簡(jiǎn)稱DC。如果沒有DC同步總線上每個(gè)從站都是按照各自的晶振節(jié)拍來采樣和輸出晶振的頻率誤差雖然不大但累積到一定時(shí)間就會(huì)導(dǎo)致軸與軸之間出現(xiàn)明顯的偏移。在高精度的運(yùn)動(dòng)控制場(chǎng)合這種時(shí)間偏差會(huì)直接表現(xiàn)為軌跡跟隨的抖動(dòng)。DC的原理簡(jiǎn)單來說就是第一個(gè)具有DC功能的從站作為參考時(shí)鐘主站周期性發(fā)送時(shí)鐘同步報(bào)文其他從站讀取參考時(shí)鐘的時(shí)間戳并通過本地時(shí)鐘補(bǔ)償算法來校準(zhǔn)自身的本地時(shí)間。這樣一來所有從站的采樣時(shí)刻就對(duì)齊到了同一個(gè)時(shí)間基準(zhǔn)上。SOEM對(duì)DC的支持很到位在ec_config_map之后只需要調(diào)用以下幾個(gè)函數(shù)就可以完成DC初始化ec_configdc();這個(gè)函數(shù)會(huì)自動(dòng)檢測(cè)從站的DC能力并對(duì)有DC功能的從站進(jìn)行時(shí)鐘同步設(shè)置。如果總線上混合了有DC和無DC的從站SOEM會(huì)以第一個(gè)支持DC的從站的時(shí)鐘作為參考也就是所謂的SYNC0事件由DC0來觸發(fā)。5.2 周期同步與SYNC信號(hào)在實(shí)際項(xiàng)目中伺服驅(qū)動(dòng)器的位置環(huán)、速度環(huán)甚至電流環(huán)都需要依賴從站的SYNC事件來觸發(fā)。SYNC事件是DC時(shí)鐘在到達(dá)預(yù)設(shè)時(shí)刻時(shí)生成的硬件中斷信號(hào)驅(qū)動(dòng)內(nèi)部的數(shù)字信號(hào)處理器DSP會(huì)響應(yīng)這個(gè)中斷進(jìn)行采樣和計(jì)算。也就是說周期控制的精度直接取決于DC同步鏈路的質(zhì)量和SYNC信號(hào)周期的設(shè)置。在SOEM中可以通過ec_dcsync0來設(shè)置SYNC0的周期和偏移// slaveIndex為參考從站索引 // cycleTimeNs為周期時(shí)間單位是納秒 // shiftTimeNs為偏移時(shí)間 ec_dcsync0(slaveIndex, TRUE, cycleTimeNs, shiftTimeNs);例如對(duì)于1ms的控制周期ec_dcsync0(1, TRUE, 1000000, 0);這里有一個(gè)心得SYNC0的偏移時(shí)間不要一律設(shè)置為0。在總線上有多個(gè)從站時(shí)如果所有從站都在同一個(gè)時(shí)間點(diǎn)觸發(fā)SYNC可能會(huì)造成總線上瞬時(shí)電流峰值過大尤其在伺服驅(qū)動(dòng)器的使能瞬間。通常我會(huì)把偏移時(shí)間錯(cuò)開幾十微秒讓各驅(qū)動(dòng)器的采樣點(diǎn)稍微錯(cuò)開能有效減少總線上的干擾。5.3 DC同步誤差的觀察與調(diào)優(yōu)怎么判斷DC同步是否正常一個(gè)可行的辦法是循環(huán)讀取參考從站的時(shí)鐘時(shí)間戳和本地從站的系統(tǒng)時(shí)間計(jì)算時(shí)間偏差。SOEM提供了ec_dcreg相關(guān)的寄存器讀取函數(shù)可以讀取從站的0x092CSystem Time寄存器和0x0920Receive Time寄存器實(shí)時(shí)打印偏差。我在調(diào)試時(shí)發(fā)現(xiàn)當(dāng)DC同步正常時(shí)時(shí)間偏差一般能穩(wěn)定在幾百納秒以內(nèi)如果偏差出現(xiàn)毫秒級(jí)的漂移那就要檢查參考時(shí)鐘從站的選擇是否正確或者從站之間的線纜連接是不是接觸不良。還有一點(diǎn)容易被忽略如果總線上有非DC能力的從站它的報(bào)文轉(zhuǎn)發(fā)延遲會(huì)對(duì)DC同步產(chǎn)生可見的影響這種情況下盡量把DC參考點(diǎn)設(shè)在離主站最近的DC從站上或者調(diào)整DC偏移參數(shù)來補(bǔ)償。同步是所有運(yùn)動(dòng)控制系統(tǒng)的生命線SOEM在這塊已經(jīng)封裝得很好但用戶必須理解這些參數(shù)的含義才能合理使用。切忌直接復(fù)制網(wǎng)上的參數(shù)不同品牌伺服、不同拓?fù)浣Y(jié)構(gòu)最優(yōu)配置是不同的。6. 基于QT的完整應(yīng)用框架設(shè)計(jì)6.1 界面線程與實(shí)時(shí)線程如何協(xié)作很多初次接觸QT結(jié)合EtherCAT的人最容易犯的錯(cuò)誤就是把通信直接塞進(jìn)GUI線程。QT的GUI線程運(yùn)行著事件循環(huán)一旦被長(zhǎng)時(shí)間阻塞界面就會(huì)卡死這是絕對(duì)不可接受的。正確做法是把EtherCAT周期通信放在一個(gè)單獨(dú)的實(shí)時(shí)線程中用信號(hào)槽機(jī)制與界面線程通信。在設(shè)計(jì)這個(gè)框架時(shí)我會(huì)把功能分成三層界面層負(fù)責(zé)顯示狀態(tài)、接收用戶輸入比如目標(biāo)位置、速度完全不接觸任何EtherCAT API?？刂茖右粋€(gè)獨(dú)立的QThread運(yùn)行周期通信循環(huán)調(diào)用SOEM的收發(fā)函數(shù)并維護(hù)一個(gè)簡(jiǎn)化的狀態(tài)機(jī)。數(shù)據(jù)層定義好控制指令和反饋數(shù)據(jù)的結(jié)構(gòu)體用互斥鎖或者隊(duì)列在控制層和界面層之間傳遞數(shù)據(jù)。對(duì)于運(yùn)動(dòng)控制系統(tǒng)我通常定義一個(gè)EtherCATWorker類繼承自QObject并把它移動(dòng)到QThread中執(zhí)行class EtherCATWorker : public QObject { Q_OBJECT public: explicit EtherCATWorker(QObject* parent nullptr); public slots: void start(); void stop(); void setTargetPosition(int axis, int32_t pos); signals: void statusUpdated(const QString status); void positionUpdated(int axis, int32_t pos); void errorOccurred(const QString error); private: void cycleLoop(); bool runningFlag; };start()插槽里執(zhí)行前面說到的初始化和狀態(tài)切換然后進(jìn)入一個(gè)while循環(huán)以QElapsedTimer控制周期節(jié)拍在循環(huán)內(nèi)部調(diào)用ec_send_processdata和ec_receive_processdata。這里有個(gè)性能細(xì)節(jié)周期循環(huán)中不要使用QThread::msleep()來粗略延時(shí)因?yàn)樗木炔蛔阋灾?ms以下的控制周期而且受系統(tǒng)調(diào)度影響很大。更可靠的做法是使用QElapsedTimer做自旋等待或者干脆加上std::this_thread::sleep_for(std::chrono::microseconds(...))配合高精度定時(shí)器。如果是在Linux平臺(tái)還可以配合timerfd或者clock_nanosleep這些實(shí)時(shí)接口。6.2 跨線程數(shù)據(jù)傳遞不丟不重在EtherCATWorker中更新的伺服位置、狀態(tài)字等數(shù)據(jù)界面需要實(shí)時(shí)刷新。直接用普通成員變量跨線程讀寫有數(shù)據(jù)競(jìng)爭(zhēng)的風(fēng)險(xiǎn)用QT信號(hào)槽傳輸又可能出現(xiàn)高頻下的丟包或延遲。我的做法是在Worker內(nèi)部用三個(gè)環(huán)形緩沖區(qū)分別存儲(chǔ)位置、狀態(tài)和報(bào)警數(shù)據(jù)界面線程按需取用用QMutex保護(hù)讀寫指針。void EtherCATWorker::cycleLoop() { while (runningFlag) { // 等待周期節(jié)拍 // 發(fā)起過程數(shù)據(jù)交換 ec_send_processdata(); int wkc ec_receive_processdata(0); // 讀取各從站的反饋 for (int i 1; i slaveCount; i) { int32_t pos servoIn[i]-actual_position; uint16_t status servoIn[i]-statusword; mutex.lock(); posBuffer[i] pos; statusBuffer[i] status; mutex.unlock(); } // 向界面發(fā)信號(hào)刷新的通知 emit dataRefreshed(); // 周期節(jié)拍控制 } }界面端的刷新槽函數(shù)只需要加鎖拷貝數(shù)據(jù)然后更新控件即可。這樣的設(shè)計(jì)下不管界面刷新頻率快慢底層通信都不會(huì)受到影響。當(dāng)然有人會(huì)說直接用emit positionUpdated(axis,pos)不是更簡(jiǎn)單嗎在軸數(shù)少、通信周期慢的場(chǎng)景下確實(shí)夠用但是在16軸甚至32軸、1ms周期的系統(tǒng)里高頻信號(hào)的發(fā)射和槽函數(shù)的調(diào)用會(huì)引入不必要的線程切換開銷。環(huán)形緩沖區(qū)加通知信號(hào)的方案在這類場(chǎng)景下明顯更穩(wěn)。6.3 日志記錄與在線升級(jí)產(chǎn)品化的系統(tǒng)不能只跑通就完事。我們需要日志來追蹤異常需要OTA升級(jí)能力來修復(fù)現(xiàn)場(chǎng)問題。SOEM的FOEFile over EtherCAT協(xié)議可以在EtherCAT總線上傳輸文件最常見的就是給從站升級(jí)固件。SOEM提供了ec_foe_write和ec_foe_read函數(shù)使用起來很直接uint32_t err ec_FOEwrite(1, filename, password, buffer, size, timeout);返回值為0代表成功非0值則是從站返回的錯(cuò)誤碼。在給伺服驅(qū)動(dòng)器升級(jí)固件時(shí)注意事項(xiàng)比較多升級(jí)前必須確保從站處于Pre-Op狀態(tài)過程數(shù)據(jù)交換要暫停升級(jí)期間不要斷電?？偩€上多個(gè)從站升級(jí)時(shí)務(wù)必一臺(tái)上完再切下一臺(tái)絕不能“并發(fā)”。日志方面QT的qInstallMessageHandler可以把運(yùn)行日志同時(shí)輸出到控制臺(tái)、文件和網(wǎng)絡(luò)配合SOEM的通信錯(cuò)誤返回值記錄這樣現(xiàn)場(chǎng)如果出了問題能快速定位是通信鏈路問題還是控制邏輯問題。我見過太多項(xiàng)目因?yàn)槿鄙偃罩粳F(xiàn)場(chǎng)調(diào)試像大海撈針一樣。7. 實(shí)戰(zhàn)中的常見問題與排查技巧7.1 網(wǎng)卡選型與實(shí)時(shí)性優(yōu)化SOEM跑不好很多時(shí)候問題不出在協(xié)議棧本身而是網(wǎng)卡選錯(cuò)了。EtherCAT主站對(duì)網(wǎng)卡的要求非常嚴(yán)格網(wǎng)卡必須支持接收所有以太網(wǎng)幀混雜模式并且發(fā)送和接收的時(shí)間戳越精確越好。普通消費(fèi)級(jí)USB網(wǎng)卡是絕對(duì)不可用的延遲大還不穩(wěn)定。目前做EtherCAT主站最常用的方案是Intel的I210、I211以及部分瑞昱的千兆網(wǎng)卡芯片。I210因?yàn)橹С钟布r(shí)間戳在DC同步精度要求高的場(chǎng)合幾乎是首選。英特爾的I210網(wǎng)卡成本不算高很多工控主板也直接板載。在Linux下可以通過ethtool -i查看網(wǎng)卡驅(qū)動(dòng)如果是igb驅(qū)動(dòng)那基本上就沒問題了。為了提高通信穩(wěn)定性我還會(huì)做以下幾個(gè)優(yōu)化在多核處理器上把EtherCAT線程綁定到獨(dú)立CPU核心避免線程被系統(tǒng)調(diào)度到其他核上。在Linux下使用chrt命令把實(shí)時(shí)線程設(shè)為SCHED_FIFO優(yōu)先級(jí)保證周期調(diào)度的確定性。關(guān)閉網(wǎng)卡的節(jié)能模式、中斷合并Interrupt Moderation盡量降低報(bào)文延遲。這些優(yōu)化看似不起眼但對(duì)系統(tǒng)的長(zhǎng)期穩(wěn)定運(yùn)行非常關(guān)鍵。7.2 總線掉線、丟幀與從站超時(shí)EtherCAT總線上最怕的就是掉從站。運(yùn)行中一旦某個(gè)從站斷線主站發(fā)出的幀就無法正常返回所有從站過程數(shù)據(jù)都可能失效。SOEM的ec_receive_processdata返回值是“工作計(jì)數(shù)器”Working Counter的總和通過檢查它可以判斷這一幀通信是否成功。我封裝過一個(gè)檢查函數(shù)bool checkWorkingCounter(int expectedWkc) { int wkc ec_receive_processdata(0); if (wkc expectedWkc) { qWarning() WKC mismatch, expected: expectedWkc actual: wkc; // 可以在這里記錄是哪一幀、哪個(gè)從站失聯(lián) return false; } return true; }如果報(bào)文丟失頻繁首要懷疑點(diǎn)就是網(wǎng)線接頭。EtherCAT要求使用屏蔽雙絞線至少Cat5e且屏蔽層要良好接地。很多現(xiàn)場(chǎng)問題最終都查出來是網(wǎng)線壓接不合格這一段我踩過很多次?？偩€末端必須接上終結(jié)電阻否則信號(hào)反射會(huì)導(dǎo)致通信不穩(wěn)定。7.3 從站EEPROM異?；謴?fù)還有一種常見的現(xiàn)場(chǎng)故障從站的EEPROM損壞或者數(shù)據(jù)被意外改寫導(dǎo)致SOEM掃描時(shí)上報(bào)錯(cuò)誤的從站信息甚至根本掃描不到。針對(duì)這種情況SOEM提供了寄存器級(jí)的訪問接口可以強(qiáng)制讀寫EEPROM。在實(shí)際操作中只要從站的ESC芯片本身沒有損壞就可以通過ec_escread和ec_escrwrite直接訪問EEPROM接口恢復(fù)出廠配置。不過要注意裸操作EEPROM風(fēng)險(xiǎn)較大如果誤改了廠商區(qū)域的數(shù)據(jù)從站可能無法正常運(yùn)行。最穩(wěn)妥的方式是聯(lián)系從站廠商獲取原廠配置工具而不是自行修復(fù)?，F(xiàn)場(chǎng)應(yīng)急時(shí)可以把錯(cuò)誤從站隔離然后重新掃描其他從站至少保證單站故障不拖垮整條線。7.4 QT串口界面卡死與崩潰最后聊一個(gè)很常見的QT層面的坑。很多人在用QT開發(fā)監(jiān)控界面時(shí)習(xí)慣在槽函數(shù)里直接更新表格控件比如QTableWidget的行列變化。但如果數(shù)據(jù)刷新頻率太高控件頻繁重建內(nèi)存碎片化會(huì)導(dǎo)致界面越來越卡甚至直接崩潰。我建議的做法是在界面上使用模型/視圖架構(gòu)Model/View預(yù)先分配足夠大的表格數(shù)據(jù)模型刷新時(shí)只更新數(shù)據(jù)而不重建控件。對(duì)于大量波形類數(shù)據(jù)的監(jiān)控建議用QCustomPlot或QCharts的增量刷新模式而不是整個(gè)圖重繪。如果界面線程和EtherCAT線程之間通過信號(hào)槽傳遞高頻數(shù)據(jù)記得用Qt::DirectConnection連接方式并且信號(hào)參數(shù)用const QByteArray這種隱式共享類型減少拷貝開銷。8. 一個(gè)完整的起步項(xiàng)目單軸伺服的點(diǎn)動(dòng)控制為了讓大家把前面的知識(shí)串起來我給出一個(gè)最簡(jiǎn)單的完整示例QT界面上放一個(gè)按鈕和一個(gè)進(jìn)度條按下按鈕后1號(hào)伺服以固定速度運(yùn)行到指定位置。8.1 界面與業(yè)務(wù)邏輯分離界面很簡(jiǎn)單一個(gè)QPushButton用于觸發(fā)運(yùn)動(dòng)一個(gè)QLabel顯示當(dāng)前位置。整個(gè)QT工程的關(guān)鍵代碼集中在Worker線程。void MainWindow::on_startButton_clicked() { if (worker nullptr) { worker new EtherCATWorker(); thread new QThread(); worker-moveToThread(thread); connect(thread, QThread::started, worker, EtherCATWorker::start); connect(worker, EtherCATWorker::positionUpdated, this, MainWindow::updatePosition); connect(worker, EtherCATWorker::statusUpdated, this, MainWindow::updateStatus); connect(worker, EtherCATWorker::errorOccurred, this, MainWindow::showError); thread-start(); } // 發(fā)一個(gè)位置指令 worker-setTargetPosition(1, 50000); }EtherCATWorker::start()先初始化SOEM成功之后進(jìn)入周期循環(huán)。設(shè)置目標(biāo)位置時(shí)注意給數(shù)據(jù)加鎖void EtherCATWorker::setTargetPosition(int axis, int32_t pos) { QMutexLocker locker(cmdMutex); targetPositionMap[axis] pos; }然后在周期循環(huán)里讀取這個(gè)目標(biāo)位置并寫入PDOint32_t pos; { QMutexLocker locker(cmdMutex); pos targetPositionMap[1]; } servoOut[1]-target_position pos; servoOut[1]-controlword 0x000F;這樣單軸點(diǎn)動(dòng)控制的骨架就出來了。8.2 防止誤觸發(fā)的安全邏輯控制類軟件里“防止誤觸發(fā)”是必須考慮的功能。我在按鈕槽函數(shù)里加入了一個(gè)鎖定機(jī)制只有從站狀態(tài)都正常、伺服使能成功、急停信號(hào)未觸發(fā)時(shí)按鈕才有效。bool MainWindow::checkSystemReady() { if (isEmergencyStop) { showError(Emergency stop active!); return false; } if (!worker-isOperational()) { showError(EtherCAT not in OP state); return false; } return true; }很多初學(xué)者在調(diào)試時(shí)會(huì)忽略急停信號(hào)。實(shí)際上EtherCAT的AL狀態(tài)機(jī)和急停邏輯是兩回事——急停信號(hào)通常通過硬接線接入IO模塊或者伺服驅(qū)動(dòng)器的STOSafe Torque Off端子軟件層面只能檢測(cè)和報(bào)警不能替代硬件的安全功能。這一點(diǎn)必須提醒大家安全回路的設(shè)計(jì)一定不要依賴上位機(jī)軟件這是人命關(guān)天的事情不能有任何僥幸心理。8.3 從簡(jiǎn)單到復(fù)雜的演進(jìn)路線如果你是從零開始接觸這套架構(gòu)我建議的路徑是先跑通官方示例simple_test再用QT封裝一個(gè)單軸點(diǎn)動(dòng)然后擴(kuò)展成多軸聯(lián)動(dòng)最后加入DC同步和FOE升級(jí)。不要一上來就追求大而全否則出了Bug你根本不知道是協(xié)議棧的問題還是自己代碼的問題。單軸跑通之后再嘗試在兩臺(tái)伺服上做同步運(yùn)動(dòng)對(duì)比DC同步開啟和關(guān)閉時(shí)的曲線差異。有了實(shí)際的實(shí)驗(yàn)數(shù)據(jù)你對(duì)EtherCAT的同步機(jī)制才會(huì)有真正的體感。9. 個(gè)人經(jīng)驗(yàn)總結(jié)寫這篇文章的時(shí)候我回想這幾年在EtherCAT主站上走過的彎路最想傳達(dá)的一點(diǎn)是SOEM雖然叫“Simple”但它的內(nèi)部機(jī)制并不簡(jiǎn)單只是把復(fù)雜性封裝得比較友好而已。真正用好的關(guān)鍵還是要把EtherCAT的協(xié)議原理和從站的行為摸透。QT加SOEM這套組合在目前的開源生態(tài)里可以說是“能打”的。QT負(fù)責(zé)跨平臺(tái)的界面、豐富的控件庫(kù)和完善的調(diào)試工具SOEM提供輕量、高效、可嵌入的EtherCAT主站能力兩者疊加無論是做實(shí)驗(yàn)室原型還是量產(chǎn)設(shè)備都有足夠的底子。最后分享一個(gè)很小的技巧在開發(fā)和調(diào)試階段把SOEM的調(diào)試打印打開能看到每個(gè)從站的寄存器讀寫過程對(duì)理解協(xié)議和排查問題幫助極大。SOEM在編譯時(shí)用DEBUG宏來控制這些輸出QT工程中可以在.pro里加一句DEFINES DEBUG來啟用。等你在實(shí)際項(xiàng)目中積累了自己的工具函數(shù)庫(kù)和模板工程之后開發(fā)效率會(huì)飛躍一個(gè)臺(tái)階。希望這篇實(shí)戰(zhàn)指南能幫你把QT加SOEM的框架從編譯到落地完整搭建起來少踩一些我當(dāng)年踩過的坑。