benwenjieshaocongwangluokongzhiqidaodianjizhongduanhechuanganqiquanchengbaochidianjiqudongtongbudexingainian。suotichudejishunenggoudafugaishantongbu
，congerxianzhutigaokongzhixingneng。

 

問題陳述和現有技術

為了解釋現有解決方案的局限性，考慮一個兩軸網絡運動控製係統，如圖1suoshi。yundongkongzhizhujitongguoshishiwangluoxianglianggesifukongzhiqifasongminglinghezhilingzhi，meigesifukongzhiqigouchengwangluoshangdeyigecongjijiedian。sifukongzhiqibenshenyouwangluokongzhiqi
、電機控製器、功率逆變器和電機/編碼器組成。

 

shishiwangluoxieyicaiyongbutongdefangfashicongjijiedianyuzhujitongbu，yizhongchangyongfangfashizaimeigejiedianchupeizhiyigebenditongbushizhong。zhezhongduishijiandegongshiquebaolesuoyousifuzhoudezhilingzhiheminglingjunjinmitongbu。huanyanzhi，shishiwangluoshangdesuoyouwangluokongzhiqidoubaochitongbu。

 

tongchang
，zaiwangluokongzhiqihedianjikongzhiqizhijianyouliangtiaozhongduanxian。diyitiaotongzhidianjikongzhiqiheshixuyaoshoujishurubingjiangqifangdaowangluoshang。diertiaotongzhidianjikongzhiqiheshicongwangluozhongduqushuju。zunzhaozhezhongfangfa
，yundongkongzhiqihedianjikongzhiqizhijianyitongbufangshijinxingshujujiaohuan，bingqiekeyishixianfeichanggaodedingshijingdu。danshi，jinjiangtongbushujuchuansongdaodianjikongzhiqihaibugou；電(dian)機(ji)控(kong)製(zhi)器(qi)還(hai)必(bi)須(xu)能(neng)以(yi)同(tong)步(bu)方(fang)式(shi)響(xiang)應(ying)數(shu)據(ju)。如(ru)果(guo)沒(mei)有(you)這(zhe)一(yi)能(neng)力(li)，電(dian)機(ji)控(kong)製(zhi)器(qi)就(jiu)無(wu)法(fa)充(chong)分(fen)利(li)用(yong)網(wang)絡(luo)的(de)定(ding)時(shi)精(jing)度(du)。在(zai)響(xiang)應(ying)指(zhi)令(ling)值(zhi)和(he)命(ming)令(ling)時(shi)
，電(dian)機(ji)控(kong)製(zhi)器(qi)的(de)I/O會出現問題。

 

電機控製器中的每個I/O（例如脈寬調製(PWM)定時器和ADC）都具有固有的延遲和時間量化。例如，我們來看圖2所示的為功率逆變器產生柵極驅動信號的PWM定時器。該定時器通過比較指令值Mx與上下計數器來產生柵極信號。當控製算法改變Mx時，新的占空比要到下一個PWM周期才會生效。這相當於一個零階保持效應，意味著每個PWM周期T內占空比僅更新一次或兩次（若使用雙更新模式）。

 

圖1.典型的兩軸網絡運動控製係統。
 

圖2.PWM定時器的占空比更新。

 

在實時網絡上，無論數據交換如何緊密地同步，PWMdingshiqideshijianlianghuajiangzuizhongchengweizhoutongbudejuedingxingyinsu。dangjieshoudaoxindezhilingzhishi，wufazaixindezhankongbishengxiaozhiqianduiqijinxingxiangying。zhedaozhishijianbuquedingxingzuichangkedayigePWM周期（通常在50 μs至100 μs範圍內）。實際上
，網絡同步周期和PWM周期之間將存在一個未經定義且可變的相位關係。將其與實時網絡上低於1 μs的時間不確定性相比較，很顯然，電機控製器的I/O在網絡同步運動控製中起到更至關重要的作用。實際上

，決定同步精度的不是實時網絡，而是係統I/O。

 

再次參考圖1，該係統具有A
、B、C三個同步域，它們沒有綁定在一起。它們實際上並不同步
，具有最長可達一個PWM周期的可變不確定性。

 

同步不確定性及應用影響

