羅繼曼，林巧智，劉 悅，孫曉偉

(沈陽建筑大學(xué) 交通與機械工程學(xué)院，沈陽 110168)

混聯(lián)雕刻機器人的實時綜合監(jiān)測系統(tǒng)研究

羅繼曼，林巧智，劉 悅，孫曉偉

(沈陽建筑大學(xué) 交通與機械工程學(xué)院，沈陽 110168)

為實現(xiàn)混聯(lián)機器人運動實時監(jiān)測，基于以太網(wǎng)RTnet進行了實時綜合監(jiān)測系統(tǒng)研究。采用現(xiàn)場總線技術(shù)，在Linux操作系統(tǒng)環(huán)境下，運用Qt和C++軟件編程，完成多功能測試系統(tǒng)的監(jiān)測和顯示功能。搭建了本測試系統(tǒng)主要硬件和軟件平臺，并給出整個測試系統(tǒng)的工作步驟。本測試界面實現(xiàn)如下功能：將雕刻機器人運動位置、速度、拉力測試的實時結(jié)果用曲線或數(shù)據(jù)等形式動態(tài)顯示于測試界面上，實現(xiàn)了對整個混聯(lián)雕刻機器人運動狀態(tài)的實時測試。

實時；監(jiān)測系統(tǒng)；以太網(wǎng)；Linux

0 引言

傳統(tǒng)的測試系統(tǒng)主要由“測試電路”組成，所具備的功能少，隨著計算機技術(shù)的迅速發(fā)展，測試系統(tǒng)采用以計算機為核心的高精度、高性能、多功能的特點測試系統(tǒng)[1～4]。工業(yè)機器人的實時測試系統(tǒng)，常采用先進的I/O總線和數(shù)字化總線，依據(jù)總線建立測試系統(tǒng)能確保硬件、軟件、系統(tǒng)級的兼容性、互換性、和重構(gòu)性[5～7]。

新型混聯(lián)雕刻機器人有5個自由度，可以完成沿X、Y、Z軸的移動，和繞X、Y軸轉(zhuǎn)動。運動的復(fù)雜性需要搭建實時監(jiān)控與測試系統(tǒng)，能在真實運動情況下或模擬運動情況下對機器人的特性、參數(shù)、功能、可靠性等進行測試和計算，用以完成試驗數(shù)值、狀態(tài)、特性的獲取、傳輸、分析、處理、顯示、報警等功能。本測試系統(tǒng)在Linux操作環(huán)境下，運用Qt編程測試界面，將混聯(lián)雕刻機器人特性參數(shù)，如位置特性，軌跡特性，速度特性，三個主動軸的拉力特性等，以曲線形式或數(shù)據(jù)形式顯示在測試界面，便于工作人員直觀分析研究。為此，本文對混聯(lián)雕刻機器人的實時測試系統(tǒng)進行了研究[8～10]。

1 基于以太網(wǎng)RTnet的實時綜合監(jiān)測系統(tǒng)的特點

以太網(wǎng)(Ethemet)最初源自于1975年美國Xerox公司和Standford大學(xué)建造的一個Z19MbPs的CSMA/CD系統(tǒng)。以太網(wǎng)的飛速發(fā)展使以太網(wǎng)全面應(yīng)用于工業(yè)控制領(lǐng)域成為可能。以太網(wǎng)具有以下優(yōu)點：l)通信速率高。2)應(yīng)用廣泛。以太網(wǎng)是目前應(yīng)用最為廣泛的網(wǎng)絡(luò)通信技術(shù)，幾乎所有的編程語言都支持以太網(wǎng)的應(yīng)用開發(fā),如Java、VisualC十十、VisualBasic等。3)成本低廉。4)易于信息集成。以太網(wǎng)很容易與intemet連接，能實現(xiàn)辦公自動化網(wǎng)絡(luò)與工業(yè)控制網(wǎng)絡(luò)的信息無縫集成。5)可持續(xù)發(fā)展?jié)摿Υ骩11～13]。

