侯芮彬,徐世許,肖克,宮志強

(青島大學(xué) 自動化學(xué)院,山東 青島 266071)

0 引言

現(xiàn)在三維太空環(huán)在科技體驗館和游樂場所中得到普遍使用。常見的三維太空環(huán)不具備數(shù)據(jù)記錄功能,不能實時記錄和顯示設(shè)備的運行數(shù)據(jù),導(dǎo)致設(shè)備運行情況不明。實物見圖1,設(shè)備結(jié)構(gòu)如圖2所示。

圖1 三維太空環(huán)

圖2 設(shè)備結(jié)構(gòu)

本文所研究的三維太空環(huán)監(jiān)控系統(tǒng)將保證設(shè)備運行中速度控制精度高,調(diào)速范圍廣,運轉(zhuǎn)過程平穩(wěn),提供了超速等多種報警提示,大大提高了設(shè)備運行的可靠性和安全性。工作人員可以通過觸摸屏,根據(jù)游客的承受能力隨時修改運行速度和運行時間,操作方便靈活,實現(xiàn)了人機交互的功能[1]。

1 監(jiān)控系統(tǒng)總體設(shè)計

監(jiān)控系統(tǒng)包括運動控制系統(tǒng)和上位機監(jiān)視系統(tǒng)兩部分。

1.1 運動控制系統(tǒng)需求分析

控制面板由觸摸屏、啟動按鈕、停止按鈕等組成,實現(xiàn)設(shè)備啟停、手動/自動模式選擇等操作并設(shè)置有聲光報警,實現(xiàn)在出現(xiàn)故障時自動報警功能。本系統(tǒng)擁有信息顯示功能,如實時速度、正轉(zhuǎn)次數(shù)和反轉(zhuǎn)次數(shù)等,同時能夠在觸摸屏上對設(shè)備的運行速度、運行時間等參數(shù)進行調(diào)節(jié),以適應(yīng)不同游客體驗?？刂葡到y(tǒng)硬件結(jié)構(gòu)如圖3所示。

圖3 三維太空環(huán)硬件結(jié)構(gòu)

1.2 上位機監(jiān)視系統(tǒng)需求分析

三維太空環(huán)運行時,上位機實時從控制器獲取參數(shù)。在三維太空環(huán)設(shè)備開機時,監(jiān)視系統(tǒng)可以自動從控制器獲取需要的實時數(shù)據(jù)并從上位機中獲取到具體時間,然后存儲到數(shù)據(jù)庫[2]。系統(tǒng)支持以折線圖形式顯示實時數(shù)據(jù),提高數(shù)據(jù)的可視化,同時用戶可以在網(wǎng)頁端進行數(shù)據(jù)查詢、刪除等操作[3]。

1.3 通信協(xié)議

EtherCAT運行原理如圖4所示,主站可以向從站發(fā)送和接收報文,這種數(shù)據(jù)傳送方式大大提高了傳輸效率,提高了數(shù)據(jù)利用率。系統(tǒng)中EtherCAT通信網(wǎng)絡(luò)主要用于NX運動控制器和伺服驅(qū)動器之間的通信,其中NX運動控制器當作主站,伺服驅(qū)動器當作從站。

FINS協(xié)議的會話有一次請求幀,請求幀中附帶著發(fā)起方的節(jié)點參數(shù)。運動控制器端會確認并將自己的節(jié)點參數(shù)返回給請求方。由FINS Header、FINS Command Code和FINS Command Data組成,詳細結(jié)構(gòu)如圖5和圖6所示。

圖5 FINS指令幀結(jié)構(gòu)

圖6 FINS響應(yīng)幀結(jié)構(gòu)

1.4 關(guān)鍵技術(shù)問題

在系統(tǒng)通信方面,由于在現(xiàn)場需要觸摸屏實時控制,因此采用EtherNet/IP通信協(xié)議實現(xiàn)觸摸屏和運動控制器通信。因為上位機監(jiān)視系統(tǒng)的功能包括從控制器中采集數(shù)據(jù),本系統(tǒng)利用FINS通信方式實現(xiàn)了上位機與控制器通信。因為FINS通信是以EtherNet/IP為基礎(chǔ),所以可以通過EtherNet/IP線纜相連。具體通信流程如圖7所示。

圖7 監(jiān)控系統(tǒng)通信流程

