基于PLC位置控制系統(tǒng)急停處理的研究與應(yīng)用*

黎一強

（羅定職業(yè)技術(shù)學(xué)院，廣東云浮 527200）

0 引言

隨著經(jīng)濟(jì)發(fā)展和科技進(jìn)步，企業(yè)為了提高生產(chǎn)效率，采用了大量的自動化生產(chǎn)線用于生產(chǎn)。這些自動化生產(chǎn)線在生產(chǎn)過程中用到了許多位置控制，為了提高控制的精度，在自動化生產(chǎn)線的位置控制中，往往都是采用PLC發(fā)脈沖控制步進(jìn)電機(jī)或伺服電機(jī)的位移來實現(xiàn)的。

這些自動化生產(chǎn)線要設(shè)置有急?？刂乒δ躘1]，用于保證操作人員的人身安全及生產(chǎn)線設(shè)備安全，保障生產(chǎn)線穩(wěn)定運行。在生產(chǎn)過程中當(dāng)遇到緊急情況時，按下急?？刂瓢粹o[2]，生產(chǎn)線的運動部分應(yīng)立即停止，禁止所有的輸出動作。當(dāng)故障清除急?；謴?fù)后，希望生產(chǎn)線能按照急停前的工作狀態(tài)繼續(xù)運行[3]，以提高生產(chǎn)效率。但研究發(fā)現(xiàn)實際生產(chǎn)中許多采用PLC控制步進(jìn)電機(jī)或伺服電機(jī)驅(qū)動的位置控制系統(tǒng)，在自動化生產(chǎn)線急?；謴?fù)后，都是設(shè)計先進(jìn)行機(jī)械歸零復(fù)位，然后再次啟動從零位開始重新工作，這樣就大大降低了生產(chǎn)效率[4]，甚至造成原材料的浪費。本文就是研究解決該生產(chǎn)問題，以提高生產(chǎn)線的生產(chǎn)效率。

1 位置控制系統(tǒng)的構(gòu)成

步進(jìn)電機(jī)是一種使用數(shù)字脈沖信號控制轉(zhuǎn)軸進(jìn)行機(jī)械角位移的電機(jī)，數(shù)字脈沖的頻率和數(shù)量決定了電機(jī)的轉(zhuǎn)速和轉(zhuǎn)角[5]。自動化生產(chǎn)線為了提高生產(chǎn)精度，許多機(jī)械位移都是采用PLC發(fā)脈沖控制步進(jìn)電機(jī)或伺服電機(jī)的拖動控制系統(tǒng)。如某生產(chǎn)線要控制1個機(jī)械手臂在相距4 000 mm的A、B兩點之間進(jìn)行多點精準(zhǔn)定位往復(fù)運動，可采用PLC控制步進(jìn)電機(jī)或伺服電機(jī)構(gòu)成拖動系統(tǒng)。步進(jìn)電機(jī)或伺服電機(jī)的運動位移是由控制的脈沖數(shù)與脈沖當(dāng)量的乘積來決定的[6]，所以要選擇晶體管輸出的PLC。

為了研究位置控制系統(tǒng)的急停控制，選擇FX3U-48MT的PLC作為控制器，該PLC的Y0、Y1、Y2為高速脈沖輸出端子，輸出脈沖的最高頻率可達(dá)100 kHz。選用Kinco的三相步進(jìn)電機(jī)3S57Q-04056作為驅(qū)動電機(jī)，該步進(jìn)電機(jī)配套的驅(qū)動器是Kinco 3M458，步進(jìn)電機(jī)的步距角在整步方式下為1.2°，半步方式下為0.6°，在無細(xì)分的條件下300個脈沖電機(jī)轉(zhuǎn)一圈，通過驅(qū)動器設(shè)置細(xì)分精度最高可以達(dá)到10 000個脈沖電機(jī)轉(zhuǎn)一圈。3M458驅(qū)動器DIP開關(guān)細(xì)分設(shè)置如表1所示。