以太網(wǎng)產(chǎn)品設(shè)計時，在實時性、材質(zhì)的選用、產(chǎn)品的強度以及適用性等方面能滿足工業(yè)現(xiàn)場的需要。將以太網(wǎng)用于工業(yè)機器人監(jiān)測系統(tǒng)中有以下特點：l)以太網(wǎng)通信實時性強，采用星型網(wǎng)絡(luò)拓撲結(jié)構(gòu)，降低了所有網(wǎng)段和主干網(wǎng)的網(wǎng)絡(luò)負荷，虛擬局域網(wǎng)等新技術(shù)也有助于提高以太網(wǎng)的實時性。2)工業(yè)環(huán)境適應(yīng)性和可靠性。3)工業(yè)以太網(wǎng)協(xié)議，由于工業(yè)控制網(wǎng)絡(luò)不單單是一個完成數(shù)據(jù)傳輸?shù)耐ㄐ啪W(wǎng)絡(luò)，而且還是一個借助網(wǎng)絡(luò)完成控制功能的控制系統(tǒng)。它除了完成數(shù)據(jù)傳輸之外，往往還需要依靠所傳輸?shù)臄?shù)據(jù)和指令，執(zhí)行某些控制計算與操作功能，由多個網(wǎng)絡(luò)節(jié)點協(xié)調(diào)完成控制任務(wù)。由以上特性，以太網(wǎng)在工業(yè)機器人實時綜合測試系統(tǒng)中得到廣泛應(yīng)用[14,15]。

2 混聯(lián)雕刻機器人測試系統(tǒng)搭建

混聯(lián)雕刻機器人測試系統(tǒng)主要由中央控制臺、實時測試仿真單元和控制輸出單元，以及輔助測試裝置組成，混聯(lián)雕刻實時測試系統(tǒng)硬件組成和數(shù)據(jù)流如圖1所示。

圖1 實時測試系統(tǒng)硬件組成和數(shù)據(jù)流

2.1 混聯(lián)雕刻機器人控制系統(tǒng)硬件平臺

2.1.1 混聯(lián)雕刻機器人 NC主機

NC主機是整個測試系統(tǒng)的控制中心，NC主要分為前后臺工作方式，前臺為系統(tǒng)進行加工操作，實時顯示狀態(tài)信息；前臺硬件包括：液晶顯示屏、功能鍵、編程與控制鍵盤、機床操作按鈕、倍率修調(diào)旋鈕以及急停按鈕等組成。后臺進行文本編輯、系統(tǒng)配置、PLC編輯編譯及系統(tǒng)調(diào)試提供顯示界面,其主要硬件包括：PCI卡，PCI卡插槽，PCI卡中嵌入一個Microblaze處理器。前后臺功能切換按鍵即可切換到后臺屏幕，如圖2所示。

圖2 NC控制面板

2.1.2 混聯(lián)雕刻機器人從站單元

從站單元是整個混聯(lián)雕刻機器人測試系統(tǒng)的集散中心，主要硬件有：電源板，計數(shù)器從站單元CNT，I/O從站，計數(shù)器I/O 32路輸入端子板和20路輸出端子板，軸控制站SVSV，手持盒接口。32 路端子板為I/O從站的輸入信號與機床的電氣控制信號之間提供了連接端口。20路輸出端子板為I/O從站的輸出信號與數(shù)控機床的電氣控制信號之間提供了連接端口。雕刻機器人測試系統(tǒng)的從站系統(tǒng)組成如圖3所示。

圖3 從站系統(tǒng)組成

2.1.3 混聯(lián)雕刻機器人傳感器

混聯(lián)雕刻機器人分別在X軸和Y軸裝有SGC-4.2光柵線位移傳感器，在并聯(lián)部分的三條主動鏈L1、L2、L3三根軸上安裝MCL-S2拉壓力傳感器。SGC-4.2光柵線位移傳感器主要應(yīng)用于直線移動導(dǎo)軌機構(gòu)，可實現(xiàn)移動量的精確顯示和自動控制，廣泛應(yīng)用于切削機床加工量的數(shù)字顯示。MCL-S2 系列S式拉力傳感器適用于一些要求精度高的機床。傳感器如圖4所示。

