（接伺服與運動控制第5期）

（4）輸出信號的配置與測試。

在“總線配置”界面上，在左邊的總線節(jié)點樹上雙擊伺服電機驅(qū)動器“MADLN05BE”，看見如圖13所示的界面。在“選擇輸出”欄中選中“Receive PDO mapping1”；然后，點擊下方的“編輯”按鈕，得到圖14所示的PDO編輯界面。

 圖3.9. “專用信號狀態(tài)”頁面

圖3.10. “軸IO狀態(tài)”頁面

圖3.11. 從站的“過程數(shù)據(jù)”頁面

圖3.12. PDO編輯界面 

在“PDO編輯”界面上，點擊“添加”按鈕，進入如圖15所示“PDO項編輯”界面。先后添加兩個數(shù)據(jù)：PhysicalOutputs和Bit Mask，其地址和數(shù)據(jù)類型如圖所示。點擊“確定”，返回“過程數(shù)據(jù)”界面。這時，在“選擇輸出”欄中多出2個數(shù)據(jù)PhysicalOutputs和Bit Mask。

下載配置文件后，在圖12所示界面中可測試通用輸出信號，EX-OUT1對應(yīng)于軸輸出信號的Out16。

圖3.13. PDO項編輯界面 

（5）電機測試。在主頁面上點擊“功能測試”按鈕，進入到如圖16所示界面。在“單軸測試”欄中，進行電機測試。

注意：在點擊“啟動”按鈕之前，必須點擊“單軸使能開”按鈕。

圖3.14. “單軸測試”頁面 

6、用C#編寫程序控制松下伺服電機的方法

下面通過一個例程，演示C#程序控制松下伺服電機的方法。

例程1：

伺服電機的硬件連接及輸入輸出口的定義如圖3.1、3.2所示，電機的參數(shù)設(shè)置如第三章第三節(jié)所示。

程序界面設(shè)計如圖3.15所示，程序代碼見附錄中的例程1。

該程序可實現(xiàn)的功能及編程要點如下：

1. 初始化運動控制卡

總線型運動控制卡的初始化過程與一般脈沖型運動控制卡的一樣，代碼詳見附錄例程1中的函數(shù)Form1_Load(…)。

在伺服電機運動之前要將使能信號打開。其指令為：nmc_set_axis_enable(卡號,軸號);

注意：不要忘記將LTDMC.cs拷貝置項目文件夾中，并在“解決方案”中添加LTDMC.cs；并且要將DMC2410.dll拷貝至項目文件夾中的bin文件夾中的Debug文件夾內(nèi)。

2. 關(guān)閉運動控制卡

關(guān)閉總線型運動控制卡的過程與一般脈沖型運動控制卡的一樣，代碼詳見附錄例程1中的函數(shù)Form1_FormClosing(…)。

關(guān)閉伺服電機的使能信號指令為：nmc_set_axis_disable(卡號,軸號);

3. 點位運動

點位運動的指令與一般脈沖型運動控制卡的一樣，代碼詳見附錄例程1中的函數(shù)button5_Click(…)。

圖3.15. 松下伺服電機測試程序界面 

4. 連續(xù)正反轉(zhuǎn)運動

伺服電機定位精度高。應(yīng)該在運動指令發(fā)送結(jié)束后，再判斷其到位信號INP，以確定電機運動是否停止。代碼詳見附錄例程1中的函數(shù)Check_INP(…)。

讀取電機的輸入口狀態(tài)的指令為：nmc_get_axis_io_in(卡號,軸號);它一次將該電機所有的輸入信號讀入一個無符號32位變量中。判斷到位信號INP，還需要進行一次與運算，將第24位的到位信號INP解析出來，如以下代碼所示。

inINP = LTDMC.nmc_get_axis_io_in(cardID0, 0);

                inINP = inINP & 0x1000000;      // 讀取第24位的到位信號INP

5. Jog運動

Jog運動即為定速運動。按鈕“Jog+”按下后，啟動vmove指令，電機定速運動；按鈕“Jog+”抬起后，啟動減速停止指令，使定速運動停止。代碼詳見附錄例程1中的函數(shù)button1_MouseDown()、button1_MouseUp(…)。

6. 定速運動及在線變速