在麵向機器人和機床等應用的高性能多軸伺服係統中，可以清楚地看到時間不確定性的影響。在I/O級的電機控製軸之間的時間偏移量變化會對機器人或機床的最終三維定位精度產生直接且顯著的影響。

 

考慮一個簡單的運動曲線，如圖3所示。在此示例中，電機速度指令值（藍色曲線）shangshenghouzaixiajiang。ruguoxieposulvzaijidianxitongdenenglifanweinei
，zeshijisuduyuqizhijiangzunxunzhilingzhi。danshi，ruguozaixitongzhongrenheweizhicunzaiyanchi


，zeshijisudu（紅色曲線）將滯後於指令值


，從而導致位置誤差Δθ。

 

圖3.時序延遲對位置精度的影響。

 

在多軸機器中

，根據機器的機械結構將目標位置(x, y, z)轉換為角度軸向描述(θ1, ..., θn)。角度軸向描述為每個軸定義了一係列相等時間間隔的位置/速度命令。軸之間的任何時序差異都會導致機器的精度降低。考慮圖4所示的兩軸示例。機器的目標路徑以一組(x, y)坐標來描述。延遲使y軸命令產生時序誤差
，最終導致不規則的實際路徑。

 

在zai某mou些xie情qing況kuang下xia


，通tong過guo適shi當dang的de補bu償chang可ke以yi最zui大da程cheng度du地di降jiang低di固gu定ding延yan遲chi的de影ying響xiang。然ran而er
，更geng關guan鍵jian的de是shi無wu法fa對dui可ke變bian且qie未wei知zhi的de延yan遲chi進jin行xing補bu償chang。此ci外wai，可ke變bian延yan遲chi會hui導dao致zhi控kong製zhi環huan路lu增zeng益yi發fa生sheng改gai變bian
，從cong而er使shi調tiao整zheng環huan路lu以yi獲huo得de最zui佳jia性xing能neng變bian得de很hen困kun難nan。

 

應該注意的是
，係統中任何地方的延遲都會導致機器精度不準確。因此，盡可能減小或消除延遲才能提高生產率和最終產品質量。

 

圖4.時序延遲對位置精度的影響。

 

同步和新型控製拓撲

傳統的運動控製方法如圖5的上半部分所示。運動控製器（通常為PLC）通過實時網絡將位置指令(θ*)發送到電機控製器。電機控製器由三個級聯的反饋環路組成

，包括控製轉矩/電流(T/i)的內部環路、控製速度(ω)的中間環路和另一個控製位置(θ)的環路。轉矩環路的帶寬最高，位置環路的帶寬最低。來自工廠的反饋保持在電機控製器本地

，並與控製算法和脈寬調製器緊密同步。

 

采用這種係統拓撲，運動控製器和電機控製器之間通過位置指令值來實現軸的同步，但是在CNC加工等極高精度應用中，與電機控製器的I/O（反饋和PWM）同步的相關性隻會使之成為問題。位置環路通常具有相當低的帶寬
，因此對I/O同步較為不敏感。這意味著即使網絡與I/O位於不同的同步域中
，指令級的節點同步性能通常也能接受。

 

雖然圖5上半部分所示的控製拓撲很常見，但也可以使用其他的控製分區方法
，例如在運動控製器側實現位置和/或速度環路
，並通過網絡傳送速度/轉矩指令值。工業領域近期趨於轉向一種新的分區方法，即所有的控製環路都由電機控製器轉移至網絡主機側功能強大的運動控製器（見圖5的下半部分所示）。在實時網絡上交換的數據是電機控製器的電壓指令(v*)和運動控製器的工廠反饋(i, ω, θ)。這種控製拓撲由功能強大的多核PLC和實時網絡實現，具有諸多優勢。首先
，該架構具有很高的可擴展性。還可以輕鬆地添加/移除軸，無需擔心電機控製器的處理能力。其次
，由於軌跡規劃和運動控製都在同一個中心位置完成，因此可以提高精度。

 

新的控製拓撲也有缺點。在電機控製器中去除了控製算法
，因此損失了代碼執行和I/O的緊密同步。控製環路的帶寬越高
，損失I/O同步的問題就越大。轉矩/電流環路對同步特別敏感。

 

