二維“飛貓”控制系統(tǒng)研究

孫立新，陳 幫，孫志龍，高菲菲

SUN Li-xin,CHEN Bang,SUN Zhi-long,GAO Fei-fei

（河北工業(yè)大學(xué) 機械工程學(xué)院，天津 300131）

0 引言

“飛貓”又叫索道攝像承載系統(tǒng)，它承載著攝像機，將拍攝到的畫面，由微波或者光纖信號傳送到地面轉(zhuǎn)播車，實現(xiàn)對于平臺和攝像機的遠程遙控和畫面監(jiān)看，對攝像機對焦、光圈、快門進行遙控，平穩(wěn)的索道使得畫面不會有震顫[1]。按照維數(shù)，“飛貓”可以分為二維“飛貓”和三維“飛貓”，其在超低空拍攝領(lǐng)域應(yīng)用特別廣泛。在北京奧運會期間，利用二維“飛貓”跨越鳥巢，帶來不同的視覺盛宴；在世界杯賽事，采用三維“飛貓”跟蹤球員運動，讓球迷欣賞比賽的同時幫助裁判更好的判罰[2]。

目前國內(nèi)絕大多數(shù)“飛貓”被用在戶外的大場所，如果把“飛貓”應(yīng)用到室內(nèi)演播室，將可以取代搖臂實現(xiàn)多臺攝像機的視覺效果。本文通過可編程邏輯控制器的應(yīng)用研究二維“飛貓”在室內(nèi)演播室的控制系統(tǒng)。

1 “飛貓”結(jié)構(gòu)簡圖及原理

本文介紹二維“飛貓”在室內(nèi)演播室的應(yīng)用。如圖1所示為本裝置的結(jié)構(gòu)簡圖，E是橫桿，長度80厘米，攝像機掛在橫桿正中間，點O為橫桿中點，A，B為兩個定滑輪，A，B間距12米，C，D為兩個滾筒，A，C間距6米，l1，l2分別為左繩長和右繩長。

每個滾筒附近都有一套驅(qū)動器、電機和減速器裝置，該簡圖中沒有畫出，如圖2所示為它們的實物圖。圖2中數(shù)字1是滾筒，2是伺服驅(qū)動器，3是伺服電機，4是減速器。本裝置原理就是控制兩個電機運動，從而控制兩個滾筒收放繩，改變l1，l2的長度，最終實現(xiàn)攝像機在這個平面內(nèi)運動。

圖1 “飛貓”結(jié)構(gòu)簡圖

圖2 滾筒、驅(qū)動器、電機實物圖

2 運動控制系統(tǒng)組成

本系統(tǒng)的控制原理圖如圖3所示。

圖3 系統(tǒng)控制原理圖

搖桿通過模擬量輸入控制可編程控制器（PLC），觸摸屏通過RS232接口與PLC通信，驅(qū)動器與PLC根據(jù)Modbus RTU協(xié)議通過RS485接口相互通信，驅(qū)動器根據(jù)伺服電機上的編碼器的反饋信息控制電機[3]。

2.1 可編程控制器（PLC）

本控制系統(tǒng)的可編程控制器為歐姆龍PLC，編程軟件CX-Programmer，型號CP1H-XA40DT-D，如圖4所示。圖中1為模擬量輸入輸出端口，2是RS232接口，3為RS485接口。

圖4 歐姆龍PLC

該型號內(nèi)存容量20K步，高速計數(shù)器為100KHz，4軸，24點輸入，16點晶體管輸出，分別有4路模擬量輸入，2路模擬量輸出。24V直流電源供電。

2.2 驅(qū)動器和電機

驅(qū)動器是時代超群公司的一款交流伺服驅(qū)動器，型號為DM-08EB，如圖5所示。

圖5 伺服電機驅(qū)動器

編碼器反饋為17位絕對絕對式編碼器。圖5中五位LED顯示和四位按鍵為驅(qū)動器的控制面板，通過四位按鍵可以更改驅(qū)動器內(nèi)部寄存器的值。

CN1為通信端口，支持RS485接口和RS232接口，圖6所示；CN2為控制端口，可以連接可編程控制器和PC等；CN3為編碼器端口，連接編碼器線。

圖6 CN1通信端口

電機型號為80AEA07530-SC3，額定轉(zhuǎn)速3000r/min，額定扭矩2.4N.m，額定功率是0.75KW，是時代超群公司的交流伺服電機。

2.3 搖桿和觸摸屏

搖桿型號為朗弗萊SMC45-2A，采用2軸霍爾傳感器，需要5V直流電源供電，模擬電壓輸出，圖7所示，0到5V的電壓對應(yīng)數(shù)字0到6000，可以在平面內(nèi)360°全方位搖動，放手后彈簧自動復(fù)位。

圖7 模擬量輸出

觸摸屏型號為PWS6710T-P，24V直流電源供電，有RS485和RS232接口。

3 各設(shè)備間相互通信

3.1 PLC與驅(qū)動器之間的通信

PLC和驅(qū)動器都有一個RS485接口，可以采用Modbus RTU協(xié)議并用RS485接口進行通信[4～6]。通信前首先將PLC和驅(qū)動器的通信參數(shù)設(shè)置為相同，本系統(tǒng)采用波特率為115200，8個數(shù)據(jù)位，1個停止位，奇校驗。PLC參數(shù)設(shè)置如圖8所示。