按下“連續(xù)運動開始”按鈕，電機以設(shè)定的速度連續(xù)運動。之后，每按一次“速度+10%”或“速度-10%”，電機都會進行在線變速。

在線變速的指令為：dmc_change_speed_unit(卡號,軸號,新速度,變速調(diào)整時間);

7. 回原點運動

回原點運動和一般脈沖型運動控制卡的不一樣?；亓隳Ｊ绞?/span>按照IEC61800-7CiA402標準協(xié)議定義的。常用的4種如下：

19號回零方式：電機正方向旋轉(zhuǎn)高速回原點，檢測到原點信號后，低速后退，出零點檢測范圍后停止。

21號回零方式：電機負方向旋轉(zhuǎn)高速回原點，檢測到原點信號后，低速后退，出零點檢測范圍后停止。

20號回零方式：電機正方向旋轉(zhuǎn)低速回原點，檢測到原點信號即停止。

22號回零方式：電機負方向旋轉(zhuǎn)低速回原點，檢測到原點信號即停止。

即在調(diào)用回原點模式設(shè)置函數(shù)nmc_set_home_profile(卡號,軸號,回零模式,回零低速,回零高速,回零加速時間,回零減速時間,回零偏移量)時，其中的“回零模式”要設(shè)為19或21、20、22。

回原點運動的代碼詳見附錄例程1中的函數(shù)button12_Click(…)。

8. 輸出口Output1的控制

電機輸出口的控制指令和輸入口的一樣，也是一次將該電機所有的輸出信號讀出或?qū)懭搿Ｒ虼?，在控制輸出?/span>Output1時，就要對輸出口數(shù)據(jù)的第16位信號進行處理。置1用或運算、清0用與運算。代碼詳見附錄例程1中的函數(shù)checkBox6_CheckedChanged(…)。

9. 查詢輸入口狀態(tài)

輸入口狀態(tài)由定時器定時查詢其變化并顯示其狀態(tài)，定時周期50毫秒。代碼附錄例程1中的詳見函數(shù)timer2_Tick(…)。

10. 編碼器位置顯示與清零

編碼器位置也是由定速器定時查詢與顯示，代碼詳見附錄例程1中的函數(shù)timer2_Tick(…)。

編碼器位置清零的代碼詳見附錄例程1中的函數(shù)button7_Click (…)。

11. 總線狀態(tài)顯示與總線復(fù)位

總線狀態(tài)也是由定速器定時查詢與顯示，代碼詳見函數(shù)timer2_Tick(…)。

當總線狀態(tài)異常時，可以使用指令dmc_cool_reset(0)對總線復(fù)位，同時關(guān)閉運動控制卡；復(fù)位過程需要10秒鐘時間；總線復(fù)位完成后，需要對運動控制卡初始化，直接調(diào)用函數(shù)Form1_Load(sender, e)即可。代碼詳見附錄例程1中的函數(shù)button8_Click(…)。

雷賽EtherCAT總線型步進電機驅(qū)動器

在EtherCAT總線型運動控制系統(tǒng)中，全部使用伺服電機顯然是不合適的。

2016年雷賽智能公司在國內(nèi)首先推出了EtherCAT總線型步進電機驅(qū)動器DM3E系列產(chǎn)品。其外觀與參數(shù)如圖4.1和表4.1所示；其總線參數(shù)如表4.2所示。

其接口電路圖如圖4.2所示，其中CN3為IO接口。IO接口的默認信號如圖4.2所示，也可以更改為其他信號，詳見該產(chǎn)品手冊。

圖4.1. 雷賽EtherCAT步進電機驅(qū)動器外觀

表4.1. DM3E系列驅(qū)動器參數(shù)

表4.2. DM3E系列驅(qū)動器總線參數(shù)

圖4.2. DM3E系列驅(qū)動器接口電路 

DM3E系列驅(qū)動器接入總線的方法很簡單，和松下交流伺服電機的相似。用雷賽Motion軟件，在總線配置界面內(nèi)，通過“掃描設(shè)備”、設(shè)置總線周期時間、下載配置文件，即自動配置完成；然后可進行電機的相關(guān)測試。（參見第三章第5節(jié)）