圖5.傳統（上圖）和新興（下圖）的運動控製拓撲。
 

圖6.I/O調度器將同步域綁定在一起。

 

建議的解決方案

將更快速的控製環路移至運動控製器提出了從網絡主機直到電機終端全程同步的要求。

總體思路是使所有軸的I/O與網絡同步

，以使它們全都在一個同步域中運行。圖6顯示了一個位於網絡控製器和電機控製器之間的I/O事件調度器。I/O事件調度器的主要功能是為所有外設生成同步/複位脈衝，使它們與網絡流量保持同步。I/O事件調度器獲取幀同步信號，該信號來源於網絡控製器的本地時鍾，並為必須與網絡保持同步的所有I/O輸出適當的硬件觸發信號。

 

每個I/O都有自己的一組時序/複位要求，這意味著I/O事件調度器必須為每個I/Otigongdingzhidechufaxinhao。suiranchufaxinhaodeyaoqiubutong，dantamenrengyongyouyixietongyongfaze。shouxian，suoyouchufaxinhaobixuyizhentongbuweijizhun。qici，cunzaiyumeigechufaxinhaoxiangguanliandeyanchi/偏移。該延遲與I/O的固有延遲有關，例如
，ADC的轉換時間或sinc濾波器的群延遲。第三
，存在I/O響應時間，例如，來自ADC的數據傳輸。I/O事件調度器掌握每個I/O的時序要求
，並根據本地時鍾連續調整觸發/複位脈衝。生成I/O事件調度器每個輸出脈衝的原理概述如圖7所示。

 

圖7.I/O調度器生成觸發脈衝。

 

在大多數網絡運動控製係統中，幀速率以及幀同步速率等於或低於電機控製器的PWM更新速率。這意味著I/O事件調度器必須每幀周期提供至少一個、也可能是多個觸發脈衝。例如，如果幀速率為10 kHz且PWM速率為10 kHz
，則I/O事件調度器必須為每一個網絡幀提供1個觸發脈衝，類似地
，如果幀速率為1 kHz且PWM速率為10 kHz，I/O事件調度器必須為每一個網絡幀提供10個觸發脈衝。這相當於圖7中的倍頻器。對每個同步脈衝施加延遲時間tD
，以補償每個I/O的固有延遲。I/O事shi件jian調tiao度du器qi的de最zui後hou一yi個ge要yao素su是shi智zhi能neng濾lv波bo功gong能neng。每mei個ge網wang絡luo上shang都dou會hui存cun在zai一yi些xie流liu量liang抖dou動dong。濾lv波bo器qi可ke減jian少shao觸chu發fa脈mai衝chong的de抖dou動dong，並bing確que保bao幀zhen同tong步bu頻pin率lv的de變bian化hua率lv受shou到dao限xian製zhi。

 

圖7的下半部分顯示了PWM同步的一個示例時序圖。請注意，本例中幀同步頻率是PWM頻率的倍數以及I/O觸發信號抖動是如何減小的。

 

實現方案

圖8顯示了一個在網絡運動控製係統中實施並進行測試的推薦的同步方案示例。網絡主機采用Beckhoff CX2020 PLC，並連接到PC用於開發和部署PLC程序。實時網絡協議（紅色箭頭）為EtherCAT。

 

電機控製器主要采用ADI公司的fido5200和ADSP-CM408。兩者結合，為網絡連接的電機驅動器提供高度集成的芯片組。

 

fido5200是一個帶有兩個以太網端口的實時以太網多協議(REM)交換芯片。它在主機處理器和工業以太網物理層之間提供一個靈活的接口。fido5200包括一個可配置的定時器控製單元(TCU)，可針對各種工業以太網協議實現先進的同步方案。還可以借助專用定時器引腳實現輸入捕獲和方波信號輸出等附加功能。定時器輸入/輸出與本地同步時間保持同相，因此也與網絡流量保持同相。這使其不僅可以同步單個從機節點的I/O，而且可以同步整個網絡中的從機節點。

 

REM交換芯片有兩個以太網端口，因此可連接兩個Phys（PHY1和PHY2）。該拓撲支持環形和線形網絡。但在本實驗設置中，作為演示說明
，僅使用一個從機節點
，並且隻有一個以太網端口處於活動狀態。

 

