駱東松 武曉峰

（蘭州理工大學(xué)電氣工程與信息工程學(xué)院 蘭州 730050）

1 引言

舞臺機械設(shè)備分為臺上設(shè)備和臺下設(shè)備，臺上設(shè)備是整個控制系統(tǒng)中的主要組成部分，而吊桿又是臺上設(shè)備的核心設(shè)備，它控制著道具、幕布和燈具的升降、對開、左移、右移等操作。目前國內(nèi)舞臺機械設(shè)備控制系統(tǒng)多采用傳統(tǒng)的定速控制，這種控制方式在吊桿快速啟停、定位時有很大的機械慣性和機械延時，存在很大誤差，很難滿足系統(tǒng)高精度要求［1～3］。同時在電機啟停時，滾筒卷揚鋼絲繩張力變化劇烈，產(chǎn)生有害沖擊，影響設(shè)備的使用壽命［4～10］。

針對上述問題，本文在Ethernet+PROFI?BUS-DP雙層網(wǎng)絡(luò)下，采用七段式變頻調(diào)速控制實現(xiàn)吊桿的位置和速度檢測的雙閉環(huán)控制。該方法最大化地實現(xiàn)了吊桿無極零速制動，增加了調(diào)速平穩(wěn)性和擴大了調(diào)速范圍，減小了機械慣性和機械延時，降低了對設(shè)備的有害沖擊，使吊桿定位更加精準(zhǔn)，人員操作更加安全［11～17］。

2 舞臺吊桿控制系統(tǒng)

吊桿是舞臺機械控制系統(tǒng)的核心部分，本文主要對吊桿子系統(tǒng)進行分析［18-20］。本系統(tǒng)采用“上位工控機（IPC）+可編程控制器（PLC）+變頻器+交流電機”的運動控制模式，其控制架構(gòu)如圖1所示。

圖1 吊桿控制架構(gòu)圖

操作臺人機交互采用工控機和工業(yè)級觸摸顯示器來實現(xiàn)對系統(tǒng)的監(jiān)控和管理，通過Ethernet與系統(tǒng)主站（西門子S7-400）進行通信，為傳輸當(dāng)前位置、當(dāng)前速度、運行時間、設(shè)備負荷等參數(shù)提供安全保障；系統(tǒng)主站通過PROFIBUS-DP總線與系統(tǒng)從站（多功能變頻器）進行通信，主站下發(fā)指令給變頻器，變頻器帶動交流電機來驅(qū)動吊桿進行相應(yīng)的運動；編碼器輸出信號到變頻器與PLC中，通過脈沖計數(shù)實現(xiàn)速度與位置的反饋，構(gòu)成雙閉環(huán)控制系統(tǒng)。

3 吊桿的雙閉環(huán)控制

操作員通過IPC設(shè)置目標(biāo)位置、目標(biāo)速度和偏差值，通過編碼器進行速度檢測，將當(dāng)前速度反饋給變頻器來實現(xiàn)速度閉環(huán)控制，同時將脈沖計數(shù)反饋給PLC，通過位置計算來確定吊桿運行的當(dāng)前位置，當(dāng)前位置與預(yù)設(shè)減速位置進行比較實現(xiàn)位置閉環(huán)控制。

3.1 吊桿位置閉環(huán)

吊桿的升降控制采用滾筒卷揚鋼絲繩單層纏繞牽引方式，為了避免吊桿在運行到極限位置出現(xiàn)突變數(shù)據(jù)，編碼器采用數(shù)據(jù)值的中間位置作為工作起始位。在吊桿運行過程中，西門子新型分布式I/O設(shè)備ET-200M將編碼器脈沖二進制信息反饋到CPU414-3 PN/DP主控制器，主控制器通過編碼器計數(shù)檢測吊桿位置，經(jīng)過計算得到吊桿當(dāng)前位置。當(dāng)主控制器接收到測量值轉(zhuǎn)換的二進制碼后，調(diào)用

求出吊桿的當(dāng)前位置。

式中C為編碼器輸出的當(dāng)前測量值；Dir為編碼器旋轉(zhuǎn)方向系數(shù)，一般設(shè)置為吊桿上升為1，吊桿下降為-1；S0為吊桿的起始點值；MidP為編碼器中間位置值，該劇場使用的是16位編碼器，MidP=2n-1=216-1=32768，吊桿的起始點設(shè)置在舞臺12500mm，從起始點開始，吊桿升降編碼器均有16384圈連續(xù)工作行程。

當(dāng)?shù)鯒U運行到預(yù)設(shè)減速位置附近（±30mm，預(yù)設(shè)位置值與反饋值的差值）時，PLC立即執(zhí)行變速算法，通過PROFIBUS–DP總線下發(fā)減速命令到變頻器，變頻器驅(qū)動交流電機使吊桿平穩(wěn)運行，達到無級變速，最終在預(yù)定誤差（±3mm）之內(nèi)進行抱閘制動。

3.2 吊桿速度閉環(huán)

