張 浩,王永泉,陳花玲,徐亞明
(1.西安交通大學(xué)機(jī)械工程學(xué)院,陜西西安 710049;2.大連機(jī)床股份有限公司車床研究所,遼寧大連 116021)
基于LabVIEW的運(yùn)動(dòng)控制卡對(duì)SINAMICS S120控制實(shí)現(xiàn)*
張 浩1,王永泉1,陳花玲1,徐亞明2
(1.西安交通大學(xué)機(jī)械工程學(xué)院,陜西西安 710049;2.大連機(jī)床股份有限公司車床研究所,遼寧大連 116021)
介紹一種面向機(jī)床伺服進(jìn)給運(yùn)動(dòng)控制系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)。該系統(tǒng)基于LabVIEW虛擬平臺(tái)豐富的函數(shù)庫(kù)功能及其與硬件良好的接口性能,以GTS-400-PV-PCI-G型運(yùn)動(dòng)控制卡為核心,通過(guò)西門子擴(kuò)展端子TM41提供的可模擬增量式編碼器接口及模擬量輸入接口,對(duì)西門子新一代產(chǎn)品SINAMICS S120單軸交流驅(qū)動(dòng)器進(jìn)行運(yùn)動(dòng)控制,從而實(shí)現(xiàn)對(duì)1FT6086伺服電機(jī)的實(shí)時(shí)控制。
運(yùn)動(dòng)控制;TM41;LabVIEW;動(dòng)態(tài)鏈接庫(kù)
面向數(shù)控機(jī)床等機(jī)電產(chǎn)品的運(yùn)動(dòng)控制系統(tǒng)的設(shè)計(jì)正日趨模塊化,即基本框架采用運(yùn)動(dòng)控制卡和工控機(jī),外圍設(shè)備采用符合接口標(biāo)準(zhǔn)的伺服驅(qū)動(dòng)系統(tǒng)[1]。這種設(shè)計(jì)模式不僅通用性好、成本低且技術(shù)成熟、穩(wěn)定性好,可有效縮短設(shè)計(jì)周期。筆者選用了西門子新一代產(chǎn)品SINAMICS S120伺服系統(tǒng),正常情況下采用西門子公司配套生產(chǎn)的PLC對(duì)其進(jìn)行運(yùn)動(dòng)控制,成本較高。本研究介紹一種采用固高GTS系列運(yùn)動(dòng)控制卡對(duì)西門子新一代產(chǎn)品SINAMICS S120伺服系統(tǒng)的運(yùn)動(dòng)控制方法。
本項(xiàng)目的運(yùn)動(dòng)控制系統(tǒng)的上位控制器選用工控機(jī),下位控制器則采用了運(yùn)動(dòng)控制器配合伺服驅(qū)動(dòng)器的方式,由上位工控機(jī)對(duì)下位運(yùn)動(dòng)控制器發(fā)送控制命令[2],由下位運(yùn)動(dòng)控制器完成相關(guān)運(yùn)算和運(yùn)動(dòng)控制,再由伺服驅(qū)動(dòng)器按照命令驅(qū)動(dòng)電機(jī),完成定位操作,整個(gè)控制系統(tǒng)硬件連接示意圖如圖1所示。表1為搭建整套系統(tǒng)所需的主要硬件。
表1 控制系統(tǒng)的主要硬件
2.1 西門子SINAMICS S120驅(qū)動(dòng)系統(tǒng)
本控制系統(tǒng)選用西門子SINAMICS S120單軸交流伺服控制器來(lái)完成伺服驅(qū)動(dòng)功能。SINAMICS S120伺服驅(qū)動(dòng)器(以下簡(jiǎn)稱西門子S120)是西門子公司推出的新一代伺服驅(qū)動(dòng)單元,它具有模塊式設(shè)計(jì)的功能[3],并能夠?qū)崿F(xiàn)機(jī)動(dòng)、靈活和高效的驅(qū)動(dòng)控制,同時(shí)還可進(jìn)行快速、可靠的安裝與調(diào)試。它通過(guò)DRIVE-CLIQ通訊電纜進(jìn)行數(shù)據(jù)連接,將V/F控制、矢量控制和伺服控制集于一體,可實(shí)現(xiàn)控制軸的絕對(duì)和相對(duì)定位,具有強(qiáng)大的定位功能,總體性能遠(yuǎn)遠(yuǎn)超過(guò)同類變頻系統(tǒng)。
一套 S120伺服驅(qū)動(dòng)器包括一個(gè)控制單元CU310DP和一個(gè)功率模塊PM340,圖2為該伺服驅(qū)動(dòng)器及相關(guān)配件的電氣接線示意圖。
圖1 控制系統(tǒng)硬件連接
圖2 SINAMICS S120伺服驅(qū)動(dòng)系統(tǒng)接線圖示
2.2 運(yùn)動(dòng)控制卡
運(yùn)動(dòng)控制卡選用固高公司生產(chǎn)的GTS-400-PVPCI-G板卡。該運(yùn)動(dòng)控制卡可以工作于脈沖模式或者模擬量模式,用戶可根據(jù)需要進(jìn)行選擇。本控制系統(tǒng)選擇模擬量控制模式,運(yùn)動(dòng)控制卡最大輸出電壓為±10 V,電壓值的大小對(duì)應(yīng)轉(zhuǎn)速大小,符號(hào)對(duì)應(yīng)轉(zhuǎn)向。使用固高科技提供的 Motion Controller Toolkit 2008運(yùn)動(dòng)控制器管理軟件能夠方便地對(duì)系統(tǒng)硬件資源和軟件資源進(jìn)行組合,來(lái)完成對(duì)系統(tǒng)各個(gè)資源的基本屬性配置[4]。
控制方式選擇半閉環(huán)控制方式[5],控制系統(tǒng)的反饋取自伺服電機(jī)內(nèi)置的增量式編碼器,此控制方式可以補(bǔ)償系統(tǒng)的控制指令誤差,圖3所示為系統(tǒng)半閉環(huán)控制方式的示意圖。
2.3 運(yùn)動(dòng)控制卡與S120伺服系統(tǒng)接線
半閉環(huán)控制方式要求運(yùn)動(dòng)控制卡連接驅(qū)動(dòng)器相對(duì)應(yīng)的接口,具體包括運(yùn)動(dòng)控制器對(duì)伺服電機(jī)編碼器反饋信號(hào)的讀取及運(yùn)動(dòng)控制器輸出的模擬電壓控制信號(hào)兩個(gè)主要部分,但驅(qū)動(dòng)器控制單元CU310DP上并未設(shè)置相應(yīng)的接口,導(dǎo)致運(yùn)動(dòng)控制器不能直接對(duì)CU310DP進(jìn)行控制,所以在控制過(guò)程中需要中間擴(kuò)展單元。在此選用西門子TM41擴(kuò)展端子,TM41包括X520編碼器接口和X523模擬輸入端接口,其中X520編碼器接口將伺服電機(jī)編碼器信號(hào)反饋給運(yùn)動(dòng)控制卡,X523模擬輸入端接口接受來(lái)自運(yùn)動(dòng)控制卡經(jīng)過(guò)計(jì)算后輸出的模擬電壓控制信號(hào),具體連線圖如圖4所示。
圖3 半閉環(huán)控制方式示意圖
圖4 運(yùn)動(dòng)控制卡與TM41接口連線圖示
3.1 S120驅(qū)動(dòng)系統(tǒng)的硬件組態(tài)與優(yōu)化
上位機(jī)與S120的通訊方式有兩種,DP通訊卡或RS232的連接方式,其中RS232通訊方式需上位機(jī)配有RS232接口,采用標(biāo)準(zhǔn)的RS232電纜,在西門子Starter調(diào)試軟件中選定相應(yīng)的串口通訊方式即可。在硬件接線正確情況下,在Starter軟件中插入驅(qū)動(dòng)裝置后選擇在線項(xiàng)目,本系統(tǒng)為集成DRIVE-CLIQ接口的電機(jī),可通過(guò)自動(dòng)組態(tài)的方式將電機(jī)與編碼器等硬件的數(shù)據(jù)讀出再通過(guò)軟件進(jìn)行控制調(diào)試[6]。
版本V2.5以上的SINAMICS S120為用戶提供了自動(dòng)優(yōu)化功能(Automatic controller setting),通過(guò)自動(dòng)優(yōu)化功能可以識(shí)別電流環(huán)、正負(fù)向負(fù)載測(cè)量、自動(dòng)設(shè)置速度環(huán)參數(shù)等,自動(dòng)優(yōu)化后可使伺服電機(jī)在更優(yōu)的狀態(tài)下進(jìn)行工作。
3.2 擴(kuò)展端子TM41的配置
在硬件連接及軟件調(diào)試完畢之后,需要對(duì)TM41擴(kuò)展端子進(jìn)行配置才能完成對(duì)西門子S120伺服系統(tǒng)的運(yùn)動(dòng)控制,具體設(shè)置的步驟如下:
(1)TM41模擬輸入(Analog Input)設(shè)置
TM41的模擬輸入接口連接到SERVO_02軸的p1155參數(shù),即轉(zhuǎn)速控制參數(shù),代表SERVO_02軸的轉(zhuǎn)速控制來(lái)自外部的模擬電壓輸入,如圖5所示,在圖5中界面點(diǎn)擊Scaling選項(xiàng),可設(shè)置輸入電壓范圍值,本系統(tǒng)輸入電壓范圍為±10 V。
圖5 TM41的X523接口設(shè)置
(2)TM41脈沖模擬編碼器(Pulse encoder simulation)設(shè)置
TM41的Master Value接口連接到SERVO_02軸的r63參數(shù),即轉(zhuǎn)速實(shí)際值,TM41在讀取到SERVO_ 02軸的轉(zhuǎn)速之后可輸出模擬增量式編碼器信號(hào),在此接口可讀取符合RS422標(biāo)準(zhǔn)的運(yùn)動(dòng)控制卡能夠讀取的正交編碼器信號(hào),具體設(shè)置如圖6所示。
圖6 TM41的X520接口設(shè)置
(3)TM41及SERVO_02軸的使能設(shè)置
在Starter軟件中,參數(shù) p840代表指令“ON/ OFF”,分別設(shè)置TM41及SERVO_02軸參數(shù)p840的信號(hào)源為TM41的X522數(shù)字量輸入接口DI 0和DI 1,如圖7所示,在DI 0和DI 1接通之后TM41及SERVO_02軸即處于使能狀態(tài)。
圖7 TM41及SERVO_02軸的使能參數(shù)設(shè)置
即TM41參數(shù)設(shè)置完畢,可進(jìn)行運(yùn)動(dòng)控制調(diào)試。
4.1 動(dòng)態(tài)鏈接庫(kù)(DLL)的調(diào)用
GTS-400-PV-PCI-G運(yùn)動(dòng)控制卡提供Windows系統(tǒng)環(huán)境下的動(dòng)態(tài)鏈接庫(kù)(Dynamic-Link-Library, DLL)[7],庫(kù)中包含了對(duì)運(yùn)動(dòng)控制器讀寫(xiě)的全部函數(shù),針對(duì)LabVIEW調(diào)用DLL的特點(diǎn)和運(yùn)動(dòng)控制的復(fù)雜性,DLL中包含多個(gè)可供調(diào)用的函數(shù)。這些函數(shù)都調(diào)用運(yùn)動(dòng)控制函數(shù)庫(kù)中的一個(gè)或多個(gè)函數(shù),DLL中每個(gè)可供調(diào)用的函數(shù)都對(duì)應(yīng)著某一具體任務(wù),稱其為功能函數(shù)。但由于LabVIEW為圖形化編程環(huán)境,所以必須將動(dòng)態(tài)鏈接庫(kù)中的函數(shù)全部轉(zhuǎn)換為在LabVIEW環(huán)境下可以使用的函數(shù)形式。
4.2 運(yùn)動(dòng)控制程序?qū)崿F(xiàn)
本系統(tǒng)選用的運(yùn)動(dòng)控制卡可以對(duì)伺服電機(jī)的運(yùn)動(dòng)軌跡進(jìn)行不同類型的規(guī)劃,采用模擬量控制模式,可進(jìn)行T形曲線和S形曲線或電子齒輪模式等運(yùn)動(dòng)方式,設(shè)置運(yùn)動(dòng)中的PID參數(shù)[8],采用固高科技有限公司GTS系列運(yùn)動(dòng)控制器和LabVlEW調(diào)用DLL進(jìn)行電動(dòng)機(jī)運(yùn)動(dòng)軌跡編程控制,調(diào)用固高科技有限公司開(kāi)發(fā)的函數(shù)庫(kù),完成對(duì)電動(dòng)機(jī)不同規(guī)劃軌跡的控制功能。如圖8所示為使用LabVIEW2011軟件編寫(xiě)的伺服電機(jī)速度T形曲線運(yùn)動(dòng)控制程序。
圖8 采用LabVIEW編寫(xiě)的速度T形曲線控制程序
本控制系統(tǒng)已成功應(yīng)用于滾珠絲杠副綜合性能測(cè)試試驗(yàn)臺(tái),現(xiàn)已正常運(yùn)行并可投入生產(chǎn)。實(shí)踐表明此控制系統(tǒng)穩(wěn)定性和可靠性較高,能準(zhǔn)確實(shí)現(xiàn)對(duì)伺服電機(jī)的實(shí)時(shí)控制。
[1] 朱曉明,徐 巖,齊海龍,等.四軸轉(zhuǎn)臺(tái)系統(tǒng)軟件功能設(shè)計(jì)[J].機(jī)床與液壓,2010,38(8):78-80.
[2] 崔 延,張?bào)阍?基于GT運(yùn)動(dòng)控制卡的數(shù)控雕刻機(jī)系統(tǒng)研究[J].機(jī)械研究與應(yīng)用,2011(5):130-132.
[3] 郁林聰,吳 達(dá).基于SINAMICS S120的變速器試驗(yàn)臺(tái)加載控制系統(tǒng)設(shè)計(jì)[J].制造業(yè)自動(dòng)化,2010,32(10):219-220.
[4] 固高科技(深圳)有限公司.GTS系列運(yùn)動(dòng)控制器編程手冊(cè)[Z].2011.
[5] 劉彥鵬.運(yùn)動(dòng)控制新技術(shù)及應(yīng)用[J].裝備制造技術(shù),2009(8): 124-126.
[6] 西門子(中國(guó))有限公司.SINAMICS S120調(diào)試手冊(cè)[Z].2010.
[7] 龍華偉,顧永剛.LabVIEW8.2.1與DAQ采集[M].北京:清華大學(xué)出版社,2008.
[8] 陶永華.新型PID控制及其應(yīng)用[M].北京:機(jī)械工業(yè)出版社,2005.
Realization of Motion Control for SINAMICS S120 Using Motion Control Card Based on LabVIEW
ZHANG Hao1,WANG Yong-quan1,CHEN Hua-ling1,XU Ya-ming2
(1.School of Mechanical Engineering,Xi'an Jiaotong University,Xi'an Shanχi 710049,China;
2.Institute of Lathe,Dalian Machine Tool Group Crop,Dalian Liaoning 116021,China)
The design and implementation of a kind of general motion control system towards machine tool is introduced.The system is based on the rich function library and a good performance of interface with hardware of LabVIEW virtual instrument.Using Googol's GTS-400-PV-PCI-G type motion control card as the core,through the expansion terminals TM41 of Siemens which can provide simulated incremental encoder interface and analog input interface,enabling the motion control for new generation of products for Siemens SINAMICS S120 single-axis AC drives,then the real-time control of 1FT6086 servo motor is realized.
motion control;TM41;LabVIEW;DLL
TH12
A
1007-4414(2013)05-0171-03
2013-07-29
“高檔數(shù)控機(jī)床與基礎(chǔ)制造裝備”科技重大專項(xiàng);“CL/DL系列中高檔數(shù)控車床滾動(dòng)功能部件應(yīng)用示范工程”資助(編號(hào): 2012ZX04011022)
張 浩(1989-),男,遼寧阜新人,在讀碩士,主要從事對(duì)滾珠絲杠性能測(cè)試方面的研究工作。