REM交換芯片通過並行存儲器總線與主機處理器通信，確保了高吞吐量和低延遲。

 

用於實現電機控製器的主機處理器采用ADSP-CM408。它是基於ARM® Cortex®-M4F內核的專用處理器，用於實現控製和應用功能。該處理器包括支持工業控製應用的外設
，如用於PWM逆變器控製的定時器、ADC采樣和位置編碼器接口。為了使所有外設與網絡保持同步，采用了一個靈活的觸發路由單元(TRU)。TRU將fido5200的TCU生成的觸發信號重定向至ADSP-CM408上的所有時序關鍵型外設。這些外設包括脈寬調製器、用於相電流測量的sinc濾波器、ADC和絕對編碼器接口。同步I/O的原理如圖9所示。

 

圖9.為I/O生成同步事件。

 

在圖9中，請注意如何利用REM交換芯片上的TCU和電機控製處理器上的TRU來實現I/O事件調度器。換言之
，該功能由兩個集成電路實現。

 

電機控製器反饋三相伺服電機的相電流和轉子位置。相電流使用隔離式Σ-ΔADC測量
，轉子位置則使用EnDat絕對編碼器測量。Σ-ΔADC和編碼器都直接連接至ADSP-CM408，無需任何外部FPGA或CPLD。

PWM開關頻率為10 kHz，每個PWM周期執行一次控製算法。如本文所述，TCU在每個PWM周期內為ADSP-CM408提供一次同步脈衝。

 

實驗結果

實驗設置照片如圖10所示。為了說明係統的同步功能，設置PLC使之運行一個持續200 μs的程序任務。任務時間還決定了EtherCAT網絡上的幀速率。電機控製器以PWM方式運行，並且控製更新周期為100 μs(10 kHz)，因此需要以此速率生成同步脈衝。結果如圖11所示。

 

圖8.同步方案的實現。

 

圖10.同步方案的實現。
 

圖11.為I/O生成同步事件。

 

Data Ready（數據就緒）信號指示REM交換芯片何時向電機控製應用提供網絡數據。信號每200 μs置位一次，與EtherCAT幀速率相對應。PWM同步信號也由REM交換芯片產生
，用於使電機控製器的I/O與網絡流量保持同步。由於PWM周期為100 μs

，REM交換芯片每個EtherCAT幀調度兩次PWM同步脈衝。圖11中下方的兩個信號HSPWM和LSPWM是其中一個電機相位的高端和低端PWM。請注意PWM信號是如何與網絡流量同步的。

 

總結

實時以太網廣泛用於運動控製係統，一些協議可實現精度小於1 μs的時間同步。但是，同步僅涉及網絡主機和從機之間的數據通信。現有的網絡解決方案不包括運動控製I/O同步，這限製了可實現的控製性能。

 

本ben文wen提ti出chu的de同tong步bu方fang案an可ke以yi實shi現xian從cong網wang絡luo主zhu機ji直zhi至zhi電dian機ji終zhong端duan的de全quan程cheng同tong步bu。由you於yu同tong步bu性xing能neng大da幅fu改gai善shan，該gai方fang案an能neng夠gou顯xian著zhu提ti高gao控kong製zhi性xing能neng。該gai方fang案an還hai可ke提ti供gong跨kua多duo個ge軸zhou的de無wu縫feng同tong步bu。可ke以yi輕qing鬆song地di添tian加jia軸zhou，並bing根gen據ju單dan個ge電dian機ji控kong製zhi器qi定ding製zhi同tong步bu。

 

同步基於I/O事件調度器

，該調度器位於網絡控製器和電機控製器之間。I/O事件調度器可實時高速編程，並且可進行調節以最小化抖動/頻率變化效應。

 

本文提出的方案已經在實驗設置中得到了驗證
，並展示了其結果。實驗采用的通信協議是EtherCAT。然而，建議的方案適用於任何實時以太網協議。

 

參考文獻

1.Jie Ma

，“基於EtherCAT的多自由度運動控製係統設計與實現。”2016年第六屆儀器測量、計算機
、通信與控製國際會議，2016年7月。