步進電機的峰值電流、每轉(zhuǎn)脈沖數(shù)（相當于設(shè)置細分數(shù)）等參數(shù)可以通過EtherCAT總線修改DM3E系列驅(qū)動器的對象字典完成。常用參數(shù)如表4.3所示。

表4.3. DM3E系列驅(qū)動器常用參數(shù)

注意：修改參數(shù)后，必須向?qū)ο笞值洌?/span>1010H-04H）寫一個保存命令0x65766173，參數(shù)才能寫入EEPROM，保留在驅(qū)動器中。保存數(shù)據(jù)的時間大約為10秒鐘。

例程2：

圖4.3是一個DM3E系列驅(qū)動器及步進電機的測試程序界面程序，代碼見附錄中的例程2。該程序可實現(xiàn)的功能及編程要點如下：

圖4.3. DM3E系列驅(qū)動器及步進電機測試程序界面 

1. 初始化運動控制卡、關(guān)閉運動控制卡

代碼詳見附錄例程2中的函數(shù)Form1_Load(…)、函數(shù)Form1_FormClosing(…)。

2. 參數(shù)的讀取與設(shè)置

讀對象字典參數(shù)的指令為：

LTDMC.nmc_get_node_od(卡號,EtherCAT端口號,節(jié)點號,對象字典索引,子索引,參數(shù)長度,ref參數(shù));

寫對象字典參數(shù)的指令為：

LTDMC.nmc_set_node_od(卡號,EtherCAT端口號,節(jié)點號,對象字典索引,子索引,參數(shù)長度,參數(shù));

代碼詳見附錄例程2中的函數(shù)button1_Click(…)、函數(shù)button2_Click(…)。

注意：EtherCAT端口號固定為2。

3. 點位運動、Jog運動和回原點運動

運動指令和例程1一樣。代碼詳見附錄例程2中的函數(shù)button3_Click(…)、button5_MouseDown(…)、button5_MouseUp(…)、button4_Click(…)。

4. 讀指令脈沖位置

其指令為：LTDMC.dmc_get_position_unit(卡號,軸號, ref指令位置);

代碼詳見附錄例程2中的函數(shù)timer1_Tick(…)。

雷賽EtherCAT總線型閉環(huán)步進電機驅(qū)動器

雷賽公司于2010年在國內(nèi)首創(chuàng)的閉環(huán)步進電機控制技術(shù)是在普通的步進電機上加裝旋轉(zhuǎn)編碼器、并使用交流伺服電機控制算法，使步進電機的性能有了質(zhì)的飛躍。雷賽閉環(huán)步進電機及驅(qū)動器的特點如下：

1. 步進電機采用1000線編碼器做位置檢測；也可定制5000線編碼器。

2. 對位置偏差實時補償，根本解決了普通步進電機的丟步問題。

3. 轉(zhuǎn)速可達2500rpm，有效力矩比普通步進電機提高30%以上。

4. 振動小、噪聲低，電機運行平穩(wěn)。

5. 電機電流根據(jù)負載大小實時調(diào)節(jié)，所以電機發(fā)熱量小。

6. 電機參數(shù)自動調(diào)整，智能水平高。

雷賽EtherCAT總線型閉環(huán)步進電機驅(qū)動器CL3-EC系列產(chǎn)品的參數(shù)如表5.1所示。

表5.1. 雷賽EtherCAT總線型閉環(huán)步進電機驅(qū)動器參數(shù)

圖5.1. 雷賽CL3-EC系列驅(qū)動器外形 

CL3-EC系列驅(qū)動器總線參數(shù)與雷賽EtherCAT步進電機驅(qū)動器一樣，參見表4.2。

CL3-EC系列驅(qū)動器的接口電路圖如圖5.2所示。圖中CN4接口為數(shù)字IO接口，有7路輸入信號、6路輸出信號；信號可自定義，出廠默認值如圖所示。CN4接口上還有一個專用的抱閘輸出口，驅(qū)動電流高達500mA，并集成了續(xù)流二極管，可以不用繼電器直接驅(qū)動抱閘器。

CL3-EC系列驅(qū)動器驅(qū)動器接入總線的方法和雷賽總線型步進電機的相似。下面以一個CL3-EC507驅(qū)動器為例，介紹其使用方法。