在運動控制方面為保證系統(tǒng)安全可靠,要求三維太空環(huán)運行速度不能太快,必須在后臺限制速度最大值。由于設(shè)備運行時慣性太大,容易導(dǎo)致設(shè)備超速,必須監(jiān)控設(shè)備實時速度。本系統(tǒng)中選擇速度控制+邏輯控制策略控制設(shè)備運行,而且編寫了各部分運動控制程序。

2 運動控制策略

速度控制是指以指定速度連續(xù)移動軸的功能。速度控制過程中,如果多重啟動其他運動控制指令后發(fā)生中斷,則達到目標速度后切換動作[4];邏輯控制是指經(jīng)過程序判斷當前選擇的運行模式和是否滿足其他運行條件,來決定設(shè)備如何運行。

在MC功能模塊中指定目標位置,以達到將伺服驅(qū)動器指定為位置控制模式的目標速度。MC功能模塊依靠指令的分析結(jié)果按一定周期執(zhí)行運動運算,生成針對位置接口單元(脈沖輸出單元)的指令值,生成的指令值為目標位置、目標速度。將生成的指令值當作脈沖串輸出至伺服驅(qū)動器,伺服驅(qū)動器根據(jù)脈沖串的指令值執(zhí)行位置環(huán)控制、速度環(huán)控制。速度控制分析如圖8所示。

圖8 速度控制分析

2.1 NX運動控制器通信配置

本系統(tǒng)采用NX102自帶的以太網(wǎng)端口實現(xiàn)控制器、上位機和觸摸屏之間的有效通信,選擇EtherNet/IP協(xié)議實現(xiàn)控制器和觸摸屏通信,選擇FINS協(xié)議實現(xiàn)上位機和控制器通信,利用1根網(wǎng)線就能夠很簡單地進行通信[5]。

2.2 控制系統(tǒng)軟件設(shè)計

主程序選擇使用常用的順序控制,從三維太空環(huán)設(shè)備的控制要求方面考慮,控制系統(tǒng)程序主要包括手動程序、自動程序、報警輸出程序等設(shè)計。

手動程序主要實現(xiàn)了正轉(zhuǎn)點動、反轉(zhuǎn)點動和回原點3個功能。

自動模式能讓設(shè)備連續(xù)自動旋轉(zhuǎn),簡化工作人員工作量,在自動模式中,設(shè)備能按照工作人員設(shè)置的運行速度、運行時間、總時間、準備時間等參數(shù)運行。

超速報警能保證三維太空環(huán)安全運行,當判斷圈數(shù)是否匹配時,實際圈數(shù)通過安裝在設(shè)備原點的接近傳感器所得,每轉(zhuǎn)1圈會接收1次信號,電機圈數(shù)通過電機所轉(zhuǎn)的角度得到。圈數(shù)差或者速度差大于設(shè)定值后,設(shè)備報警。報警輸出部分程序如圖9所示。

圖9 報警輸出程序

本系統(tǒng)中可以直接通過功能塊獲取運行時間、運行速度等需要傳輸?shù)淖兞恐?而通過功能塊獲取的轉(zhuǎn)矩值變化復(fù)雜,并且變化范圍大,因此需要做一定的處理,再將值傳輸?shù)接|摸屏顯示,以便觀察轉(zhuǎn)矩變化,處理后的轉(zhuǎn)矩為

(1)

式中:Trq,rea為顯示的處理后的轉(zhuǎn)矩值;Trq為通過功能塊獲取的實際轉(zhuǎn)矩值;19Nm為伺服電機額定轉(zhuǎn)矩,除以100是求其百分比。

3 上位機監(jiān)視系統(tǒng)設(shè)計

由于設(shè)備的運行數(shù)據(jù)是通過監(jiān)測伺服電機的運行數(shù)據(jù)所得并存儲在控制器中,因此上位機從控制器中采集數(shù)據(jù)。上位機監(jiān)視系統(tǒng)中設(shè)計了相應(yīng)數(shù)據(jù)庫,以便實現(xiàn)運行數(shù)據(jù)的存儲、刪除、查詢、分析等功能[6]。

3.1 運動控制器數(shù)據(jù)采集