傳統(tǒng)定速控制方案存在一定的局限性。本文介紹的是上位機軟件速度控制的方法，可以有效地解決傳統(tǒng)定速控制的不足之處。在變速過程中，系統(tǒng)采用七段式速度控制，如圖2七段式速度給定曲線。

圖2 吊桿速度、加速度曲線

EF段速度曲線v1(t)=vmax-k(t-tE)2是一條拋物線，其中vmax是最大運行速度；其加速度曲線是一條斜線段；

FG段速度曲線是一條斜率為-aF的直線段；其加速度曲線是一條直線段；

GH段速度曲線是一條拋物線；其加速度曲線是一條斜線段。

該七段式速度給定曲線主要應(yīng)用在吊桿制動部分，即對應(yīng)曲線EFGH段，曲線啟動段ABCD與制動段對稱。因為速度和加速度曲線是聯(lián)系變化的，可以求得：

在t=tH時 ，，解得

在t=tG時 ，解 得

由圖2可知：吊桿的速度是平滑無極過渡，加速度也是連續(xù)線性變化，這樣可以避免滾筒卷揚機械設(shè)備纏繞鋼絲繩時受力突變，從而降低機械延時，改善系統(tǒng)的穩(wěn)定性，增加設(shè)備使用壽命。由其對應(yīng)公式可知：速度閉環(huán)控制電機制動時間是由vmax、aF和k決定的，而該劇院吊桿最大運行速度為0.8m/s，最大加速度aF為定值，只要在上位軟件中設(shè)定k的數(shù)值，吊桿的速度控制曲線就會接近理想曲線。

4 吊桿控制的軟件設(shè)計

吊桿的控制系統(tǒng)軟件主要由兩部分組成：1）上位監(jiān)控軟件；2）下位PLC控制程序設(shè)計。IPC用于發(fā)送變速算法計算得出的數(shù)據(jù)給PLC，PLC給變頻器指令，變頻器驅(qū)動交流電機進行無極調(diào)速；給定吊桿的運行模式、目標(biāo)位置、目標(biāo)速度、偏差值等參數(shù)；實時顯示吊桿的當(dāng)前位置、當(dāng)前速度、運行時間、運行負荷等參數(shù)；實時地將吊桿運行的數(shù)據(jù)及參數(shù)進行入庫，為以后的操作、診斷做參照依據(jù)。下位PLC控制程序?qū)崿F(xiàn)吊桿的一些其他邏輯關(guān)系，保證吊桿的啟停動作、定位操作。

4.1 上位監(jiān)控軟件設(shè)計

上位監(jiān)控軟件在Visual Studio 2013平臺運用C#編程技術(shù)進行開發(fā)，設(shè)計整個舞臺的控制界面，編譯舞臺控制系統(tǒng)的代碼。系統(tǒng)主要功能包括登錄操作、裝臺模式、演出模式、故障報警、系統(tǒng)同步等。圖3為舞臺設(shè)備控制畫面。

圖3 舞臺設(shè)備控制畫面

為了滿足設(shè)備傳輸數(shù)據(jù)量大、實時性高的要求，在C/S架構(gòu)之下，IPC與PLC之間通過TCP/IP進行以太網(wǎng)通訊傳輸數(shù)據(jù)。其中，裝臺模式包含設(shè)備設(shè)置、系統(tǒng)狀態(tài)、設(shè)備狀態(tài)等子模塊。設(shè)備設(shè)置可以對所有舞臺設(shè)備進行相應(yīng)的上下目標(biāo)位、偏移量、運行最大速度（%）等進行設(shè)置，他們的默認(rèn)值是其相應(yīng)的最大值；可以選擇運行模式，包括位置模式、速度模式、校準(zhǔn)模式。軟件方便安全地實現(xiàn)單根吊桿和多根吊桿的啟動，停止操作，實現(xiàn)吊桿的單控和集控操作，并且能夠?qū)崟r反饋當(dāng)前吊桿位置。燈具控制部分實現(xiàn)單一燈具的6方向自由度控制，以及實時可視化選取受控。系統(tǒng)狀態(tài)可以讀出系統(tǒng)IO狀態(tài)、網(wǎng)絡(luò)狀態(tài)、搖桿IO狀態(tài)。演出模式可以進行選擇劇目，對劇目進行上移下移排序，不同劇目可以選擇不同場景，編寫場景名稱、場景描述后進行劇目下載，實現(xiàn)不同劇目相應(yīng)設(shè)備的自動運行，節(jié)約了人力資源。

4.2 下位PLC控制程序設(shè)計

舞臺機械設(shè)備控制系統(tǒng)下位PLC控制程序采用西門子TIA Portal V13軟件進行結(jié)構(gòu)化編程。吊桿設(shè)備運行流程圖如圖4所示。

圖4 吊桿運行流程圖

本系統(tǒng)有兩個PLC主站，主站1控制臺上設(shè)備，主站2控制臺下設(shè)備，兩個主站DP口之間要互相通訊傳遞信息，共同完成舞臺系統(tǒng)控制任務(wù)。主站1的DP總線子網(wǎng)“PROFIBUS_1”的地址設(shè)置為2，分 配 IP地 址 192.168.70.201。 在 主 站 1（414-3PN/DP）的 OB1中 調(diào) 用 SFB12，主 站 2（414-3PN/DP）的OB1中調(diào)用SFB13實現(xiàn)兩個PLC之間的S7通訊。如圖5兩個主站變量表。

