基于EtherCAT總線的多軸伺服同步控制策略研究與工程實(shí)踐
工業(yè)自動(dòng)化領(lǐng)域?qū)Χ噍S運(yùn)動(dòng)同步精度的要求日益嚴(yán)苛,傳統(tǒng)脈沖控制方式在軸數(shù)超過(guò)8軸后布線復(fù)雜度急劇上升,且同步抖動(dòng)難以控制在微秒級(jí)。EtherCAT作為主流工業(yè)以太網(wǎng)協(xié)議,其分布式時(shí)鐘機(jī)制為多軸同步提供了硬件級(jí)時(shí)間基準(zhǔn)。本文結(jié)合某包裝機(jī)械企業(yè)的32軸凹版印刷機(jī)改造項(xiàng)目,系統(tǒng)闡述基于EtherCAT的同步控制方案設(shè)計(jì)與調(diào)試方法。
EtherCAT分布式時(shí)鐘原理
EtherCAT的DC機(jī)制要求總線中至少一個(gè)從站具備DC功能,主站通過(guò)廣播寫(xiě)入系統(tǒng)時(shí)間偏移量,各從站在本地鎖相環(huán)同步下精確對(duì)齊系統(tǒng)時(shí)間。關(guān)鍵參數(shù)包括初始偏移量寄存器和循環(huán)時(shí)間寄存器,主站在INIT至PREOP狀態(tài)轉(zhuǎn)換時(shí)自動(dòng)計(jì)算各從站的時(shí)間差并下發(fā)補(bǔ)償值。實(shí)測(cè)數(shù)據(jù)表明,在100米線纜、1ms周期下,從站間時(shí)鐘偏差可控制在正負(fù)100ns以內(nèi)。
某國(guó)產(chǎn)EtherCAT主站卡(基于FPGA架構(gòu))在32軸配置下的測(cè)試結(jié)果:周期抖動(dòng)最大值為1.2微秒,平均值0.3微秒,95%置信區(qū)間內(nèi)抖動(dòng)小于0.8微秒。這一指標(biāo)遠(yuǎn)優(yōu)于Modbus TCP的毫秒級(jí)抖動(dòng),也優(yōu)于PROFINET IRT在非專用ASIC方案下的1.5微秒典型值。
同步控制算法設(shè)計(jì)
多軸同步的核心問(wèn)題是各軸的動(dòng)態(tài)跟蹤誤差不一致。傳統(tǒng)方案采用主從模式,從軸通過(guò)電子齒輪比跟隨主軸,但該方式在加減速階段因各軸慣量差異導(dǎo)致同步偏差放大。本文采用虛擬主軸加交叉耦合控制的復(fù)合架構(gòu)。
虛擬主軸以位置規(guī)劃器生成參考軌跡,所有物理軸以相同的插補(bǔ)周期(1ms)跟蹤虛擬主軸指令。CCC補(bǔ)償器實(shí)時(shí)計(jì)算各軸位置誤差的加權(quán)平均,生成補(bǔ)償量疊加到各軸速度前饋通道。權(quán)重矩陣W根據(jù)各軸慣量比離線整定,在32軸系統(tǒng)中W為32乘1向量。
實(shí)驗(yàn)數(shù)據(jù):在凹版印刷機(jī)色組同步場(chǎng)景中,穩(wěn)態(tài)同步誤差從改造前的正負(fù)15個(gè)脈沖降低至正負(fù)0.5個(gè)脈沖(1脈沖等于0.1微米),加速段最大偏差從正負(fù)120脈沖降低至正負(fù)8脈沖。套印精度從0.15mm提升至0.05mm,滿足高端煙包印刷要求。
前置補(bǔ)償與擾動(dòng)觀測(cè)
針對(duì)負(fù)載擾動(dòng)引起的同步偏差,在速度環(huán)引入擾動(dòng)觀測(cè)器。DOB以被控對(duì)象的名義模型和實(shí)際輸出計(jì)算等效擾動(dòng),通過(guò)負(fù)反饋抵消。在伺服驅(qū)動(dòng)器中,名義模型取二階模型,截止頻率設(shè)為200Hz以避免高頻噪聲放大。DOB增益采用低通濾波器,帶寬選為伺服速度環(huán)帶寬的1/3,約100Hz。
某型號(hào)永磁同步電機(jī)(額定扭矩7.6Nm,轉(zhuǎn)子慣量6.2乘10的負(fù)4次方kg平方米)在DOB補(bǔ)償后,階躍負(fù)載擾動(dòng)(5Nm突加)下的速度跌落從12rpm減小到2.5rpm,恢復(fù)時(shí)間從45ms縮短到15ms,有效抑制了加減速階段的張力波動(dòng)。
工程部署要點(diǎn)
1. 線纜拓?fù)洌?2軸采用線性拓?fù)浼佣谭种ЫY(jié)構(gòu),每段線纜不超過(guò)100米,分支不超過(guò)0.5米,避免信號(hào)反射導(dǎo)致DC同步精度劣化。
2. 從站選型:推薦選用支持DC模式的從站控制器,且固件版本不低于1.3.0,以確保硬件時(shí)間戳精度。
3. 主站配置:周期時(shí)間設(shè)為1ms,Watchdog時(shí)間設(shè)為3倍周期,Watchdog作用于所有從站的狀態(tài)機(jī)監(jiān)控。
4. 調(diào)試流程:先單軸整定速度環(huán)(帶寬200-500Hz)和位置環(huán)(帶寬50-150Hz),再切入CCC和DOB,最后在線微調(diào)權(quán)重矩陣W。推薦使用階躍響應(yīng)和掃頻法交叉驗(yàn)證。
案例效果
某包裝企業(yè)2號(hào)凹印機(jī)改造后,32軸同步運(yùn)行穩(wěn)定,最高線速度從200m/min提升至300m/min,廢品率降低40%,年節(jié)約材料成本約120萬(wàn)元。該項(xiàng)目證明,基于EtherCAT DC加CCC加DOB的復(fù)合同步控制方案,可在不更換機(jī)械結(jié)構(gòu)的前提下顯著提升多軸同步性能,具備良好的工程推廣價(jià)值。
推薦閱讀