位置控制系統(tǒng)步進(jìn)電機(jī)的同步輪齒距為5 mm，共12個齒，當(dāng)步進(jìn)電機(jī)旋轉(zhuǎn)一周時帶動機(jī)械手臂的位移為60 mm，通過驅(qū)動器設(shè)置細(xì)分，當(dāng)10 000個脈沖步進(jìn)電機(jī)轉(zhuǎn)一圈時，機(jī)械手臂位移的精度最高，脈沖當(dāng)量μ=60 mm/10 000=0.006 mm。在這里，設(shè)置步進(jìn)電機(jī)是1 000步/轉(zhuǎn)，脈沖當(dāng)量μ=60 mm/1 000=0.06 mm。

表1 3M458驅(qū)動器DIP開關(guān)細(xì)分設(shè)置

2 位置控制系統(tǒng)的I/O接線圖

根據(jù)位置控制系統(tǒng)設(shè)計急停處理的功能，可得到該系統(tǒng)的I/O分配表如表2、表3所示。

表2 PLC輸入分配表

表3 PLC輸出分配表

根據(jù)PLC的I/O分配表可畫出PLC的I/O接線圖如圖1所示。

圖1 PLC的I/O接線圖

3 常規(guī)急停處理的缺陷

FX3U-48MT的PLC內(nèi)置三軸的定位控制功能，這個功能輸出點為Y0、Y1、Y2，常采用脈沖輸出指令PLSY、相對定位指令DRVI及絕對定位指令DRVA從這些功能輸出點發(fā)出高速脈沖去驅(qū)動步進(jìn)電機(jī)或伺服電機(jī)。為了實現(xiàn)急停發(fā)生后系統(tǒng)能立即停止運動，保持急停發(fā)生的現(xiàn)有狀態(tài)，排除急停故障復(fù)位重新啟動，系統(tǒng)不用回到初始狀態(tài)，能直接從急停前的狀態(tài)繼續(xù)運行，以提高生產(chǎn)效率。經(jīng)查閱相關(guān)文獻(xiàn)及實際生產(chǎn)操作的調(diào)研，發(fā)現(xiàn)PLC控制系統(tǒng)急停處理常用的控制方法有2種，一是采用主控指令MC；二是采用跳轉(zhuǎn)指令CJ[7]。

研究發(fā)現(xiàn)在PLC運動位置控制系統(tǒng)中，急停處理采用常用編程方法存在著嚴(yán)重的缺陷，許多運行控制系統(tǒng)在急停復(fù)位后，不能實現(xiàn)從急停前的斷點處繼續(xù)運行，都是先復(fù)位讓系統(tǒng)回復(fù)到初始狀態(tài)，再從初態(tài)開始運行，這樣大大降低了生產(chǎn)效率。

3.1 MC急停控制

3.1.1 PLSY指令位置控制

圖2所示為圖1位置控制系統(tǒng)采用主控指令MC的急?？刂铺菪螆D程序。該程序利用雙字脈沖輸出指令DPLSY，從Y0輸出頻率為5 kHz共30 000個脈沖控制步進(jìn)電機(jī)拖動機(jī)械手臂位移L=0.06 mm×30 000=1 800 mm。圖2所示為系統(tǒng)工作在急停發(fā)生時的狀態(tài)，急停按鈕SB0被按下，置位M0發(fā)出急停信號，主控開關(guān)N0斷開，MC N0到MCR N0之間程序塊的輸出被停止，Y0處于OFF狀態(tài)，也就是說當(dāng)急停發(fā)生時Y0停止脈沖的輸出，Y0的輸出脈沖寄存器D8140的值保持為13 686不變，共輸了13 686個脈沖，步進(jìn)電機(jī)拖動機(jī)械手臂位移L1=0.06 mm×13 686=821.16 mm而停止，急停起到停止運行的作用。

圖2 MC控制PLSY指令急停發(fā)生時狀態(tài)