圖4 SGC-4.2光柵線位移傳感器和 MCL-S2拉壓力傳感器

2.2 混聯(lián)雕刻機器人測試系統(tǒng)軟件構(gòu)成

混聯(lián)雕刻機器人測試系統(tǒng)主要由任務(wù)管理軟件、實時測試仿真單元軟件、控制輸出單元軟件，以及顯示終端軟件組成，混聯(lián)雕刻機器人測試系統(tǒng)軟件組成如表1所示。

表1 混聯(lián)雕刻機器人軟件組成

2.2.1 混聯(lián)雕刻機器人任務(wù)管理軟件

任務(wù)管理軟件即為中央控制系統(tǒng)，主要負責(zé)各個子系統(tǒng)的協(xié)調(diào)工作，其功能主要包括系統(tǒng)的初始化，數(shù)據(jù)接收、打包、轉(zhuǎn)發(fā)、模型下載，故障警報等。NC主機軟件也劃分為上下兩層結(jié)構(gòu)，上層是用戶空間的實時檢測界面，下層是內(nèi)核空間的檢測模塊。時任務(wù)通過RTAI提供的FIFO管道和共享內(nèi)存與Linux用戶空間中的進程進行通信，任務(wù)獲取的實時數(shù)據(jù)通過FIFO管道方式傳遞到用戶空間，大量數(shù)據(jù)則運用共享內(nèi)存進行數(shù)據(jù)傳遞。軟件結(jié)構(gòu)以及相應(yīng)的任務(wù)管理軟件任務(wù)數(shù)據(jù)流如圖5所示。

圖5 軟件結(jié)構(gòu)圖和任務(wù)管理軟件數(shù)據(jù)流圖

2.2.2 混聯(lián)雕刻機器人實時測試軟件

混聯(lián)雕刻機器人實時測試軟件主要完成信號采集、信號傳輸，模型仿真計算、信號控制輸出等功能，具有自動和手動兩種控制模式。測控軟件的手動與自動功能可通過任務(wù)管理計算機發(fā)送的指令進行區(qū)分。測控軟件主要功能模塊分為自檢、控制功能、信號采集功能和數(shù)據(jù)通信等，測試軟件的頂層控制流程和數(shù)據(jù)流如圖6所示。

圖6 測控軟件頂層控制流程圖和測試軟件信息數(shù)據(jù)流圖

3 混聯(lián)雕刻機器人測試系統(tǒng)工作步驟

混聯(lián)雕刻機器人測試系統(tǒng)的工作步驟如下：首先對整個測試系統(tǒng)進行初始化，即NC主機中用戶界面和內(nèi)核PCI驅(qū)動初始化。在PCI驅(qū)動程序中，初始化ucLinux系統(tǒng)，獲得大塊物理地址連續(xù)內(nèi)存；初始化socket接口，等待來自用戶空間的命令信息。用戶界面完成主界面的初始化后，獲得用于共享的內(nèi)存初始地址。初始化完畢后，可以根據(jù)用戶命令執(zhí)行具體任務(wù)。

其次，用戶界面發(fā)送命令到最后的執(zhí)行，完成整個過程數(shù)據(jù)信息的采集，傳遞和讀取。首先確定監(jiān)測對象和監(jiān)測結(jié)束條件；啟動用戶空間的SampleThread數(shù)據(jù)拷貝線程等待內(nèi)核空間的命令；實時監(jiān)測模塊接收到命令后，周期線程調(diào)用就緒狀態(tài)的start()，并開始執(zhí)行處于運行狀態(tài)run方法的線程，更新監(jiān)測狀態(tài)信息，并將數(shù)據(jù)拷貝到共享內(nèi)存中，顯示在用戶界面。

再次，子站仿真模塊仿真I/O設(shè)備或伺服電機完成相應(yīng)的通信功能。在太網(wǎng)RTnet一個通信周期里，仿真子站先在XML中查找并復(fù)制屬于本子站的數(shù)據(jù)。然后將上一周期的執(zhí)行結(jié)果寫入XML，并發(fā)送出去。最后根據(jù)接收到的數(shù)據(jù)執(zhí)行命令，如調(diào)用仿真函數(shù)庫中的伺服電機加速減速函數(shù)。

