|

本文主要介紹正運動技術EtherCAT控製器在多通道視覺飛拍與多點精準輸出上的應用,采用高性能ZMC408CE控製器,控製器內部高速FPGA實現硬件位置比較輸出、精準輸出功能,實現運動控製+多通道視覺飛拍與精準輸出功能。
一.硬件介紹
ZMC408CE是正運動推出的一款多軸高性能EtherCAT總線運動控製器,具有EtherCAT、EtherNET、RS232、CAN和U盤等通訊接口,ZMC係列運動控製器可應用於各種需要脫機或聯機運行的場合。

ZMC408CE支持8軸運動控製,最多可擴展至32軸,支持直線插補、任意圓弧插補、空間圓弧、螺旋插補、電子凸輪、電子齒輪、同步跟隨等功能。
ZMC408CE支持8軸運動控製,可采用脈衝軸(帶編碼器反饋)或EtherCAT總線軸,通用IO包含24個輸入口和16個輸出口,部分IO為高速IO,EtherCAT最快100us的刷新周期。
ZMC408CE支持8個通道的硬件比較輸出、硬件定時器、運動中精準輸出,還支持8通道PWM輸出,對應的輸出口為OUT0-7,支持8個通道同時觸發硬件比較輸出,用於多通道的視覺飛拍場合等。
ZMC408CE支持PLC、Basic、HMI組態三種編程方式。PC上位機API編程支持C#、C++、LabVIEW、Matlab、Qt、Linux、VB.Net、Python等接口。

ZMC408CE內置高精度PSO位置同步輸出功能,在加工圓角與曲線時即使進行有減速調整,在高速加工的場合中也能控製激光輸出的等間距輸出。
ZMC408CE的PSO功能如何實現視覺飛拍,請參見下文說明和參考例程。
二.視覺飛拍
針zhen對dui傳chuan統tong的de視shi覺jiao定ding拍pai,生sheng產chan效xiao率lv不bu夠gou高gao問wen題ti,在zai一yi些xie應ying用yong場chang合he,越yue來lai越yue多duo的de使shi用yong視shi覺jiao飛fei拍pai來lai完wan成cheng視shi覺jiao拍pai照zhao功gong能neng。即ji機ji構gou按an照zhao既ji定ding的de軌gui跡ji運yun動dong,當dang運yun行xing到dao拍pai照zhao點dian時shi,運yun動dong軸zhou不bu停ting,瞬shun間jian完wan成cheng飛fei行xing抓zhua拍pai的de功gong能neng。整zheng個ge過guo程cheng中zhong移yi動dong機ji構gou不bu停ting止zhi,從cong而er節jie省sheng機ji構gou運yun行xing時shi間jian,滿man足zu效xiao率lv,並bing且qie能neng保bao證zheng運yun行xing精jing度du。
(1)在精度保證的同時,可以不減速,v-t圖如下。

(2)在精度不足的情況下,可以略微降速,分段運行,但速度不降為0,v-t圖如下。

三.PSO觸發飛拍
為保證視覺飛拍的精度,需要在高速運動的場合完成觸發拍照,通過控製器的PSO功能可高速連續的觸發輸出,並使得觸發飛拍信號之後,輸出口能在一個脈衝內響應。
PSO功能由HW_PSWITCH2硬件比較輸出指令實現。
PSO(position synchronized output)即位置同步輸出,本質是通過采集實時的編碼器反饋位置(無編碼器可使用輸出的脈衝位置)與比較模式設定的位置進行比較,控製OP高速同步輸出信號,PSO示意圖如下。