上位機監(jiān)視系統(tǒng)和存儲數(shù)據(jù)的運動控制器之間使用FINS/TCP協(xié)議實現(xiàn)數(shù)據(jù)交互,上位機監(jiān)視系統(tǒng)和運動控制器直接連接在同一局域網(wǎng),從運動控制器中采集數(shù)據(jù),然后把數(shù)據(jù)存儲在數(shù)據(jù)庫并傳輸給上位機。通過FINS指令編程實現(xiàn)運動控制器與上位機的數(shù)據(jù)交互方法經(jīng)過了連接、斷開連接、獲取狀態(tài)、寫入和讀取5步。

3.2 數(shù)據(jù)庫配置

在配置服務(wù)器后建立了相應(yīng)的運行數(shù)據(jù)表,本系統(tǒng)數(shù)據(jù)庫表存儲的數(shù)據(jù)包括游客姓名和設(shè)備的實時速度、實時轉(zhuǎn)矩、旋轉(zhuǎn)方向、運行時間等,游客姓名是工作人員在網(wǎng)頁上輸入之后存儲到數(shù)據(jù)庫,運行數(shù)據(jù)是上位機從控制器中采集獲得。

3.3 上位機程序設(shè)計

軟件程序架構(gòu)可以決定系統(tǒng)程序的主體結(jié)構(gòu)、宏觀特性以及擁有的基本功能,因此,本系統(tǒng)按照具體要求采用了3層架構(gòu),加快了開發(fā)進度,提高了程序合理性。

用戶登錄時需要完成用戶名與密碼的校對,用戶每次進入上位機監(jiān)視系統(tǒng)時會被要求填寫密碼。

在網(wǎng)頁端實現(xiàn)了對數(shù)據(jù)的查詢操作,查詢是上位機監(jiān)視系統(tǒng)的關(guān)鍵功能。查詢結(jié)果從設(shè)定的查詢時間的第一條記錄數(shù)據(jù)開始顯示,查詢完成后會顯示相關(guān)數(shù)據(jù),并且可以導(dǎo)出數(shù)據(jù)保存在計算機上。

4 系統(tǒng)測試結(jié)果

在上位機打開數(shù)據(jù)庫,查詢設(shè)備運行數(shù)據(jù)表,執(zhí)行結(jié)果如圖10所示,由此可以看出設(shè)備啟動瞬間上位機監(jiān)視系統(tǒng)便采集了1次數(shù)據(jù),以后每隔1 s采集1次數(shù)據(jù)。

圖10 三維太空環(huán)運行數(shù)據(jù)表

上位機監(jiān)視系統(tǒng)獲取到設(shè)備運行數(shù)據(jù)并生成折線圖,得到圖11—圖13所示的速度和轉(zhuǎn)矩分析圖。通過圖中的轉(zhuǎn)矩變化折線圖可以得到每個時刻游客受到的沖擊力大小,其中轉(zhuǎn)矩來回波動的情況是三維太空環(huán)上下旋轉(zhuǎn)引起的。由折線圖可以看出,二維、三維交替旋轉(zhuǎn)和三維旋轉(zhuǎn)運轉(zhuǎn)時的轉(zhuǎn)矩要比二維旋轉(zhuǎn)時的轉(zhuǎn)矩要大,說明游客受到的沖擊力在二維、三維交替和三維旋轉(zhuǎn)比二維旋轉(zhuǎn)更大,體驗感更強。

圖11 二維旋轉(zhuǎn)速度和轉(zhuǎn)矩分析

圖12 二維三維交替旋轉(zhuǎn)速度和轉(zhuǎn)矩分析

圖13 三維旋轉(zhuǎn)速度和轉(zhuǎn)矩分析

由圖11—圖13可以看出,在運動控制器、伺服電機和伺服驅(qū)動器的配合下,設(shè)備在進入勻速狀態(tài)后能夠平穩(wěn)地運行,上位機監(jiān)視系統(tǒng)也能夠正常采集和顯示相應(yīng)數(shù)據(jù),從而得出三維太空環(huán)監(jiān)控系統(tǒng)能夠正常運行的結(jié)論。

5 結(jié)語

本文研究了三維太空環(huán)監(jiān)控系統(tǒng),根據(jù)三維太空環(huán)的結(jié)構(gòu)特點、運行情況,對硬件要求和軟件要求進行分析,完成了對設(shè)備運行參數(shù)的實時控制和監(jiān)測。在此基礎(chǔ)上,為了精準控制,采用了基于速度控制+邏輯控制的策略,確保了速度的快速、精確控制。