基于三菱FX2N的高壓水射流除銹機控制系統(tǒng)
1 引言
高壓水射流技術(shù)在材料切割和金屬除銹工業(yè)領(lǐng)域已被國內(nèi)外的相關(guān)企業(yè)所采用,其主要工作原理是:用高壓水泵將水加壓到一定壓力(一般為50~400MPa),再通過噴嘴上的小孔將水高速噴出,形成一股超音速水射流,使水獲得巨大動能,用來切割各種材料或者進行金屬除銹。高壓水射流用于金屬除銹,由于它是濕法除銹,不產(chǎn)生粉塵,安全衛(wèi)生,勞動條件好,對環(huán)境無污染,所以它在金屬除銹工業(yè)領(lǐng)域的廣泛應(yīng)用是將來發(fā)展的趨勢。
2 除銹機控制系統(tǒng)的要求及控制流程
捷特公司開發(fā)的全混合磨料水射流除銹機的處理對象為各種鋼板和焊接成型的箱型梁,要求除銹機能對不同類型的處理對象表面進行自動除銹。這就意味著高壓水噴頭的運動控制應(yīng)采用三坐標(biāo)控制方式,即噴頭要完成縱(x方向)、橫(y方向)和升降(z方向)運動,除銹機的電控系統(tǒng)應(yīng)能在操作者輸入工件外形尺寸后,按事先編制好的程序自動完成除銹工作。由于高壓水泵的拖動電機功率高達110kW,需采用啟動限流措施,以減小對電網(wǎng)的沖擊。x、y、z軸的定位精度1mm,x、y、z軸的運動控制要能實現(xiàn)單獨無級調(diào)速。除銹機電控系統(tǒng)應(yīng)設(shè)自動、手動兩種控制方式,以適應(yīng)復(fù)雜多變的工件參數(shù)。
高壓水射流除銹機的輔機為高壓水噴頭和工件的三坐標(biāo)運動控制系統(tǒng)。系統(tǒng)采用龍門架結(jié)構(gòu)、臺車移動形式,與數(shù)控龍門銑床的結(jié)構(gòu)形式相似。高壓水噴頭固定在z軸傳動絲杠的下端,z軸傳動絲杠及減速機構(gòu)又可通過y軸傳動機構(gòu)進行左右運動,工件放在x軸的臺車上。工件除銹時,工件在x軸的走行臺車上作往復(fù)運動,如果對平放的x-y平面的鋼板進行除銹,高壓水噴頭在x軸每次變換運動方向時做+y方向進給,其進給量由操作者根據(jù)高壓水噴頭的打擊寬度通過撥碼開關(guān)進行設(shè)定;如果對立放的x-z平面的箱型梁進行除銹,高壓水噴頭在x軸每次變換運動方向時做+z方向進給,其進給量的設(shè)定方法同上。x軸的走行臺車往復(fù)運動的距離即是工件的長度。高壓水射流除銹機的控制流程如圖1所示:
圖1 高壓水射流除銹機的控制流程圖
3 除銹機自動控制系統(tǒng)的設(shè)計
高壓水射流除銹機的主機為高壓水泵和合金材料制成的高壓水噴嘴,其額定工作壓力為50MPa,為了減小高壓水泵啟動時對電網(wǎng)的沖擊和其停止時對高壓輸水管道造成的水錘效應(yīng),高壓水泵電動機采用軟啟動器傳動,從而實現(xiàn)高壓水泵的軟啟動和軟停止,軟啟動器選用ABB公司的PSD250型。高壓水泵電動機軟啟動完畢進入全速運行后,用旁路接觸器進行切換,讓軟啟動器退出運行,以減輕軟啟動器的負擔(dān),增加其使用可靠性。高壓水泵正常停止時,再用旁路接觸器進行切換,讓軟啟動器進入運行,實現(xiàn)高壓水泵軟停止。
除銹機輔機x、y、z軸的電氣傳動采用異步電動機變頻調(diào)速系統(tǒng),變頻器選用三菱FR-A540系列。根據(jù)除銹機工藝要求,y、z軸不能同時運動,因此y、z軸采用一臺公用變頻器,由PLC根據(jù)控制面板的輸入數(shù)據(jù)對y、z軸驅(qū)動電動機進行切換。其中x軸的變頻器為FR-A540-5.5K-CH,y、z軸公用變頻器為FR-A540-3.7K-CH。
PLC除了完成除銹機整機的邏輯控制外,更重要的是進行實時位置控制,它要處理和運算大量的位置實時數(shù)據(jù),這些數(shù)據(jù)包括x、y、z軸光電編碼器反饋回來的位置數(shù)據(jù)、控制面板上的工件參數(shù)、4位LED數(shù)碼管的各種整機狀態(tài)參數(shù)顯示數(shù)據(jù)等。根據(jù)以上控制功能的要求,PLC選用三菱FX2N-64MT(晶體管型)。控制面板上的撥碼開關(guān)用于設(shè)定除銹機的工藝參數(shù),其中一個4位撥碼開關(guān)用于設(shè)定工件的長度,這也是x軸的自動往復(fù)運動的距離數(shù)據(jù),另外的兩個2位撥碼開關(guān)用于設(shè)定自動控制方式下+y、+z軸的每次走步量。4位LED數(shù)碼管選用鎖存型,低電平有效,電源電壓DC5V。
3.1 位置控制環(huán)節(jié)的設(shè)計
(1) 位置檢測環(huán)節(jié)的設(shè)計
因為除銹工藝要求x、y、z軸進給定位精度達到1mm即可,所以除銹機輔機的機械傳動采用如下方式:x、y軸因工作行程大,采用齒輪齒條傳動;z軸采用螺旋絲杠副傳動。x、y、z軸的電氣傳動采用異步電動機變頻調(diào)速系統(tǒng),x、y、z軸的驅(qū)動電動機均為4極電機,電動機同軸安裝光電編碼器,用以反饋x、y、z軸的位置信號。
考慮到PLC在進行高速計數(shù)、運算時的誤差和機械傳動系統(tǒng)失動量的存在,為了保證定位精度,從位置檢測精度來考核時,應(yīng)保證位置檢測精度小于實際定位精度一個數(shù)量級,即x、y、z軸的檢測精度應(yīng)小于0.1mm。為了光電編碼器的型號統(tǒng)一,均選用60ppr(ppr/每轉(zhuǎn)脈沖數(shù))、開關(guān)頻率10kHz的光電編碼器。x、y、z軸的脈沖當(dāng)量如下:x軸為20p/mm,y軸為21p/mm,z軸為18p/mm。從位置檢測精度來考核,x軸為0.050mm,y軸為0.048mm,z軸為0.056mm,它們均滿足檢測精度小于0.1mm的設(shè)計要求。
FX2N型PLC最多能為16軸提供定位控制,運算速度高達0.08μs/指令,其內(nèi)置的高速計數(shù)器通常選擇組合計數(shù)頻率不大于20kHz。由于PLC定位程序中使用了FNC53、FNC54和FNC56高速處理指令,所以高速計數(shù)器允許的選擇組合計數(shù)頻率不應(yīng)大于11kHz。核算如下:高速計數(shù)器C235(1相):1.5kHz輸入;高速計數(shù)器C236(1相):1.5kHz輸入;高速計數(shù)器C237(1相):1.5kHz輸入;SPD(X003):1.5kHz輸入;合計6kHz<11kHz。因此FX2N型PLC完全滿足本機定位控制高精度數(shù)據(jù)處理和運算的要求。
(2) 位置控制環(huán)節(jié)的軟件設(shè)計
●定位控制
為了保證x、y、z軸精確的定位,各軸的電氣傳動采用變頻器無級變速進給,電氣制動選用制動電阻動力制動方式,以提供大的制動力矩,縮短減速時間,提高加工效率。如圖2所示,當(dāng)x、y、z軸進給到減速點后,變頻器以3Hz的低速接近定位點并精確停止(減速點與定位點之間的距離由PLC軟件設(shè)定)。
圖2 位移與電機速度關(guān)系曲線圖
由于PLC處理軟件程序采用循環(huán)掃描方式,從信號輸入PLC到PLC輸出信號,至少要延遲一個循環(huán)掃描時間(一般為數(shù)ms,因軟件程序的容量大小而不同)。當(dāng)PLC用于要求高速響應(yīng)的場合時,就必須慎重考慮循環(huán)掃描時間對高速信號處理的遲滯影響。本機x、y、z軸位置信號的檢測與處理采用FX2N型PLC內(nèi)置的32位高速計數(shù)器進行處理,它是通過中斷處理進行高速動作,可對來自特定輸入端的高速脈沖進行數(shù)kHz的高速計數(shù),而與PLC的循環(huán)掃描時間無關(guān)。為了精確定位,除了選用晶體管輸出型的PLC和其內(nèi)置高速計數(shù)器功能外,還應(yīng)在軟件編程中注意,對x、y、z軸高速位置信號的檢測與處理應(yīng)采用高速計數(shù)器專用的比較置位/復(fù)位指令,以消除PLC循環(huán)掃描時間對位置控制輸出信號的遲滯影響。下面就以+x走步子程序為例做以詳細介紹,如圖3所示:
圖3中,D276是+x軸減速點的位置數(shù)據(jù),D260是+x軸定位點到位停的位置數(shù)據(jù)。當(dāng)M452變?yōu)镺N狀態(tài)后,x軸的高速位置編碼信號送入C235高速計數(shù)器進行計數(shù),當(dāng)x軸進給到減速點后,C235高速計數(shù)器的當(dāng)前值等于數(shù)據(jù)寄存器D276中的+x軸減速點的位置數(shù)據(jù),輸出繼電器Y021變?yōu)镺N狀態(tài),輸出繼電器Y020變?yōu)镺FF狀態(tài),變頻器從調(diào)速給定狀態(tài)切換到減速給定狀態(tài),以3Hz的低速接近最終定位點。當(dāng)C235高速計數(shù)器的當(dāng)前值等于數(shù)據(jù)寄存器D260中的+x軸最終定位點的位置數(shù)據(jù)時,輸出繼電器Y021變?yōu)镺FF狀態(tài),切斷變頻器的給定,+x軸停止在定位點。同時,M18變?yōu)镺N狀態(tài),向控制x、y、z軸自動進給的步進階梯指令程序發(fā)出+x軸走步轉(zhuǎn)向+y/+z軸走步的轉(zhuǎn)換標(biāo)志。由于使用了FNC53、FNC54高速處理指令,PLC所做的數(shù)據(jù)比較、外部輸出等能中斷處理,所以高速計數(shù)器C235的當(dāng)前值一旦等于數(shù)據(jù)寄存器D276、D260中的值,輸出繼電器Y020、Y021立即置位或復(fù)位,而不受PLC固有循環(huán)掃描時間的影響。
圖3 +x軸走步PLC子程序
●數(shù)據(jù)處理與計算
LC內(nèi)部采用二進制的整數(shù)值進行常規(guī)算術(shù)運算,在除銹機的控制中為了更精確地進行算術(shù)運算,因此采用FX2N提供的浮點運算指令。浮點運算在PLC內(nèi)部全部以二進制浮點值為基礎(chǔ)進行運算,由于二進制浮點值為不易直接判明的數(shù)值,所以如果要通過外部設(shè)備進行數(shù)值監(jiān)測,就要將其轉(zhuǎn)換成十進制浮點值。
除銹機位置數(shù)據(jù)的處理過程如下,控制面板上撥碼開關(guān)設(shè)定的十進制位置數(shù)據(jù)通過FNC72(DSW)數(shù)字開關(guān)指令轉(zhuǎn)換成二進制數(shù)據(jù)存入寄存器,然后將該二進制數(shù)據(jù)轉(zhuǎn)換成二進制浮點值后,再進行算術(shù)運算,最后將二進制浮點值運算結(jié)果轉(zhuǎn)換成外部設(shè)備監(jiān)視用的十進制浮點值和位置控制用的32位二進制整數(shù)值。下面以+y走步浮點數(shù)運算子程序為例進行介紹,如圖4所示。
圖4 +y走步浮點數(shù)運算PLC子程序
數(shù)據(jù)寄存器(D191,D190)中存放的是+y走步量的二進制整數(shù)值,在運算前先通過FNC49(DFLT)指令將二進制整數(shù)轉(zhuǎn)換為二進制浮點數(shù)。K2100÷K100的運算含義為:+y軸實際移動100mm時它的位移傳感器發(fā)2100個脈沖,即+y軸的脈沖當(dāng)量為21p/mm。撥碼開關(guān)設(shè)定的+y軸實際移動距離位置數(shù)據(jù)乘以它的脈沖當(dāng)量就是PLC位置控制要用的脈沖量數(shù)據(jù),其運算結(jié)果減去+y軸減速區(qū)距離位置數(shù)據(jù)就是它的減速點位置數(shù)據(jù)。上述運算都采用高精度浮點數(shù)算術(shù)運算,F(xiàn)NC123(DEDIV)是32位二進制浮點數(shù)除法指令,F(xiàn)NC122(DEMUL)是32位二進制浮點數(shù)乘法指令,F(xiàn)NC121(DESUB)是32位二進制浮點數(shù)減法指令,F(xiàn)NC118(DEBCD)是32位二進制浮點數(shù)轉(zhuǎn)換十進制浮點數(shù)指令(用于PLC外圍設(shè)備數(shù)據(jù)監(jiān)視),F(xiàn)NC129(DINT)是32位二進制浮點數(shù)轉(zhuǎn)換二進制整數(shù)指令(舍去小數(shù)點以后的值)。最后,+y軸實際移動距離和減速點位置的二進制浮點數(shù)數(shù)據(jù)還要轉(zhuǎn)換為PLC位置控制要用的32位二進制整數(shù)數(shù)據(jù),并存入相應(yīng)的數(shù)據(jù)寄存器(D291,D290)和(D307,D306)。
3.2 位置控制數(shù)據(jù)的輸入
控制面板上的撥碼開關(guān)用于設(shè)定除銹機的工藝參數(shù),其中一個4位撥碼開關(guān)用于設(shè)定工件的長度,這也是x軸的自動往復(fù)運動的距離數(shù)據(jù),它是4位十進制數(shù)據(jù);另外兩個2位撥碼開關(guān)用于設(shè)定自動控制方式下+y、+z軸的每次走步量,它是兩個2位十進制數(shù)據(jù)。為了減少撥碼開關(guān)占用的I/O端口,采用動態(tài)掃描輸入方式,即利用FX2N提供的FNC72(DSW)數(shù)字開關(guān)指令。撥碼開關(guān)與PLC的I/O端口接線,如圖5所示:
圖5 x、y、z軸數(shù)據(jù)設(shè)定及LED顯示器的PLC硬件接口
下面就FNC72(DSW)數(shù)字開關(guān)指令的工作原理做以介紹。當(dāng)M80變?yōu)镺N狀態(tài)時,連接X10-X13的BCD4位數(shù)字開關(guān)由Y10-Y13順序讀入,作為BIN值存入數(shù)據(jù)寄存器D100;連接X14-X17的BCD4位數(shù)字開關(guān),也由Y10-Y13順序讀入,作為BIN值存入數(shù)據(jù)寄存器D101,其工作時序圖,如圖6所示:
圖6 數(shù)字開關(guān)指令的工作時序圖
由于y、z軸設(shè)定數(shù)據(jù)作為一個4位十進制數(shù)據(jù)轉(zhuǎn)換成BIN值讀入,因此需用軟件分離程序,將存入數(shù)據(jù)寄存器D101的BIN值中分離出y、z軸各自的設(shè)定值。根據(jù)除銹機工藝要求,y、z軸的設(shè)定值不能同時有效,即高壓水噴頭在自動控制方式下,不是做x-y平面的運動,就是做x-z平面的運動。由此可知,數(shù)據(jù)寄存器D101中的數(shù)據(jù),若是z軸數(shù)據(jù),則(D101)<K100;若是y軸數(shù)據(jù),則(D101)≥K100,同時其數(shù)值能被K100整除。如果數(shù)據(jù)寄存器D101中的數(shù)據(jù)大于或等于K100,而除以K100后,余數(shù)不為零,說明y、z軸數(shù)據(jù)同時有設(shè)定,PLC將通過M100產(chǎn)生y/z軸數(shù)據(jù)設(shè)定錯誤報警,停止除銹機的自動進給操作。y、z軸數(shù)據(jù)的分離程序詳見圖7所示:
圖7 y、z軸進給設(shè)定數(shù)據(jù)分離PLC子程序
3.3 x軸進給速度檢測和控制系統(tǒng)數(shù)據(jù)顯示
除銹機對工件除銹效果的控制是通過調(diào)節(jié)x軸臺車運行速度來實現(xiàn)的,因此本機要求對往復(fù)進給運行的x軸臺車運行速度進行數(shù)字顯示。同時,要對控制系統(tǒng)的各種故障以故障報警號的形式進行顯示,這樣就可以大為縮短除銹機發(fā)生故障后的修復(fù)時間。
x軸的速度檢測通過將x軸位置編碼器的高速位置信號輸入X003端口,利用FX2N提供的FNC56(SPD)脈沖密度高速處理指令來實現(xiàn)。LED數(shù)碼管顯示器選用帶鎖存功能的4位七段碼顯示器,其驅(qū)動利用FX2N提供的FNC74(SEGL)帶鎖存七段碼顯示指令來實現(xiàn),其硬件接口如圖5所示。LED數(shù)碼管PLC軟件驅(qū)動和故障報警顯示程序如圖8所示:
圖8 LED數(shù)碼管PLC軟件驅(qū)動及故障報警顯示程序
圖8中,M8000處于ON狀態(tài)時,PLC將從X003輸入的x軸高速位置信號脈沖在指定的1000ms內(nèi)計數(shù),將其結(jié)果存入數(shù)據(jù)寄存器D150中。通過反復(fù)操作,數(shù)據(jù)寄存器D150就能得到脈沖密度(即與速度成比例的值)。數(shù)據(jù)寄存器D151將X003的OFF-ON操作進行計數(shù),1000ms后存入數(shù)據(jù)寄存器D150,隨之?dāng)?shù)據(jù)寄存器D151復(fù)位,再計數(shù)X003的OFF-ON操作。
3.4 自動進給的PLC軟件設(shè)計
高壓水射流除銹機的自動進給控制程序流程圖,如圖9所示。實現(xiàn)上述自動進給控制流程,可采用FX2N提供的步進階梯指令,它適用于完成工序步進式自動流程的控制任務(wù)。用步進階梯指令實現(xiàn)的高壓水射流除銹機自動進給PLC軟件程序,因篇幅所限,此不贅述。
圖9 高壓水射流除銹機的自動進給控制程序流程圖
4 結(jié)束語
本文介紹了巧妙利用FX2N型PLC強大、豐富的數(shù)據(jù)處理、高速處理、方便指令、算術(shù)及邏輯運算、外部設(shè)備I/O等指令,實現(xiàn)低定位精度要求的位置控制系統(tǒng)。該項技術(shù)成果已成功應(yīng)用于捷特公司制造的50MPa高壓水射流除銹機,經(jīng)過一年多時間的運行觀察,整機電控系統(tǒng)達到設(shè)計要求,運行穩(wěn)定,操作靈活。高壓水射流除銹機電控系統(tǒng)還涉及到軟啟動器和變頻器的自動控制,限于篇幅,均未討論。
文章版權(quán)歸西部工控xbgk所有,未經(jīng)許可不得轉(zhuǎn)載。