當(dāng)故障排除，急停復(fù)位，主控開關(guān)接通，重新啟動后，如果系統(tǒng)是從急停前的斷點繼續(xù)工作的話，PLC的Y0端子應(yīng)再發(fā)送30 000-13 686=16 314個脈沖后停止，步進(jìn)電機(jī)拖動機(jī)械手臂再次位移L2=0.06 mm×13 686=978.84 mm，L1+L2=1 800 mm。但DPLSY指令的特性是該指令每次得電啟動后，都是連續(xù)輸出程序中設(shè)定的脈沖數(shù)，所以急?；謴?fù)后Y0是連續(xù)發(fā)送30 000個脈沖才停止，也就是說系統(tǒng)共發(fā)出了43 686個脈沖如圖3所示，步進(jìn)電機(jī)拖動機(jī)械手臂位移為821.16 mm+1 800 mm=2 621.16 mm，超出了原來控制的運動范圍，造成機(jī)械事故。

圖3 MC控制PLSY指令急?；謴?fù)后狀態(tài)

3.1.2 DRVA指令位置控制

圖4、圖5所示為采用DRVA絕對位置指令，從PLC的Y0發(fā)脈沖控制步電機(jī)位移的梯形圖程序。該程序的功能也是從Y0輸出頻率為5 kHz共30 000個脈沖，控制步進(jìn)電機(jī)拖動機(jī)械手臂位移1 800 mm，D8340為Y0的輸出脈沖寄存器。圖4是系統(tǒng)工作在急停發(fā)生時的狀態(tài)，主控開關(guān)N0斷開，MC N0到MCR N0之間程序塊的輸出被停止，Y0處于OFF狀態(tài)，Y0的輸出脈沖寄存器D8340的值保持為13 330不變，步進(jìn)電機(jī)拖動機(jī)械手臂位移L1=0.06 mm×13 330=799.80 mm而停止，急停起到停止運行的作用。

圖4 MC控制DRVA指令急停發(fā)生時狀態(tài)

圖5 MC控制DRVA指令急?；謴?fù)后的狀態(tài)

DRVA指令是以脈沖輸出端子的輸出脈沖寄存器為零時，機(jī)械手的位置為電氣原點的。在這個系統(tǒng)中Y0的輸出脈沖寄存器D8340為0時，機(jī)械手的位置為電氣原點。圖4是機(jī)械手距電氣原點799.80 mm時發(fā)生了急停動作，如果不用斷開PLC的電源進(jìn)行急停故障排查，當(dāng)急?；謴?fù)重啟后，D8340的值保持為13 330不變，系統(tǒng)的電氣原點沒有發(fā)生變化，根據(jù)DRVA絕對位置控制的功能，PLC驅(qū)動Y0點再發(fā)送30 000-13 686=16 314個脈沖后停止，步進(jìn)電機(jī)拖動機(jī)械手臂的位移為1 800 mm，達(dá)到控制的要求。

但控制系統(tǒng)發(fā)生急停事故之后，往往要停電進(jìn)行故障排查。D8340數(shù)據(jù)寄存器不具有停電保持功能，PLC斷電后，D8340的數(shù)值會清零。當(dāng)急停故障排除后，PLC系統(tǒng)上電重新啟動，因斷電時D8340的數(shù)值已清零，PLC系統(tǒng)是將D8340為0時機(jī)械手的位置看作電氣原點，故PLC重新從Y0連續(xù)發(fā)送30 000個脈沖，步進(jìn)電機(jī)拖動機(jī)械手臂位移為799.08 mm+1 800 mm=2 599.08 mm，也超出了原來控制的運動范圍，也沒達(dá)到急?？刂频哪康摹?/p>

3.1.3 DRVI指令位置控制