PSO一般與激光器(或點膠噴射閥等設備)同步輸出信號進行相位同步,在運動軌跡的所有階段以恒定的空間(或者恒定時間)間隔觸發輸出開關,包括加速、減速和勻速段,從而實現脈衝能量均勻地作用在被加工物體上。
PSO功gong能neng的de特te點dian就jiu是shi能neng高gao速su且qie穩wen定ding的de輸shu出chu信xin號hao,因yin為wei輸shu出chu精jing度du足zu夠gou高gao,所suo以yi能neng夠gou在zai整zheng個ge運yun動dong軌gui跡ji中zhong以yi固gu定ding的de距ju離li觸chu發fa輸shu出chu信xin號hao而er不bu用yong考kao慮lv總zong體ti速su度du。
jizaizhixianbufenyihenkuaidesuduyundong,erzaiyuanjiaobufenjiansudetongshiyenengbaozhengshuchujianjuhengding,tongchangyuanjiaojiagongbufenzaizhenggejiagongguochengzhongzhanyoubijiaoxiaodebufen,zheyangzaibaozhengjiagongxiaoguodetongshi,jiukeyizuidaxianduditigaochanneng。

ZMC408CE運動控製器的PSO功能能應用在轉盤視覺篩選機上,高速控製視覺飛拍篩選,高精度點膠加工,高精度激光加工等應用優勢如下:
(1)可實時控製轉盤,記錄編碼器的反饋位置;
(2)高速輸入口接傳感器,感應並記錄零件來料位置;
(3)PSO硬件位置比較輸出可接2-8個相機進行視覺飛拍、檢測和測量;
(4)PSO硬件位置比較輸出可接吹氣口,對視覺的檢測結果進行相應篩選分類。

通過振動盤將零件輸送到高透明玻璃轉台,其次通過傳感器去感應來料的零件,再通過ZMC408CE的(de)高(gao)速(su)鎖(suo)存(cun)輸(shu)入(ru)口(kou)記(ji)錄(lu)來(lai)料(liao)的(de)實(shi)際(ji)位(wei)置(zhi),當(dang)轉(zhuan)盤(pan)轉(zhuan)動(dong)到(dao)視(shi)覺(jiao)檢(jian)測(ce)工(gong)位(wei)時(shi),控(kong)製(zhi)器(qi)通(tong)過(guo)高(gao)速(su)輸(shu)出(chu)口(kou)觸(chu)發(fa)相(xiang)機(ji)拍(pai)照(zhao),然(ran)後(hou)進(jin)行(xing)圖(tu)像(xiang)處(chu)理(li)運(yun)算(suan),最(zui)後(hou)根(gen)據(ju)預(yu)設(she)的(de)標(biao)準(zhun)檢(jian)測(ce)條(tiao)件(jian)進(jin)行(xing)自(zi)動(dong)檢(jian)測(ce)篩(shai)選(xuan),並(bing)剔(ti)除(chu)不(bu)良(liang)品(pin)。

如需谘詢轉盤視覺篩選應用,請聯係正運動技術相關人員。
四.PSO功能實現指令
觸發連續視覺飛拍的命令是HW_PSWITCH2,HW_PSWITCH2主要用於設定觸發模式和比較輸出的位置,部分模式可搭配HW_TIMER硬件定時器使用,精準控製輸出時刻。
1.HW_PSWITCH2--總線硬件位置比較輸出
HW_PSWITCH2(1,opnum,opstate,tablestart,tableend[,direction])
此指令模式很多,適用於不同的場合,支持一維二維三維的比較,本文主要以TABLE比較點的模式1和模式3展開說明,其他模式參見Basic編程手冊。
每個軸均有各自的硬件比較輸出緩衝區。
讀取語法:Buff = HW_PSWITCH2([axisnum])
(1)Mode=1:單軸比較
mode:1-啟動比較器
opnum:對應的輸出口
opstate:第一個比較點的輸出狀態
tablestart:第一個比較點絕對坐標所在TABLE編號
tableend:最後一個比較點絕對坐標所在TABLE編號
direction:第一個點判斷方向,0坐標負向,1坐標正向,-1不使用方向
此模式較為簡單,需要借助TABLE寄存器,把需要比較輸出的位置坐標先存儲到TABLE寄存器,然後PSO控製OP口每到達一個比較點的位置便反轉一次,直到全部坐標點比較完成。示意圖如下,P表示比較點,展示六個比較點的OP輸出情況。

