在CN技術(shù)和激光加工切割新技術(shù)已經(jīng)廣泛應(yīng)用于金屬、皮革、廣告雕刻等切割加工領(lǐng)域的今天,采用新型的龍門機(jī)構(gòu)設(shè)計的大幅面機(jī)器,幅面跨度可達(dá)到3mx5m有效的加工行程,使用了安裝在床身側(cè)的導(dǎo)軌設(shè)計,激光頭縱向位移軸就可以方便的以門字形結(jié)構(gòu)跨坐在橫向位移導(dǎo)軌上,同時位移由橫向兩個伺服馬達(dá)同步位移驅(qū)動兩根絲桿來完成橫向位移。如下圖所示。這樣負(fù)載重量就由2邊導(dǎo)軌和絲桿分開承受,很好的解決了大幅面機(jī)械的幅面過大、機(jī)械剛性不足的問題。
解決了上述問題后,那怎么樣才能很好的驅(qū)動電機(jī)使兩邊的伺服馬達(dá)能夠保持高精度的位置同步呢?本文就以龍門激光切割機(jī)為案例,詳述了如何利用A2伺服獨(dú)有的龍門同驅(qū)功能,僅以一路脈沖命令作為命令來源,即可實現(xiàn)兩個伺服電機(jī)之間的高精度同步控制方案。
1. 臺達(dá)高精度龍門同驅(qū)方案
傳統(tǒng)的龍門同驅(qū)電機(jī)控制,一般都需要上位控制器的配合,需要獨(dú)立的兩路命令通道才能夠控制兩軸同驅(qū)。與傳統(tǒng)龍門同驅(qū)控制架構(gòu)相比,新的A2控制方式,無需修改上位控制器的硬件接口設(shè)置和參數(shù)設(shè)計,只需要改變上位控制器和A2伺服接線,以及設(shè)定相應(yīng)的參數(shù)即可以實現(xiàn)雙伺服同驅(qū)功能,這是A2伺服運(yùn)動控制的一大特色功能。
2. 龍門同驅(qū)的控制架構(gòu)和具體接線
a)控制器選型
龍門同驅(qū)須使用A2-m/u/l型驅(qū)動器,驅(qū)動器必須具有cn5接口,因為這一個接口可支持A2驅(qū)動器接受除自身編碼器反饋之外的、來自于另外一顆伺服的第二路編碼器反饋。
b)控制器架構(gòu)
1)上位控制器給軸①的伺服di/do信號
2)上位控制器給軸②的伺服di/do信號
3)上位控制器給兩軸的一路脈沖命令信號
4)軸①pg信號輸出給軸②的cn5信號
5)軸②pg信號輸出給軸①的cn5信號
c)具體接線如下,以軸①伺服為例
3. 方案的實施
a)伺服基本參數(shù)設(shè)定-電子齒輪比設(shè)定
當(dāng)接線接好,檢查確認(rèn)無誤后,即可進(jìn)行伺服參數(shù)的設(shè)置。首先,取消相關(guān)無用的di,解除報警信息ale13、ale14、ale15,同時需要設(shè)定上位控制器對伺服命令的電子齒輪比參數(shù),設(shè)定對正確的電子齒輪比是伺服正確運(yùn)動的前提,切記兩軸的電子齒輪比設(shè)定的數(shù)值要保持一致。
設(shè)定數(shù)值p1-44 電子齒輪比分子,出廠設(shè)定值為128。
設(shè)定數(shù)值p1-45 電子齒輪比分母,出廠設(shè)定值為10,即伺服驅(qū)動器接到10萬pulse,馬達(dá)才運(yùn)轉(zhuǎn)一圈,建議根據(jù)上位控制器發(fā)送脈沖的脈沖能力,以及最高運(yùn)動速度,還有絲桿的螺距等因素綜合考慮。
這里舉例假設(shè)為p1-45=1,即10000pulse,電機(jī)運(yùn)行一圈。公式如下:
1280000xp1-45÷p1-44=1280000x1÷128=10000pulse。
b)伺服慣量比測定
伺服慣量比的估測和伺服增益的調(diào)整,步驟如下:
1)先將龍門機(jī)構(gòu)解除,檢查所有的機(jī)構(gòu)及伺服上的設(shè)定,如急停以及左右極限等,確認(rèn)是否正常有效!
2)將兩臺驅(qū)動器上的面板監(jiān)視調(diào)整為j-l(p0-02=15監(jiān)測慣量用)。
3)上位控制器下達(dá)脈波指令,先以慢速來回移動龍門機(jī)構(gòu),確定機(jī)構(gòu)運(yùn)轉(zhuǎn)沒有問題,慢慢加快來回移動速度,觀看驅(qū)動器上的慣量顯示。
4)等顯示穩(wěn)定后,將慣量比分別寫入到各自控制器的p1-37參數(shù)(當(dāng)機(jī)械結(jié)構(gòu)不對稱時,各自的慣量比有可能不同)。
5)慣量比是伺服電機(jī)運(yùn)轉(zhuǎn)的計算基礎(chǔ),此值務(wù)必正確!
c)p1-46 pg分周比參數(shù)設(shè)定和p1-72光學(xué)尺閉環(huán)解析度設(shè)定
p1-46為伺服驅(qū)動器cn1自身輸出到另一顆同驅(qū)驅(qū)動器的cn5的編碼器反饋值,此數(shù)值大小和前面p1-44、p1-45并無實質(zhì)的關(guān)系,為馬達(dá)自身輸出解析。設(shè)定數(shù)值越大,解析越高,越有利龍門的控制,但是超出一定控制的范圍的話,將影響兩軸間位置誤差計算的正確性。限制公式為:馬達(dá)轉(zhuǎn)速÷60xp1-46x4 < 8*1000,000。
p1-72為電機(jī)旋轉(zhuǎn)一圈時cn5應(yīng)該接收到多少數(shù)值。為4倍頻之后的數(shù)值,其數(shù)值為另一顆伺服軸的p1-46x4得到的數(shù)值。舉例,如軸①的p1-46=10000pulse,則軸②的p1-72相應(yīng)等于 p1-72=2500x4=40000pulse。通常兩個軸的這兩組參數(shù)要設(shè)定一致!
d)p1-73光學(xué)尺全閉環(huán)回授位置、馬達(dá)編碼器之間位置誤差過大的錯誤保護(hù)范圍設(shè)定
當(dāng)伺服驅(qū)動器從cn5接收到的另一驅(qū)動器數(shù)值與自身編碼器接口cn2反饋來的數(shù)值差值到該設(shè)定數(shù)值后,驅(qū)動器即發(fā)生ale40報警,在設(shè)定此值時,務(wù)必考慮實際的機(jī)械結(jié)構(gòu)所能承受兩軸間的錯位誤差,如誤差值設(shè)定超過實際機(jī)械結(jié)構(gòu)所能承受的能力,可能會損壞機(jī)械系統(tǒng)!允許誤差的公式如下:
還以上述為例,p1-46=10000pulse,p1-72=40000pulse。p1-73=400pulse,絲桿的螺距為10mm,則兩軸允許的誤差為:
400÷40000x10=0.1mm,當(dāng)兩軸誤差達(dá)到0.1mm時,伺服系統(tǒng)產(chǎn)生報警信息ale40。
需要注意的是這個值設(shè)定在設(shè)定時并非越小越好,還要考慮兩軸因為負(fù)載情況不可能完全相同,在加速或減速過程中,產(chǎn)生較大的同步誤差,因此要被考慮,后續(xù)章節(jié)會描述。
e)同步設(shè)定檢查
使用a2-sfot軟件示波器功能
1)將示波器下方的ch1的adr及32bit勾選,并在黃格內(nèi)鍵入0x3f9060,此值為驅(qū)動器內(nèi)部光學(xué)尺cn5的回授脈波量,此變數(shù)為32位元數(shù)值(監(jiān)視同動驅(qū)動器的移動方向)。
2)將ch2的32bit勾選,并在白色方格內(nèi)選擇“回授位置”,此為馬達(dá)本身回授的脈波量(監(jiān)視連接到示波器之驅(qū)動器的移動方向)。
3)命令上位控制器下達(dá)位置命令,使兩顆馬達(dá)同時移動,并觀察pc示波器的變化,訊號如下圖,ch1與ch2增加量是相反的,如不將cn5的輸入信號反向,只要龍門同動控制一啟動,就會馬上產(chǎn)生兩軸位置誤差過大的警報,若將本機(jī)上的p1-74設(shè)定改為10x,即可將cn5接收到的回授信號將反相。
1) 如果設(shè)定正確,訊號會如同下圖,增加量是同向的。(圖中黃色的鋸齒訊號,屬正?,F(xiàn)象,因為控制器內(nèi)部,為避免溢位,執(zhí)行數(shù)值重置的動作)
2) 完成后,將示波器接到另一臺驅(qū)動器,察看另一臺脈波回授相位是否正確。
a) 試運(yùn)轉(zhuǎn)以及P1-73 誤差值的修正
使用A2-sfot軟件增益計算功能,兩臺伺服驅(qū)動器先設(shè)定相同的伺服頻寬設(shè)定,以避免兩軸增益參數(shù)設(shè)定不一致而引起馬達(dá)反應(yīng)速度不同,產(chǎn)生較大的誤差。
使用A2-sfot軟件示波器功能
設(shè)定適當(dāng)?shù)乃欧l寬后(由小到大調(diào)整),讓上位控制器下達(dá)位置命令,并透過PC軟件示波器,觀察兩軸之間的位置誤差及同步情形。如下圖設(shè)定,勾選CH1,ADR及32BIT,并輸入位址0x3f9f98,此數(shù)值為兩軸之間的位置誤差量,單位為PULSE,兩軸間若位置誤差量大過設(shè)定值P1-73,則會產(chǎn)生報警。所以上位控制器最后給定的加減速指令,必須調(diào)整到伺服在加減速過程中,能夠滿足0x3f9f98
當(dāng)上述參數(shù)檢查和設(shè)定完畢后,將參數(shù)P1-74設(shè)定等于2即可實現(xiàn)龍門同驅(qū)功能。
c) P2-57同步增益頻寬的設(shè)定
當(dāng)使用中發(fā)現(xiàn)兩軸同步后,跟隨誤差還是較大時,建議適當(dāng)?shù)脑黾覲2-57的數(shù)值,該數(shù)值為同步控制頻寬,設(shè)定該數(shù)值后,系統(tǒng)會自動的計算出P2-54~P2-58等一系列同步頻寬PID調(diào)節(jié)參數(shù)。此數(shù)值設(shè)定越大,其兩軸同步的效果就越好。
但是需要注意的是,當(dāng)系統(tǒng)的速度環(huán)頻寬+同動控制頻寬>系統(tǒng)自身的允許頻寬時,機(jī)構(gòu)就會共振產(chǎn)生嘯叫,因此在調(diào)整同動頻寬時,要由小到大慢慢的調(diào)整!
4. 其他因素對同步精度的影響
對于下述問題是一個十分有必要討論的問題,我們在實際調(diào)試時發(fā)現(xiàn)以下問題對同步精度起影響作用,甚至有時左右到方案的結(jié)果。
1) 兩臺驅(qū)動器沒有安裝在同一個金屬層板,導(dǎo)致不能等電位,引起驅(qū)動器CN5脈沖受干擾。
實際證明發(fā)現(xiàn),有些客戶的驅(qū)動器安裝在膠木板上或者將金屬底板噴漆,當(dāng)采用的底線不夠規(guī)格時,同時監(jiān)控兩臺驅(qū)動器,其中一臺編碼器回授不增加,但是另一臺驅(qū)動器的3F9060地址位數(shù)值卻不斷變化,顯示有脈沖進(jìn)入,這就是雜訊干擾引起。
解決的方法是:
A. 減少CN5到CN1的接線長度,采用屏蔽雙絞線。
B. 使用金屬底板。
C. 采用良好和正確的接地,或者將兩顆伺服接地端子,使用金屬銅編織帶跨接。
2) 兩軸同步時機(jī)械使用絲桿和齒輪齒條的效果差異。
當(dāng)采用絲桿傳動結(jié)構(gòu)時,機(jī)械的剛性較高,因此可以獲得較好的同步效果,而使用齒輪齒條時,需要兩邊齒條嚴(yán)格對位,這樣對安裝有了較高的要求,加上齒輪傳動的間隙問題,所以結(jié)構(gòu)剛性不如絲桿,同步效果也會差些,但這是機(jī)械結(jié)構(gòu)特點(diǎn)決定的,伺服電機(jī)在電氣上仍保持高精度的位置同步。
5. 結(jié)束語
本案只是A2高解析智能伺服龍門同驅(qū)功能的一個典型應(yīng)用。目前A2系列伺服除龍門同驅(qū)功能外,其他系列機(jī)型還包含有CAN-OPEN總線機(jī)型,全閉環(huán)機(jī)型,以及擴(kuò)展I/O機(jī)型,可以滿足不同應(yīng)用場合和控制需求,相信隨著市場的不斷深入,我們可以為客戶實現(xiàn)更穩(wěn)定、高性價比的伺服運(yùn)動控制控制方案。