采用相對位置控制指令DRVI從PLC的Y0發(fā)脈沖控制步電機(jī)，它的程序結(jié)構(gòu)與采用DRVA指令的相似。當(dāng)急停發(fā)生，主控開關(guān)斷開，Y0停止發(fā)脈沖。DRVI是將該指令啟動信號看作相對電氣原點位置的，所以急?；謴?fù)后，DRVI指令將急停斷點看成相對電氣原點，PLC驅(qū)動Y0點重新連續(xù)發(fā)送30 000個脈沖控制步進(jìn)電機(jī)位移。它實現(xiàn)的功能與PLSY指令相似，機(jī)械手將超程運行，這也是機(jī)械設(shè)計不允許的，達(dá)不到急?？刂频囊?。

3.2 跳轉(zhuǎn)指令CJ控制

圖6 CJ指令控制急停發(fā)生時狀態(tài)

許多PLC控制系統(tǒng)的急停設(shè)計，也采用條件跳轉(zhuǎn)指令CJ來實現(xiàn)。當(dāng)跳轉(zhuǎn)指令CJ的條件滿足時，跳到CJ指令指定的標(biāo)簽位置P，被跳過的程序模塊保存原來的輸出不變，但在PLC發(fā)脈沖定位控制系統(tǒng)中，這種急停設(shè)計也存在著嚴(yán)重的缺陷。按照常規(guī)的編程方法，圖6所示為位置控制系統(tǒng)采用CJ指令控制急停發(fā)生時的梯形圖程序，該程序利用DRVA指令從Y0端子發(fā)脈沖控制步進(jìn)電機(jī)。當(dāng)急停發(fā)生時，M0得電CJ指令跳轉(zhuǎn)到指定的標(biāo)簽位置P0處，跳過了DRVA指令模塊，由圖可以看出啟動信號M1雖然失電，但由于CJ指令的特性，被跳過的程序塊保持原來的輸出不變,所以Y0及Y1的值保持為ON不變，Y0一直有脈沖輸出，步進(jìn)電機(jī)不會停止。但Y0的脈沖存儲器D8340的值，在CJ發(fā)生跳轉(zhuǎn)時一直保持在12883不變，這會誤導(dǎo)編程者。采用PLSY及DRVI指令的控制結(jié)果與DRVA指令是一樣，也不能實現(xiàn)急停控制，圖7所示為CJ指令控制急?；謴?fù)后的狀態(tài)。

圖7 CJ指令控制急停恢復(fù)后的狀態(tài)

4 急停處理的優(yōu)化設(shè)計

通過前面的分析，在基于PLC位置控制系統(tǒng)的急停處理中，不管是采用哪條脈沖發(fā)生指令，條件跳轉(zhuǎn)指令CJ都是無法實現(xiàn)急?？刂啤５诓捎弥骺刂噶頜C的急停處理控制系統(tǒng)中：（1）如果是采用PLSY或DRVI指令發(fā)脈沖的，只要在急停恢復(fù)時，將原來設(shè)置的總脈沖數(shù)減去已發(fā)送的脈沖數(shù)，即可實現(xiàn)要求的急?？刂?；（2）如果是采用DRVA指令發(fā)送脈沖的，只要在急?；謴?fù)時，保持已經(jīng)發(fā)送的脈沖數(shù)即可。

4.1 PLSY指令位置控制的優(yōu)化

采用PLSY發(fā)脈沖指令，Y0的脈沖存儲器是D8140，D8140不具有斷電保持功能，通過圖2的梯形圖分析，不能實現(xiàn)急?？刂频闹饕颍海?）急停斷電排故時D8140的數(shù)值已清零；（2）PLSY是以該指令啟動信號看作重新開始發(fā)送脈沖的信號，所以急?；謴?fù)后，PLC驅(qū)動Y0點重新連續(xù)發(fā)送設(shè)定的脈沖個數(shù)。