圖5 主站變量表

5 結(jié)語

本文提出的舞臺吊桿變頻調(diào)速雙閉環(huán)控制方法在工大舞臺吊桿試驗平臺進行了多次吊桿定位監(jiān)控試驗，并且已經(jīng)在敦煌大劇院應(yīng)用。在10次實驗中，吊桿定位在3000mm，七段式變速控制曲線與傳統(tǒng)的定速控制比較，圖6是在兩種控制方式下的位置曲線。

圖6 兩種控制方式實驗數(shù)據(jù)

從圖中看出運行結(jié)果驗證了該方法的可行性與可靠性。使用七段式變速控制算法進行舞臺吊桿的控制，實現(xiàn)了吊桿無極零速制動，極大降低了吊桿運行時的運動慣性和機械延時的定位誤差。

［1］馬軼男，陸玉姣，徐江，等.基于速度位置雙閉環(huán)控制的視軸穩(wěn)定系統(tǒng)設(shè)計［J］.壓電與聲光，2017，39（3）：358-360.

［2］李煒，李青朋，毛海杰，等.舞臺調(diào)速吊桿群同步控制策略研究與仿真［J］.電子技術(shù)應(yīng)用，2014，40（5）：140-142.

［3］趙慶國，胡心科.變速算法在舞臺吊桿控制中的應(yīng)用［J］.工業(yè)儀表與自動化裝置，2012（5）：43-45.

［4］李煒，李青朋，毛海杰，等.變頻技術(shù)在舞臺吊桿定位控制中的應(yīng)用［J］.自動化與儀表，2014，29（11）：65-68.

［5］蔣偉，胡高平，劉妍.舞臺吊桿七段式速度控制策略探討［J］.現(xiàn)代電子技術(shù)，2006，29（5）：73-75.

［6］馬文星，劉浩，劉春寶，等.液力調(diào)速風(fēng)電機組變速恒頻雙模控制［J］.華中科技大學(xué)學(xué)報（自然科學(xué)版），2017，45（3）：105-110.

［7］金怡果，王功釵.基于灰色聚類的直流電機無極調(diào)速的機床主傳動系統(tǒng)優(yōu)化設(shè)計［J］.組合機床與自動化加工技術(shù)，2009（10）：34-38.

［8］李珊珊，李麗蘭，朱云霞.基于雙閉環(huán)控制的柔性直流輸電變流器仿真研究［J］.電氣傳動，2017，47（9）：19-23.

［9］湯子龍，鄭小芳，劉春華.舞臺調(diào)速吊桿同步控制策略研究與應(yīng)用［J］.電氣自動化，2010，32（6）：1-4.

［10］孟憲坤，李明輝，等.基于PLC的舞臺燈光控制系統(tǒng)的設(shè)計與應(yīng)用［J］.陜西科技大學(xué)學(xué)報，2011，29（2）：96-99.

［11］李春，高長水.基于RS485和以太網(wǎng)的舞臺控制系統(tǒng)［J］.機電工程，2015，32（3）：384-388.

［12］Luo Dongsong，Li Zhenen.The research of multi-motor synchronous control based on single neuron PID in the stage［C］//ICECC，2012（2）：3291-3294.

［13］周平，溫林儒，李志俊.基于Profibus-DP總線的網(wǎng)絡(luò)控制轉(zhuǎn)換器的設(shè)計與應(yīng)用［J］.自動化與儀表，2016，31（5）：44-48.

［14］李磊，劉日良，等.基于工業(yè)以太網(wǎng)冗余舞臺控制系統(tǒng)研究［J］.計算機測量與控制，2012，20（9）：2396-2398.

［15］戚磊，韓喆，陳雙，等.S7-1200以太網(wǎng)通信的真空造浪測控系統(tǒng)設(shè)計與實現(xiàn)［J］.工業(yè)儀表與自動化裝置，2016（3）：31-34.

［16］朱保琨，劉廣文.千兆以太網(wǎng)通信端口FPGA設(shè)計與實現(xiàn)［J］.計算機工程與設(shè)計，2016，37（9）：2292-2298.

［17］黃敦華，李勇.基于以太網(wǎng)與PROFIBUS總線的主-從站調(diào)速系統(tǒng)設(shè)計［J］.實驗室研究與探索，2016，35（12）：130-134.

［18］Ashjaei M，Behnam M，Nolte T.SEtSim：A modular simulation tool for switched Ethernet networks［J］.Jour?nal of Systems Architecture，2016，65：1-14.

［19］屈鐵軍，趙禹洲，劉廣東.智能舞臺機械系統(tǒng)設(shè)計［J］.機械工程師，2009（4）：148-148.

［20］殷勁松，蘇磊，黃曉華，等.Profibus總線技術(shù)在舞臺電氣控制系統(tǒng)中的應(yīng)用研究［J］.機電工程，2014，31（12）：1653-1656.