(2)Mode=2:清除比較點
HW_PSWITCH2(2)
mode:2-停止並刪除沒完成的比較點
使用前需要調用此模式,清除可能沒有比較完成的數據。使用過程中也可以發送此命令,停止比較。
(3)Mode=3:矢量比較方式
mode:3-啟動比較器
opnum:對應的輸出口
opstate:第一個比較點的輸出狀態
tablestart:第一個比較點VECTOR_MOVED所在TABLE編號
tableend:最後一個比較點VECTOR_MOVED坐標所在TABLE編號
說明:比較點寫在TABLE中,每到達一個比較矢量位置OP反轉一次。
使用矢量距離比較時,與VECTOR_MOVED進行比較,建議連續運動前設置VECTOR_MOVED初始值。

2.HW_PS2AXISNUM--設置PS2軸號
HW_PS2AXISNUM(axisnum1)=axisnum2
axisnum1:緩衝軸號
axisnum2:實際操作的軸號
HW指令有單獨的緩衝區,此指令用於把沒有使用的軸的HW_PSWITCH2緩衝重複利用起來,指向當前運動的主軸,,可以對當前的主軸同時做多個比較。
3.VECTOR_MOVED--當前運動距離
VECTOR_MOVED=VAR
參數:VAR返回軸當前運動的距離,units單位。
對多軸插補是矢量距離,使用之前最好手動清零,使用模式3前注意此指令的初始值設置是否正確。
五.單軸多通道PSO視覺飛拍
單軸多通道PSO視覺飛拍是在單軸運動過程中運動到指定位置觸發多個不同相機進行飛拍,觸發位置來源可以是自行設定也可以通過傳感器鎖存抓取。
飛拍需要支持硬件位置比較輸出、精準輸出功能以及帶多個獨立HW通道的控製器,ZMC408CE有8個獨立的HW通道,可以同時給相機輸出信號觸發飛拍采集。

程序示例:OUT(0)和OUT(1)同時輸出。
RAPIDSTOP(2)
WAIT IDLE(0)
BASE(0)
ATYPE=1 '脈衝軸類型,比較需求位置DPOS
'ATYPE=4 '帶編碼器的脈衝軸類型,比較編碼器的位置MPOS
UNITS=5000
ACCEL=1000
DECEL=1000
SPEED=100
SRAMP=50
DPOS=0
MPOS=0
OP(0,OFF)
OP(1,OFF)
AXIS_ZSET(0)=19 '編碼器精準輸出
HW_PS2AXISNUM(1)=0 '將軸1緩衝指向軸0,-1取消
HW_PS2AXISNUM(0)=0 '將軸0緩衝指向軸0,-1取消
HW_PSWITCH2(2) AXIS(0) '清空軸0比較點
HW_PSWITCH2(2) AXIS(1) '清空軸1比較點
TABLE(0,50,52,75,77,100,102,125,127,150,152,175,177) '設置比較點的table列表
TABLE(20,50,52,60,62,70,72,80,82,100,101,130,131,140,141) '設置比較點的table列表
HW_PSWITCH2(1,0,1,0,11,1) AXIS(0) '硬件位置比較輸出,針對OUT(0)
HW_PSWITCH2(1,1,1,20,33,1) AXIS(1) '硬件位置比較輸出,針對OUT(1)
TRIGGER '觸發示波器
MOVEABS(200)
END
示波器波形如圖所示:采樣4個通道的波形,依次為軸0的目標位置、軸0的速度、輸出口0、輸出口1。
輸出0跟輸出1支持同時進行比較輸出,互相不幹擾,均參考軸0的位置輸出。