在急停發(fā)生時，要解決這些問題，先將D8140內(nèi)的數(shù)據(jù)存放到一個具有斷電保持功能的寄存器中如D202，急?；謴?fù)時再將D202的數(shù)據(jù)傳送給D8140；再用一個變量D200來存放PLSY指令要發(fā)送的脈沖數(shù)，這個變量實時等于總的脈沖數(shù)減去已發(fā)送的脈沖數(shù)。這樣就能保證要發(fā)送的脈沖數(shù)不變達(dá)到急?？刂频哪康?。圖8所示為MC控制PLSY指令急停控制的優(yōu)化梯形圖程序，在程序執(zhí)行時步10程序中采用M8000將要總發(fā)送的30 000個脈沖實時減去已發(fā)送脈沖D8140的數(shù)值存放在D200中，D200的數(shù)值就是PLSY要發(fā)送的脈沖數(shù)。同時用DMOV指令實時將D8140的數(shù)值傳送給D202。在程序運行的第一個周期，步0采用初始化脈沖M8002將D202的數(shù)據(jù)傳送回給D8140。也就是說D202是實時記錄PLC已發(fā)送的脈沖數(shù)，D202具有斷電保持功能，當(dāng)PLC恢復(fù)運行時，M8002通過DMOV指令再將D202的數(shù)據(jù)傳送給D8140作為初始值，保持了原來已經(jīng)發(fā)送的脈沖數(shù)，同時D200保持還要發(fā)送的脈沖數(shù)，這樣就達(dá)到了急?？刂频哪康?。

圖8 MC控制PLSY指令急?？刂频膬?yōu)化程序

4.2 DRVA指令位置控制的優(yōu)化

采用DRVA發(fā)脈沖指令，因Y0的脈沖存儲器D8340不具有斷電保持功能，通過圖4的梯形圖分析，不能實現(xiàn)急?？刂频闹饕?，是急停斷電排故時D8340的數(shù)值已清零。所以要在急停發(fā)生時，先將D8340內(nèi)的數(shù)據(jù)存放到一個具有斷電保持功能的寄存器中如D200，急?；謴?fù)時再將D200的數(shù)據(jù)傳送給D8340，這樣就能保持已發(fā)送的脈沖數(shù)不變達(dá)到急?？刂频哪康?。

圖9是MC控制DRVA指令急停控制的優(yōu)化梯形圖程序，在程序執(zhí)行時步10程序中采用M8000將D8340的數(shù)據(jù)實時傳送給D200保存，在程序運行的第一個周期，步0采用初始化脈沖M8002將D200的數(shù)據(jù)傳送給D8340。也就是說D200是實時記錄PLC已發(fā)送的脈沖數(shù)，D200具有斷電保持功能，當(dāng)PLC恢復(fù)運行時，M8002通過DMOV指令再將D200的數(shù)據(jù)傳送給D8340作為初始值，保持了原來已經(jīng)發(fā)送的脈沖數(shù)，達(dá)到了急?？刂频哪康?。

4.3 DRVI指令位置控制的優(yōu)化

DRVI指令的程序優(yōu)化結(jié)構(gòu)與采用PLSY指令的相似。它也要保持已發(fā)送的脈沖數(shù)及用變量設(shè)定DRVI指令要發(fā)送的脈沖數(shù)。但DRVI指令驅(qū)動Y0的脈沖存儲器是D8340，通過程序優(yōu)化后也能達(dá)到急?？刂频囊?。

圖9 MC控制DRVA指令急?？刂频膬?yōu)化程序

5 結(jié)束語

本文通過程序優(yōu)化設(shè)計，實時將PLC已發(fā)送的運動脈沖數(shù)傳送給斷電保持存儲器，急停發(fā)生時能保持原來運動的數(shù)據(jù)，急?；謴?fù)后，不管是采用哪條脈沖指令，運動機(jī)械都不用進(jìn)行歸零復(fù)位，實現(xiàn)從急停斷點連續(xù)工作。PLC控制伺服電機(jī)的運動系統(tǒng)可采用同樣的編程方法。通過實際生產(chǎn)應(yīng)用，該方法實現(xiàn)了急停控制的需求，保障了人身安全及設(shè)備安全，運行效果明顯，有力地促進(jìn)了生產(chǎn)[8]，提高了生產(chǎn)線的工作效率，節(jié)約了能源，減少了生產(chǎn)成本，創(chuàng)造了較大經(jīng)濟(jì)效益。