最后，子站通過一個定時器readTimer讀取狀態(tài)信息，太網(wǎng)RTnet將反饋回來的信息傳到共享內(nèi)存中，最終用戶層顯示信息。

4 混聯(lián)雕刻機器人測試系統(tǒng)的實現(xiàn)

4.1 測試界面軟件編程

本混聯(lián)雕刻機器人測試界面開發(fā)是在Linux環(huán)境中進行，主要由于Linux操作系統(tǒng)占內(nèi)存少、精簡、穩(wěn)定、適合開發(fā)等優(yōu)點。測試界面運用Qt使用 C++語言進行編程。

4.2 運行界面測試結(jié)果

混聯(lián)雕刻機器人的測試界面主界面顯示：當(dāng)前混聯(lián)雕刻機器人所處的狀態(tài)，各個關(guān)節(jié)的命令位置、反饋位置、命令速度、實際速度、扭矩等如圖7所示。測試系統(tǒng)基于開放式平臺，能獨立測試不同的特性參數(shù)。目前該測試界面能實現(xiàn)三個功能：1）測試混聯(lián)雕刻機器人刀尖點實時位移曲線；2）測試混聯(lián)雕刻機器人各關(guān)節(jié)以及三根主動軸實時速度曲線；3）測試混聯(lián)雕刻機器人三根主動軸拉力曲線。

圖7 混聯(lián)雕刻機器人的測試主界面

混聯(lián)雕刻機器人的測試功能一包括：乘1、乘5、乘10這三個倍率的實時位移測試曲線界面，取數(shù)頻率為100ms，實現(xiàn)刀尖點實時位移曲線如圖8所示。

圖9 位移分別乘1、乘5、乘10這三個倍率實時測試曲線

混聯(lián)雕刻機器人的測試功能二包括：乘1、乘5、乘10這三個倍率的實時速度測試曲線界面，此測試系統(tǒng)測試的是關(guān)節(jié)X1、Y1、Y2和三根主動軸L1、L2、L3的速度曲線，取數(shù)頻率為100ms，六個速度以不同顏色曲線現(xiàn)實是在一個界面上，易于比較分析如圖10所示。

圖10 速度分別乘1、乘5、乘10這三個倍率實時測試曲線

混聯(lián)雕刻機器人的測試功能三包括：乘1、乘5、乘10這三個倍率的實時拉力測試曲線界面，分別以三個顏色的畫筆在同一張畫布中繪制所測得的三根主動軸L1、L2、L3的拉力曲線，取數(shù)頻率為100ms，便于比較分析三根主動軸拉力情況，如圖11所示。

圖11 拉力分別乘1、乘5、乘10這三個倍率實時測試曲線

測試結(jié)果顯示：實時測試仿真單元信號采集到仿真運算結(jié)束的時間為約1ms～10ms；網(wǎng)絡(luò)通信速率可達100Mbps，站與站間通信距離最大100m，測試精度為0.1mm.。

5 結(jié)論

本文對新型混聯(lián)雕刻機器人實時綜合測試系統(tǒng)進行了研究，搭建了基于現(xiàn)場總線的中央控制臺NC主機、包含實時測試仿真單元和控制輸出單元的從站單元等硬件結(jié)構(gòu)；完成了任務(wù)管理和實時測試仿真單元的軟件編制。綜合測試系統(tǒng)將混聯(lián)雕刻機器人運動過程中的位移、速度、拉力等參數(shù)的測試曲線實時地顯示于測試界面上。得到如下結(jié)論：

1) 混聯(lián)雕刻機器人采用了高分辨率、高精度的檢測元件，應(yīng)用了實時以太網(wǎng)RTnet，并應(yīng)用RTAI，提高了測試系統(tǒng)的實時性。

2) 該混聯(lián)雕刻機器人實時測試系統(tǒng)具有多種性能測試功能，如運動位置特性，軌跡特性，速度特性，三個主動軸的拉力特性等參數(shù)的測量。