六.多軸多通道PSO視覺飛拍
多軸多通道PSO視覺飛拍主要應用於多個相機在多軸插補運動時需要多點PSO視覺飛拍的情況。
zaixiangmuzhongchangchangxuyaodeshizaichabuzhixianhuochabuyuanhuguijishangjinxingbijiaoshuchu,zhegeshihouruguojiangchabuguijichaifenchengduiyingdegegezhouzuobiaoshuju,yunsuanlianghuifeichangda,bufuheshijiyingyong。
所(suo)有(you)對(dui)於(yu)多(duo)軸(zhou)位(wei)置(zhi)比(bi)較(jiao)觸(chu)發(fa)飛(fei)拍(pai)時(shi),我(wo)們(men)常(chang)常(chang)會(hui)使(shi)用(yong)插(cha)補(bu)運(yun)動(dong)矢(shi)量(liang)合(he)成(cheng)距(ju)離(li)來(lai)確(que)定(ding)整(zheng)個(ge)插(cha)補(bu)運(yun)動(dong)坐(zuo)標(biao)位(wei)置(zhi),在(zai)這(zhe)個(ge)坐(zuo)標(biao)上(shang)設(she)置(zhi)比(bi)較(jiao)點(dian)位(wei)置(zhi)進(jin)行(xing)比(bi)較(jiao)。
程序示例:OUT(0),OUT(1)各自同步軸0,軸1多軸插補的PSO輸出。
RAPIDSTOP(2)
WAIT IDLE(0)
WAIT IDLE(1)
BASE(0,1)
ATYPE=1,1
UNITS=1000,1000
ACCEL=1000,1000
DECEL=1000,1000
SPEED=100,100
SRAMP=50,50
MERGE=1 '開啟連續插補
DPOS=0,0
MPOS=0,0
OP(0,OFF)
OP(1,OFF)
VECTOR_MOVED=0
AXIS_ZSET(0)=19 '編碼器精準輸出
HW_PS2AXISNUM(1)=-1 '取消設置
HW_PS2AXISNUM(1)=0 '設置PS2軸號,將軸1緩衝指向軸0
HW_PSWITCH2(2) AXIS(0) '清空軸0比較點
HW_PSWITCH2(2) AXIS(1) '清空軸1比較點
TABLE(0,50,52,75,77,100,102,125,127,150,152,175,177) '設置比較點的table列表
TABLE(20,50,55,80,88,100,102,130,135,160,162,175,180) '設置比較點的table列表
HW_PSWITCH2(3,0,1,0,11) AXIS(0) '硬件位置比較輸出,針對OUT(0)
HW_PSWITCH2(3,1,1,20,31) AXIS(1) '硬件位置比較輸出,針對OUT(1)
TRIGGER '觸發示波器
BASE(0,1) '兩軸插補
MOVEABS(40,40) '直線插補
MOVECIRCABS(40,-40,40,0,1) '圓弧插補
MOVEABS(0,0) '直線插補
END
示波器波形如圖所示:采樣4個通道的波形,依次為軸0的目標位置,軸1的目標位置、輸出口0、輸出口1。
輸出0跟輸出1在不同的位置同時進行比較輸出,每到一個比較點位置輸出口反轉一次,總共比較12次,每次輸出脈衝寬度控製在2個脈衝內均支持。
YT模式:數據隨時間變化。

XY模式:兩軸合成插補軌跡。

XYZ模式:三通道數據合成軌跡,OP(0)隨XY軸合成矢量距離變化情況。

XYZ模式:三通道數據合成軌跡,OP(1)隨XY軸合成矢量距離變化情況。

本次,正運動技術運動控製器八通道PSO的視覺飛拍與精準輸出,就分享到這裏。
更多精彩內容請關注“正運動小助手”公眾號,需要相關開發環境與例程代碼,請谘詢正運動技術銷售工程師:400-089-8936。
本ben文wen由you正zheng運yun動dong技ji術shu原yuan創chuang,歡huan迎ying大da家jia轉zhuan載zai,共gong同tong學xue習xi,一yi起qi提ti高gao中zhong國guo智zhi能neng製zhi造zao水shui平ping。文wen章zhang版ban權quan歸gui正zheng運yun動dong技ji術shu所suo有you,如ru有you轉zhuan載zai請qing注zhu明ming文wen章zhang來lai源yuan。
|