首先，用雷賽Motion軟件，在總線配置界面內(nèi)，通過“掃描設(shè)備”、設(shè)置總線周期時間，可自動找到CL3系列閉環(huán)步進電機驅(qū)動器，但沒有自動完成軸映射，如圖5.3所示。

在圖5.3所示的界面中，點擊“添加”按鈕，手工進行軸映射。過程如圖5.4所示。再點擊圖5.5中的“上移”按鈕，將剛添加的“軸3”上移為“軸1”，如圖5.5所示。

然后下載配置文件，完成配置工作。

至此，圖5.5中的原點信號Home，正負限位信號POT、NOT，到位信號INP、報警信號ALM，通用輸入信號SI-MON1、SI-MON2都可正常使用。

如果要使用圖5.5中的通用輸出口EX-OUT1~EX-OUT4，還需要進行輸出口過程數(shù)據(jù)的設(shè)置，方法如下。

 圖5.2. 雷賽CL3-EC系列閉環(huán)步進電機驅(qū)動器接口電路圖

圖5.3. 掃描設(shè)備后，自動找到CL3系列閉環(huán)步進電機驅(qū)動器

圖5.4. 手工進行軸映射

圖5.5. 完成軸映射 

在Motion軟件的“總線配置”界面左邊的EtherCAT設(shè)備樹中，雙擊“CL3-EC507”，出現(xiàn)圖5.6所示的界面。

選中“ReceivePDO1”，點擊下面的“編輯”按鈕，進入到圖5.7所示界面。點擊“添加”按鈕，進入如圖5.8所示的界面。

圖5.6. 打開從站的“過程數(shù)據(jù)”界面

圖5.7. PDO編輯界面

圖5.8. 添加Physical Outputs和BitMask 

在圖5.8所示的界面中，選擇“DigitalOutputs”，分別添加Physical Outputs和BitMask這兩個數(shù)據(jù)；之后，可在輸出數(shù)據(jù)中看到Physical Outputs和BitMask，如圖5.9所示。最后，還要下載配置文件。

CL3-EC系列驅(qū)動器的通用IO信號與EtherCAT總線軸IO的映射關(guān)系如表5.2所示。控制通用IO信號的指令和松下交流伺服電機例程中的相同。

圖5.9. 完成輸出口數(shù)據(jù)設(shè)置

表5.2. CL3-EC的通用IO信號與總線軸IO的映射關(guān)系 

閉環(huán)步進電機的峰值電流、每轉(zhuǎn)脈沖數(shù)（相當于設(shè)置細分數(shù)）等參數(shù)可以通過EtherCAT總線修改CL3-EC系列驅(qū)動器的對象字典完成。常用參數(shù)如表5.3所示。

注意：編碼器分辨率是編碼器線數(shù)的4倍。如果，采用5000線的編碼器，這編碼器分辨率為20000。和松下交流伺服電機不同，編碼器分辨率不可隨便改動。修改編碼器分辨率后，必須重新啟動驅(qū)動器才能生效。

例程3：

圖5.10是CL3-EC系列驅(qū)動器及閉環(huán)步進電機測試程序的界面。其代碼見附錄中的例程3。

表5.3. CL3-EC系列驅(qū)動器的常用參數(shù)

圖5.10. 閉環(huán)步進電機及驅(qū)動器的測試程序界面 

EtherCAT總線擴展模塊

為了便于客戶組建EtherCAT總線型運動控制系統(tǒng)，雷賽控制公司還研發(fā)了多種功能的EtherCAT總線擴展模塊。如：IO擴展模塊用于IO信號的檢測與控制；定位模塊用于控制脈沖型電機；AD/DA擴展模塊用于模擬信號的采集與控制；編碼器擴展模塊用于編碼器信號檢測。

1、IO擴展模塊

EM32DX-E4模塊可控制16路輸入和16路輸出信號。IO接口采用了光電隔離和濾波電路，抗干擾性能好。EM32DX-E4模塊的外形如圖6.1所示，其接口定義如表6.1所示，其接口電路與雷賽公司的IO控制卡相同，其參數(shù)如表6.2所示。

表6.1. IO接口定義

圖6.1. EM32DX-E4模塊外形

表6.2. IO接口參數(shù)

（未完待續(xù)）