本文以正運動技術(shù)具備專用手輪接口的運動控制器ZMC408CE為例,介紹手輪、手輪的作用及原理、控制器手輪接口接線以及手輪程序配置。
上節(jié)講解了使用正運動basic語言進行手輪應(yīng)用配置,本節(jié)主要講解C++調(diào)用API函數(shù)庫接口實現(xiàn)手輪配置。
01 手輪作用及原理 手輪也稱手搖脈沖發(fā)生器,主要用于數(shù)控機床、立體加工中心、臥式加工中心、龍門加工中心等數(shù)控設(shè)備。當(dāng)手輪旋轉(zhuǎn)時,編碼器產(chǎn)生與手輪運動相對應(yīng)的信號,通過數(shù)控系統(tǒng)選定座標(biāo)并對座標(biāo)進行定位。 手動脈沖發(fā)生器它中心有軸的光電碼盤,其上有環(huán)形通、暗的刻線,搖動手輪后,由光電發(fā)射和接收器件讀取,獲得2組正弦波信號HA、HB,每個正弦波相差90度相位差。由于HA、HB兩信號相差90度,可通過A相在前還是B相在前,給出正轉(zhuǎn)脈沖或反轉(zhuǎn)脈沖去控制伺服電機正轉(zhuǎn)或反轉(zhuǎn)。 ? ? ? 02 手輪介紹
1.通過手輪上的“軸選擇旋鈕”選擇需要移動的坐標(biāo)軸;
2.通過“倍率選擇旋鈕”選擇合適的移動倍(×1/×10/×100);
3.旋轉(zhuǎn)“手輪搖柄”移動坐標(biāo)軸。順時針旋轉(zhuǎn)為正向移動,逆時針旋轉(zhuǎn)為負向移動,旋轉(zhuǎn)速度快慢可以控制坐標(biāo)軸的運動速度;
4.按鈕“急?!保o急停止手輪運動;
5.控制器手輪接口為雙排標(biāo)準(zhǔn)DB15母頭,需要手輪接頭為雙排標(biāo)準(zhǔn)DB15公頭。
03 控制器手輪接口接線
1.硬件介紹
案例采用ZMC408CE運動控制器,具備專用的手輪接口。
ZMC408CE是正運動技術(shù)推出的一款高性能EtherCAT總線運動控制器,核心技術(shù)采用了先進的FPGA技術(shù),實現(xiàn)硬件位置比較輸出、精準(zhǔn)輸出功能,保證連續(xù)軌跡加工的出色性能和穩(wěn)定性,以及動態(tài)數(shù)據(jù)捕獲的實時性,從而實現(xiàn)更加精準(zhǔn)控制和提高生產(chǎn)效率和品質(zhì)。
ZMC408CE支持EtherCAT總線軸 + 脈沖軸混合插補,可脫機或聯(lián)機運行,可控電機軸數(shù)8軸,特殊型號提供16或32軸可選,支持ZDevelop + 多種高級上位機混合編程,可以實現(xiàn)點位運動、電子凸輪、直線插補、圓弧插補、連續(xù)軌跡加工和30+種機器人模型的控制。 ZMC408CE產(chǎn)品亮點 1.高性能處理器,提升運算速度、響應(yīng)時間和掃描周期等;
2.一維/二維/三維、多通道視覺飛拍,高速高精;
3.位置同步輸出PSO,連續(xù)軌跡加工中對精密點膠膠量控制和激光能量控制等;
4.多軸同步控制,多坐標(biāo)系獨立控制等;
5.EtherCAT同步周期可快至125us;
6.EtherCAT總線和脈沖軸混合插補;
7.直線插補、任意空間圓弧插補、螺旋插補、樣條插補等;
8.應(yīng)用靈活,可PC上位機開發(fā),也可脫機獨立運行;
ZMC408CE視頻介紹
2.控制器手輪接口MPG定義
接口 | 引腳號 | 信號 | 說明 |
![]() |
1 | H-5V | 5V電源輸出正極,專為手輪供電 |
2 | HA- | 編碼器A相信號(IN40) | |
3 | HB- | 編碼器B相信號(IN41) | |
4 | HEMGN | 緊急停止信號(IN51) | |
5 | NC | 懸空 | |
6 | HX1 | 選擇X1倍率(IN42) | |
7 | HX10 | 選擇X10倍率(IN43) | |
8 | HX100 | 選擇X100倍率(IN44) | |
9 | HSU | 軸選3(IN48) | |
10 | HSV | 軸選4(IN49) | |
11 | EGND | 5V電源輸出負極,信號公共端 | |
12 | HSW | 軸選5(IN50) | |
13 | HSZ | 軸選2(IN47) | |
14 | HSY | 軸選1(IN46) | |
15 | HSX | 軸選0(IN45) | |
注意: 1.5V電源輸出僅為手輪供電,切勿為其他設(shè)備供電。 2.該接口中的所有信號均為數(shù)字輸入信號,編號為IN(40-51)。 |
3.手輪接線參考
4.注意事項
手輪編碼器軸接口接線原理如上圖所示,手輪廠家的設(shè)計多種多樣,請先查看手輪內(nèi)部的設(shè)計圖后與運動控制器確認正確后謹慎接線;請使用雙絞屏蔽線,尤其是環(huán)境惡劣的場合,務(wù)必使屏蔽層充分接地。
04 函數(shù)接口指令說明 使用ZAux_Direct_Connect命令,將手輪連接到運動軸,指令說明如下表。
指令119 | ZAux_Direct_Connect | ||||||||||
指令原型 | int32 __stdcall ZAux_Direct_Connect(ZMC_HANDLE handle,floatratio,int link_axis,int move axis) | ||||||||||
指令說明 | 同步運動。電子齒輪,將當(dāng)前軸的目標(biāo)位置與idring_axis軸的插補矢量長度通過電子齒輪連接。 | ||||||||||
輸入?yún)?shù) |
|
||||||||||
輸出參數(shù) | / | ||||||||||
返回值 | 成功返回值為0,非0詳見錯誤碼說明 | ||||||||||
指令示例 | 同步運動 | ||||||||||
詳細說明 |
1.連接的是脈沖個數(shù),要考慮不同軸 UNITS 的比例。取消連接時用CANCEL。 2.假設(shè)連接軸0的 UNIST 為100,被連接軸1的 UNITS 為10。 3.使用 ZAux_Direct_Connect連接,比例 ratio 為1,當(dāng)軸0運動s1=100時,軸1運動=s1*UNITS(0)*ratio/UNITS(1),此時運動1000。 4.比率可以通過重復(fù)調(diào)用指令動態(tài)變化。 5.常用于手輪使用。 |
05 C++程序配置
1.配置步驟
(1)參考以上手輪接線示意圖正確連接手輪和控制器; (2)掃描文章末尾二維碼,下載例程,使用Visual Studio 2022,打開C++手輪運動例程,運行之后根據(jù)型號選擇EtherNET、串口、PCI、LOCAL任意一種接口連接控制器。 (3)配置軸號;不同控制器型號,手輪軸號,倍率和軸選擇IN編號不一樣,詳情請參考控制器用戶手冊,本例程使用控制器型號為ZMC408CE,手輪接口軸號為8,該控制器手輪接口無可用默認AXIS軸號,必須進行映射才可以使用,映射避開脈沖軸號,此例程是將手輪映射到軸10。 (4)配置IO;根據(jù)需要賦予軸選(HSX,HSY,HSZ,HSU)和倍率(HX1,HX10,HX100)以及緊急停止 (HEMGN)功能;這些信號本質(zhì)為數(shù)字輸入信號,有固定的編號,但無固定的功能,需要ZDevelop開發(fā);其名稱為推薦配置的功能,軸選即為connect同步運動的被連接軸,倍率即connect比率。
(5)完成以上配置即可開始使用手輪。
2.程序運行界面
程序運行成功后會顯示以下界面,未連接控制器之前,軸坐標(biāo)和手輪軸坐標(biāo)默認為0,手輪狀態(tài)為“未連接”,手輪軸號為10,鏈接倍率為1,手輪軸脈沖方式為“脈沖+方向”,鏈接軸為“未選擇”。
3.控制器鏈接 選擇IP、串口,鏈接到控制器ZMC408CE,鏈接成功,手輪測試則會變成“已連接”,若失敗則會有彈窗“鏈接失敗”點擊確定關(guān)閉彈窗,檢查IP地址或串口地址重新鏈接。
(鏈接成功)
(鏈接失?。?/p>
4.手輪軸操作
程序鏈接上控制器成功之后,會獲取軸坐標(biāo)和手輪軸位置。通過手輪的“軸選擇”旋轉(zhuǎn)按鈕選擇鏈接軸,如果鏈接成功,手輪鏈接狀態(tài)會變成“已鏈接”,鏈接軸也會顯示出所鏈接的軸號和鏈接倍率。 如果想要切換連接軸和鏈接倍率,只需要旋轉(zhuǎn)手輪“軸選擇”按鈕和“倍率選擇”按鈕即可。點擊停止按鈕之后,會自動斷開鏈接,此時手輪的“軸選擇”和“倍率選擇”按鈕處于無效狀態(tài),只有點擊繼續(xù)后才會重新鏈接,建議在鏈接軸之前先選好鏈接倍率,否則可能會出撞機的危險,點擊坐標(biāo)清零則會將X、Y、Z、手輪的坐標(biāo)全部清零。
5.手輪軸軸號修改
此例程的手輪軸軸號綁定到軸10,如果要進行修改,可以在手輪設(shè)置中的手輪軸號,直接進行更改,手輪脈沖方式也是在此處進行修改。
6.手輪軸號映射
不同控制器的默認手輪軸接口不同,具體需要參考控制器手冊,相同點是不管使用哪個型號的控制器都需要重新進行軸映射將手輪軸映射到其他軸號去。
在控制器手冊中找到默認手輪接口軸號,使用ZAux_Direct_SetAtype(handle,重映射的軸號,0)將重映射的軸類型設(shè)置為0,還原軸設(shè)置, ZAux_Direct_SetAtype(handle,要修改的本地脈沖軸號,0)將要修改的本地脈沖軸號軸類型也設(shè)置為0,低版本不設(shè)置會報錯。
使用本地軸映射指令ZAux_Direct_SetAxisAddress{ handle,重映射的軸號,(-1<<16) +要修改的本地脈沖軸號 }。
7.手輪軸參數(shù)配置 軸號映射參數(shù)修改完后,接著使用ZAux_Direct_SetAtype(handle,手輪軸軸號,3/6)進行修改手輪軸的類型,ATYPE=3正交編碼器,ATYPE=6脈沖方向方式的編碼器,設(shè)置好之后可在運行主界面進行切換。
使用ZAux_Direct_SetUnits(g_handle,手輪軸號,脈沖當(dāng)量)根據(jù)實際需求修改手輪軸的脈沖當(dāng)量。
8.建立手輪鏈接
查詢控制器手冊,找到手輪對應(yīng)軸輸入信號、倍率信號、急停信號,使用ZAux_Direct_GetIn(g_handle,輸入口編號,&獲取輸入口的狀態(tài)值)進行IO信號讀取,這里運動軸是X、Y、Z對應(yīng)控制器的0、1、2軸。
通過IO信號的判斷使用同步運動指令ZAux_Direct_Connect(g_handle,鏈接比率,手輪軸,運動軸),進行軸的鏈接、綁定,使用單軸運動停止指令ZAux_Direct_Single_Cancel(g_handle,運動軸,停止模式),斷開軸鏈接。
9.手輪軸位置獲取、清零
建立鏈接之后,需要使用ZAux_Direct_GetMpos(g_handle,手輪軸號,&showpos[手輪軸號])來獲取,手輪軸的當(dāng)前位置,并顯示在界面上。
使用ZAux_Direct_SetMpos(g_handle,手輪軸號,0)進行手輪坐標(biāo)清零。
本次,正運動技術(shù)EtherCAT運動控制器在數(shù)控加工手輪隨動中的應(yīng)用之C++,就分享到這里。
-
接口
+關(guān)注
關(guān)注
33文章
8885瀏覽量
152972 -
API
+關(guān)注
關(guān)注
2文章
1554瀏覽量
63287 -
函數(shù)
+關(guān)注
關(guān)注
3文章
4365瀏覽量
63852 -
C++
+關(guān)注
關(guān)注
22文章
2116瀏覽量
74568
原文標(biāo)題:EtherCAT運動控制器在數(shù)控加工手輪隨動中的應(yīng)用之C++
文章出處:【微信號:伺服與運動控制,微信公眾號:伺服與運動控制】歡迎添加關(guān)注!文章轉(zhuǎn)載請注明出處。
發(fā)布評論請先 登錄
相關(guān)推薦
如何找到DLP4500的API函數(shù)庫和說明手冊?
PS 2接口C 語言通信函數(shù)庫設(shè)計
ZLGCAN接口函數(shù)庫
C++教程之函數(shù)的遞歸調(diào)用
C語言入門教程-函數(shù)庫
PIC單片機的C語言應(yīng)用下的函數(shù)庫
ARM匯編 C語言 C++ 相互調(diào)用
基于GE運動控制器型號及在函數(shù)庫中應(yīng)用
標(biāo)準(zhǔn)C函數(shù)庫的用法

EE-128:C++中的DSP:從C++調(diào)用匯編類成員函數(shù)

LiquidCrystal_I2C函數(shù)庫

ZNetAdv配置函數(shù)庫使用手冊

Java調(diào)用C/C++動態(tài)庫dll操作串口實例

評論