圖8 PLC通信參數(shù)設(shè)置

圖9 驅(qū)動器通信參數(shù)設(shè)置

如圖9所示，通過驅(qū)動器上面的按鍵更改Pn64～Pn67的值，Pn64=2代表用RS485接口，因為要控制兩個驅(qū)動器，兩個驅(qū)動器的通信站點必須要不一樣，否則會出現(xiàn)通信癱瘓，所以Pn65設(shè)置的值要不一樣。Pn66=5代表波特率是115200，Pn67=8代表8個數(shù)據(jù)位，1個停止位，奇校驗。這樣PLC與驅(qū)動器之間的通信參數(shù)就設(shè)置完成了，可以進行通信。下面介紹如何采用Modbus RTU協(xié)議進行RS485接口通信。

3.1.1 讀取多個驅(qū)動器中寄存器

現(xiàn)在需要從站點號為01H的驅(qū)動器上讀取起始地址為0013H開始的2個字，那么可以參考圖10操作。

圖10 讀寄存器

歐姆龍PLC通過RXD指令讀取驅(qū)動器中寄存器地址的內(nèi)容，如圖11所示。

圖11 PLC讀寄存器指令

3.1.2 寫驅(qū)動器中的單個寄存器

寫寄存器的方式跟讀寄存器類似，只是將CMD中的03H改為06H，相應(yīng)的CRC校驗的數(shù)值也改下。歐姆龍PLC通過TXD指令寫入驅(qū)動器中寄存器地址的內(nèi)容。CRC校驗可以利用歐姆龍PLC中功能塊進行編寫，如圖12所示。

圖12 CRC校驗程序

這樣就可以切換電機運行的速度模式和位置模式，控制電機的脈沖數(shù)和速度，停止電機運行等操作。

3.2 其他設(shè)備間通信

搖桿通過電壓模擬量的輸入與PLC進行通信，搖動搖桿時，X軸和Y軸的數(shù)值會在0～6000間變化，這兩個數(shù)值會保存在歐姆龍PLC200和201兩個寄存器。驅(qū)動器與電機連上編碼器線和交流220V電源線并且共地，驅(qū)動器發(fā)送和接受信息給電機。觸摸屏和PLC通過RS232接口通信[7]。

4 “飛貓”的控制

下面介紹如何控制攝像機在二維平面內(nèi)的運動。如圖1所示，以A點為坐標(biāo)原點，AB方向為X軸，AC方向為Y軸，橫桿中心點坐標(biāo)O（x，y）。設(shè)點O在正中間的坐標(biāo)為（x0，y0）只要控制點O的運動，相當(dāng)于控制攝像機的運動。由圖可以得知：

x，y的單位為厘米，l1，l2的單位為毫米，只要知道點O的坐標(biāo)就能知道l1，l2的長度。

設(shè)搖桿參數(shù)在x軸和y軸的值分別為a，b，令：

當(dāng)移動搖桿O0變?yōu)镺1時，l1，l2分別變?yōu)閘1'，l2'，l1=l1'-l1，l2=l2'-l2，令t=400ms，根據(jù)滾筒直經(jīng)D=30厘米，電機與滾筒的減速比為40∶1，算出電機轉(zhuǎn)速n，單位為轉(zhuǎn)每分鐘。

算出兩個電機的轉(zhuǎn)速后，就可以用PLC控制驅(qū)動器讓電機有相應(yīng)的速度。這三個公式可以用歐姆龍PLC功能塊編寫，如圖13、圖14所示。

圖13 公式(1)、式(4)程序

圖14 公式(2)、式(3)程序

所以只要搖桿搖動，橫桿上的攝像機就會到達相應(yīng)的位置，從而達到控制攝像機上下左右運動的目的。

要實現(xiàn)橫桿按照軌跡自動運行，需要將手動運行過程中每隔一段時間采集兩個電機的速度放到相應(yīng)的地址，間隔時間越小越能反映原先的軌跡，本系統(tǒng)間隔時間為200毫秒，這樣就可以把這條軌跡的速度記下來，當(dāng)再次走這條軌跡時，只需將儲存在地址里的速度值發(fā)送給電機，橫桿就會按照設(shè)定的軌跡自動運行。

5 結(jié)語

本系統(tǒng)采用歐姆龍可編程控制器，并用Modbus RTU協(xié)議RS485接口與驅(qū)動器通信；用RS232接口與觸摸屏通信；接受模擬量輸入信號與搖桿通信。本文完整設(shè)計了控制系統(tǒng)的結(jié)構(gòu)，并且實現(xiàn)了系統(tǒng)的運動控制，經(jīng)過一個多月的調(diào)試，攝像機在演播室運動平滑，搖桿控制精確。整個裝置容易維護，操作簡單，性能良好，其最大不足在于有線控制，造成搬運不便。相比較搖臂，“飛貓”可以實現(xiàn)多臺攝像機的視覺效果，應(yīng)用前景廣泛，現(xiàn)已取代搖臂在某個室內(nèi)演播室投入使用。