鄭燦周1,陳育均1,黃偉業(yè)1,劉旭鵬1,鄭譽煌2
隨著社會需求的發(fā)展,傳統(tǒng)的單升降臺工作模式已經(jīng)不能滿足實際工程需要,多升降臺協(xié)同工作在實際工程應(yīng)用越來越廣泛,特別是在大型表演舞臺中,可能需要采取上百臺升降臺一起協(xié)同工作[1]。此時,1個多升降臺協(xié)同控制系統(tǒng)就顯得尤其重要。本文以4個升降臺的同步控制為研究對象,通過分析4個升降臺行程的同步控制機理,采用多軸同步運動控制技術(shù),實現(xiàn)一套至少包含4個升降臺的行程同步控制系統(tǒng)。本系統(tǒng)可以根據(jù)實際項目需要擴展,實現(xiàn)更多的升降臺同步控制[2,3]。整體設(shè)計方案如圖1所示。
圖1 整體設(shè)計方案圖
根據(jù)圖1,本系統(tǒng)的硬件設(shè)計關(guān)鍵有兩點,一是升降臺的行程測量;二是如何實現(xiàn)多升降臺同步控制。
本升降臺采用4臺升降臺進行升降,因此需要對4臺升降臺的高度進行測量。本升降臺通過多次比較了多種測量高度的測量儀器,最終決定采取相對值式拉線編碼器。相對值式拉線編碼器的工作原理在于拉線長度的多少和方向可以通過編碼器發(fā)送的AB兩相脈沖數(shù)相應(yīng)地反映出來,相比起其他測量工具,例如,超聲波測距,紅外線測距,它受到外界環(huán)境的影響較小,較為穩(wěn)定,精度也是較為準確。
為了獲得實際升降臺行程,需要對測到的脈沖數(shù)進行量綱變換。根據(jù)升降臺在降到最低位置hmin上對應(yīng)的脈沖數(shù)數(shù)值是xmin,升降臺在升到最高位置hmax上對應(yīng)的脈沖數(shù)數(shù)值xmax,升降臺實際升降行程h與實時測到脈沖數(shù)x滿足公式(1)和(2)
(1)
(2)
值得注意的是,可以通過拉線編碼器的精度可以很高,但是實際上要具體針對升降臺所能移動的精度進行適當?shù)厝≈?,因為本升降臺系統(tǒng)有移動到指定高度功能,但由于有些升降臺不一定能夠執(zhí)行上升1 mm或者更低的高度。因此適當?shù)厝∩峥梢宰屔蹬_在工作的過程中,執(zhí)行得更加流暢。
本項目中采用三菱FX3U系列PLC,由于FX3U只能支持2個兩相兩計高速計數(shù)器,因此每臺FX3U最多能接入2個相對值式拉線編碼器,因此每臺PLC最多能控制2個升降臺。若要控制4臺升降臺同步控制,則需要把2臺PLC組成1:1網(wǎng)絡(luò),其中1臺作為主站,另1臺作為從站。同理,若要控制N個升降臺(N為偶數(shù)),則需要0.5N臺PLC組成1:(0.5N-1)網(wǎng)絡(luò)。
以本系統(tǒng)采取的1:1網(wǎng)絡(luò)為例。本系統(tǒng)需要設(shè)置主站和從站,采取輔助寄存器M8000在PLC通電后長閉,然后在主站和從站程序中通過分別連接輸出輔助寄存器M8070和M8071(如圖2和圖3),讓其在PLC工作過程中長期得電,即可設(shè)置2臺PLC的主站和從站關(guān)系。當然要實現(xiàn)對模擬量的測量,還需要兩臺PLC都通過輔助寄存器M8000令計數(shù)器C251和計數(shù)器C253長時間地得電(如圖4),這樣編碼器發(fā)送的脈沖數(shù)才能輸送到計數(shù)器里面。這樣我們便實現(xiàn)了對編碼器脈沖數(shù)的采集,最后,需要把采集到的脈沖數(shù)輸送到2臺PLC的共享數(shù)據(jù)寄存器中,這樣,從站獲取的脈沖數(shù)便可如實地傳送到主站中去。主站通過對共享數(shù)據(jù)寄存器的讀取,就可以得到從站連接的第三四臺升降臺的實時高度,實現(xiàn)對第三和第四臺升降臺的實時監(jiān)控。
本系統(tǒng)通過采取PLC和觸摸屏通信,把對4臺升降臺監(jiān)控的高度實時地反映在觸摸屏地界面上。觸摸屏還可以該系統(tǒng)進行實時控制,真正意義上地實現(xiàn)人機交互。在升降臺系統(tǒng)工作的過程中,觸摸屏通過RS232串口線和PLC進行通訊,觸摸屏通過調(diào)用相關(guān)的寄存器,觸摸屏便可以實時地得到PLC各個寄存器的狀態(tài),也可以得到PLC通過量綱變換計算出來的高度值,這樣各升降臺的高度便可以如實反饋給人們。當然人們也可以通過觸摸屏對相應(yīng)的數(shù)據(jù)寄存器進行賦值,然后傳送給PLC(如圖5)。
圖2 主站控制
圖3 從站控制
圖4 從站發(fā)送測量脈沖到主站
圖5 觸摸屏界面
多臺升降臺的系統(tǒng)工作是在單臺升降臺工作衍生出來的,也是本多升降臺系統(tǒng)一大特色。多臺升降臺的系統(tǒng)工作的原理在于,通過前面四臺升降臺反饋的高度,進行自身監(jiān)控,自身控制,使得四臺升降臺能保持在同一高度上,進行協(xié)同上升和協(xié)同下降,當然也可以讓四臺升降臺上升至指定的高度,復(fù)位(觸摸屏控制界面如圖6)等。通過整個系統(tǒng)的協(xié)同控制,使得在升降臺的功能更加人性化。在協(xié)同工作的過程中,輸出到計數(shù)器上可以得到上升的增量,在把當前高度和增量相加,可以得到要上升的位置高度。再把得到的位置高度跟4臺升降臺當前高度進行比較,可以讓升降臺上升到該位置。在此,本升降臺系統(tǒng)設(shè)定了高度限制,在到達最高點后不再繼續(xù)上升,這對升降臺起到了一個保護作用。協(xié)同下降同理。除此之外,因為協(xié)同上升和協(xié)同下降都是點動操作,所以本系統(tǒng)也設(shè)置松手后延時一段時間會對相應(yīng)的計數(shù)器和相關(guān)寄存器清零,以便下一次的操作。
當然,本多升降臺協(xié)同控制系統(tǒng)雖然只用4臺升降臺,但是只要PLC的數(shù)量足夠,本系統(tǒng)可以把升降臺的個數(shù)拓展到10幾臺甚至上百臺,從而解決了多升降臺的協(xié)同工作和擴展問題。
圖6 觸摸屏控制界面