3) 用Qt平臺C++軟件開發(fā)的混聯(lián)雕刻機器人性能測試軟件，實現(xiàn)了全菜單式的用戶界面，操作便捷，采用圖形形象地顯示出各種測試結(jié)果的曲線，使得監(jiān)測更加方便。

[1] 宋桃桃.基于實時網(wǎng)絡(luò)數(shù)控系統(tǒng)通信平臺的設(shè)計與實現(xiàn)[D].沈陽：中國科學(xué)院沈陽計算技術(shù)研究所,2008.

[2] 陳磊,馮冬芹,金建祥,褚健,以太網(wǎng)在工業(yè)應(yīng)用中的實時特性研究[J].浙江大學(xué)學(xué)報：工學(xué)版,2004(6).

[3] 陳磊,馮冬芹,金建祥,褚健,以太網(wǎng)在工業(yè)控制中的實時性問題[J].自動化儀表,2003(7).

[4] 王國興,何方.基于以太網(wǎng)的現(xiàn)場總線設(shè)計與實現(xiàn)[J].組合機床與自動化加工技術(shù),2010(4)：60-64.

[5] 史國慶,高曉光,吳勇,等.1553B總線監(jiān)測儀系統(tǒng)軟件設(shè)計[J].火力與指揮控制,2009(6)：143-146.

[6] 王興舉.基于RTAI的數(shù)控系統(tǒng)跟蹤調(diào)試工具的設(shè)計與實現(xiàn)[D].沈陽：沈陽計算技術(shù)研究所,2010.

[7] 杜剛,王寧會.CAN總線網(wǎng)絡(luò)協(xié)議分析儀的軟硬件設(shè)計[J].電工技術(shù)雜志,2003(2)： 20-22.

[8] 燚楊.在Linux下用戶空間與內(nèi)核空間數(shù)據(jù)交換的方式[Z].IBM developerworks,2006.

[9] 蔡志明,盧傳富,李立夏.精通Qt4編程[M].北京：電子工業(yè)出版社,2008.

[10] Jonathan Corbet, Alessandro Rubin,i等,著,魏永明,耿岳,鐘書毅,譯.Linux設(shè)備驅(qū)動程序[M].北京：中國電力出版社, 2006.

[11] J.Santos J.Pedro J.Monteiro P.Pires. Multilayer Optimization of Inverse-Multiplexed 100 Gb/s Ethernet Services over Optical Transport Networks[J].IEEE Conferences,2009：1-8.

[12] Mikolasek Ademaj Racek. Segmentation of standard Ethernet message in the time-trigged Ethernet[J].Emerging Technologies and Factory Automation, 2008.page(s)：392-399.

[13] Shu Xiao;Chaoping Wu;Teganahalli.Design and Implementation of Aggregation Platform for Extended Ethernet Transport and Services[J].Global Telecommunications Conference,2009.IEEE.page(s)：l-7.

[14] M.Chacinski U.Westergren B.illen B.Stoltz L.Thylen.Electrabsorption Modulators Suitable for 100-Gb/s Ethernet[J].Electron Device Letters,IEEE.2008,29(9)：1014-1016.

[15] Andrew Rindos;Steven Woolet; Larry Nicholson. A Performance evaluation of emerging Ethernet technologies：switched/high-speed/full-duplex Ethernet and Ethernet emulation over ATM[J].IBM Corporation.Aug.2009.page(s)：401-404.

Research of hybrid sculpture robot’s real-time monitoring system

LUO Ji-man, LIN Qiao-zhi, LIU Yue, SUN Xiao-wei

TP241

A

1009-0134(2014)05(下)-0025-04

10.3969/j.issn.1009-0134.2014.05(下).07

2014-01-10

遼寧省基金項目（20102185）；沈陽市科技計劃項目（F13-316-1-37）

羅繼曼（1966 -），女，四川雙流縣人，教授，博士，研究方向為機器人技術(shù)，建筑裝備，機械設(shè)計及理論研究，機械制造與機械學(xué)研究等。