電子發(fā)燒友App
01 硬件介紹
ZMC408CE是正運(yùn)動(dòng)推出的一款多軸高性能EtherCAT總線運(yùn)動(dòng)控制器，具有EtherCAT、EtherNET、RS232、CAN和U盤(pán)等通訊接口，ZMC系列運(yùn)動(dòng)控制器可應(yīng)用于各種需要脫機(jī)或聯(lián)機(jī)運(yùn)行的場(chǎng)合。
ZMC408CE支持8軸運(yùn)動(dòng)控制，最多可擴(kuò)展至32軸，支持直線插補(bǔ)、任意圓弧插補(bǔ)、空間圓弧、螺旋插補(bǔ)、電子凸輪、電子齒輪、同步跟隨等功能。 ZMC408CE支持8軸運(yùn)動(dòng)控制，可采用脈沖軸（帶編碼器反饋）或EtherCAT總線軸，通用IO包含24個(gè)輸入口和16個(gè)輸出口，部分IO為高速I(mǎi)O，EtherCAT最快100us的刷新周期。
ZMC408CE支持8個(gè)通道的硬件比較輸出、硬件定時(shí)器、運(yùn)動(dòng)中精準(zhǔn)輸出，還支持8通道PWM輸出，對(duì)應(yīng)的輸出口為OUT0-7，支持8個(gè)通道同時(shí)觸發(fā)硬件比較輸出，用于多通道的視覺(jué)飛拍場(chǎng)合等。 ZMC408CE支持PLC、Basic、HMI組態(tài)三種編程方式。PC上位機(jī)API編程支持C#、C++、LabVIEW、Matlab、Qt、Linux、VB.Net、Python等接口。 ?
ZMC408CE內(nèi)置高精度PSO位置同步輸出功能，在加工圓角與曲線時(shí)即使進(jìn)行有減速調(diào)整，在高速加工的場(chǎng)合中也能控制激光輸出的等間距輸出。
02 PSO技術(shù)介紹 ?
PSO（position synchronized output）即位置同步輸出，本質(zhì)是通過(guò)采集實(shí)時(shí)的編碼器反饋位置(無(wú)編碼器可使用輸出的脈沖位置)與比較模式設(shè)定的位置進(jìn)行比較，控制OP高速同步輸出信號(hào)，PSO示意圖如下。
PSO一般與激光器(或點(diǎn)膠噴射閥等設(shè)備)同步輸出信號(hào)進(jìn)行相位同步，在運(yùn)動(dòng)軌跡的所有階段以恒定的空間(或恒定時(shí)間)間隔觸發(fā)輸出開(kāi)關(guān)，包括加速、減速和勻速段，從而實(shí)現(xiàn)脈沖能量均勻地作用在被加工物體上。 PSO功能的特點(diǎn)是能高速且穩(wěn)定的輸出信號(hào)，因?yàn)檩敵鼍茸銐蚋?，所以能夠在整個(gè)運(yùn)動(dòng)軌跡中以固定的距離觸發(fā)輸出信號(hào)而不用考慮總體速度，即在直線部分以很快的速度運(yùn)動(dòng)，而在圓角部分減速的同時(shí)也能保證輸出間距恒定。 通常圓角加工部分在整個(gè)加工過(guò)程中占有比較小的部分，這樣在保證加工效果的同時(shí)，就可以最大限度地提高產(chǎn)能。
正運(yùn)動(dòng)的PSO功能調(diào)用ZAux_Direct_HwPswitch2函數(shù)接口實(shí)現(xiàn)，該函數(shù)采用硬件實(shí)現(xiàn)IO的高速比較輸出，響應(yīng)速度達(dá)到微秒級(jí)別，故名硬件比較輸出。 ?
03 C++語(yǔ)言MFC進(jìn)行運(yùn)動(dòng)控制項(xiàng)目的開(kāi)發(fā)
1.新建MFC項(xiàng)目并添加函數(shù)庫(kù)
注：本例程在VS2010編譯環(huán)境下，基于.NET Framework 4.0框架創(chuàng)建的MFC窗體應(yīng)用程序。
（1）工具欄菜單“文件”→“新建”→“項(xiàng)目”，啟動(dòng)創(chuàng)建項(xiàng)目向?qū)А?/p>
（2）選擇開(kāi)發(fā)語(yǔ)言為“Visual C++”和.NET Framework 4以及MFC應(yīng)用程序，填寫(xiě)好程序名以及選擇好程序存放路徑，點(diǎn)擊確定。
（3）點(diǎn)擊下一步。
（4）選擇類(lèi)型為“基于對(duì)話框”，點(diǎn)擊下一步或者完成即可。
2.找到廠家提供的C++函數(shù)庫(kù)文件
（1）進(jìn)入廠商提供的光盤(pán)資料，找到“8.PC函數(shù)”文件夾，并點(diǎn)擊進(jìn)入，找到C++函數(shù)庫(kù)，路徑如下（64位庫(kù)為例）。
（2）選擇“函數(shù)庫(kù)2.1”文件夾。
（3）選擇“Windows平臺(tái)”文件夾。
（4）根據(jù)需要選擇對(duì)應(yīng)的函數(shù)庫(kù)，這里選擇“64位庫(kù)”。
（5）解壓C++壓縮包，里面有C++對(duì)應(yīng)的函數(shù)庫(kù)。
（6）函數(shù)庫(kù)具體路徑如下。
（7）將廠商提供的C++庫(kù)文件以及相關(guān)文件復(fù)制到新建的項(xiàng)目中。
3.在項(xiàng)目中添加靜態(tài)庫(kù)和相關(guān)頭文件
靜態(tài)庫(kù)：zauxdll.lib, zmotion.lib 相關(guān)頭文件：zauxdll2.h, zmotion.h
（1）先右擊頭文件，接著依次選擇:“添加”→“現(xiàn)有項(xiàng)”。
（2）在彈出的窗口中依次添加靜態(tài)庫(kù)和相關(guān)頭文件。
（3）聲明用到的頭文件和定義控制器連接句柄。
至此，項(xiàng)目新建完成。
4.查看PC函數(shù)手冊(cè)
用戶需要從PC函數(shù)手冊(cè)中獲取運(yùn)動(dòng)控制開(kāi)發(fā)使用的函數(shù)接口，對(duì)照手冊(cè)說(shuō)明使用，PC函數(shù)手冊(cè)在光盤(pán)資料查看，具體路徑如下：“光盤(pán)資料8.PC函數(shù)函數(shù)庫(kù)2.1Motion函數(shù)庫(kù)編程手冊(cè)V2.1.pdf”。
5.控制器網(wǎng)口連接函數(shù)接口
PC編程一般使用網(wǎng)口對(duì)控制器和工控機(jī)進(jìn)行鏈接。ZAux_FastOpen（）；如果鏈接成功，該接口會(huì)返回一個(gè)鏈接句柄。通過(guò)操作這個(gè)鏈接句柄可以實(shí)現(xiàn)對(duì)控制器的控制。
ZAux_OpenEth()接口說(shuō)明：
| 指令11 | ZAux_FastOpen | ||||||||
| 指令原型 | int32 ?__stdcall ?ZAux_FastOpen(int type, char *pconnectstring, uint32 uims ,ZMC_HANDLE * phandle) | ||||||||
| 指令說(shuō)明 | 與控制器建立連接, 可以指定連接的等待時(shí)間 | ||||||||
| 輸入參數(shù) |
|
||||||||
| 輸出參數(shù) |
|
||||||||
| 返回值 | 成功返回值為0，非0詳見(jiàn)錯(cuò)誤碼說(shuō)明 | ||||||||
| 指令示例 |
1.串口連接: ZMC_HANDLE ?phandle;//控制器連接句柄 Char comID[32]= "0";//串口ID ZAux_FastOpen(1, comID,1000s ,&phandle); 2.網(wǎng)口連接例子： ZMC_HANDLE ?phandle;//控制器連接句柄 Char EthID[32]= "192.168.0.11";//網(wǎng)口ID ZAux_FastOpen(1, EthID,1000s ,&phandle); |
||||||||
| 詳細(xì)說(shuō)明 | type設(shè)置為5,zmotion.dll版本要在3.8.8.50以上 |
項(xiàng)目應(yīng)用截圖：
6.硬件比較輸出函數(shù)接口
使用對(duì)下位機(jī)寄存器操作的指令操作鏈接句柄“g_handle”，對(duì)控制器進(jìn)行寄存器內(nèi)容取值，實(shí)時(shí)控制下位機(jī)相關(guān)的指令如下。
實(shí)時(shí)全局變量指令：ZAux_Direct_HwPswitch2硬件比較輸出指令到位置后硬件自動(dòng)觸發(fā)op輸出信號(hào)。
| 指令19 | ZAux_Direct_HwPswitch2 | ||||||||||||||||||
| 指令原型 | int32 ?__stdcall ?ZAux_Direct_HwPswitch2(ZMC_HANDLE handle,int ?Axisnum,int ?Mode, int ?Opnum, int ?Opstate, float ModeParal, float ModePara2, float ?Mode ?Para3 , float ?ModePara4) | ||||||||||||||||||
| 指令說(shuō)明 |
硬件位置比較輸出2，4系列產(chǎn)品20170513以上版本支持。 ZMC306E/306N支持。 |
||||||||||||||||||
| 輸入?yún)?shù) |
|
7.硬件定時(shí)器函數(shù)接口
ZAux_Direct_HwTimer硬件定時(shí)器硬件比較輸出后一段時(shí)間還原電平。
| 指令21 | ZAux_Direct_HwTimer | ||||||||||||||||
| 指令原型 | int32 __stdcall ZAux_Direct_HwTimer(ZMC_HANDLE handle,int mode, int cyclonetime, int ?optime, int ?reptimes, int ?opstate, int ?opnum) | ||||||||||||||||
| 指令說(shuō)明 | 硬件定時(shí)器用于硬件比較輸出后一段時(shí)見(jiàn)還原電平-4系列產(chǎn)品支持 | ||||||||||||||||
| 輸入?yún)?shù) |
 |
||||||||||||||||
| 輸出參數(shù) | / | ||||||||||||||||
| 返回值 | 成功返回值為0，非0詳見(jiàn)錯(cuò)誤碼說(shuō)明 | ||||||||||||||||
| 指令示例 |
//周期調(diào)整為2，輸出兩次 ZAux_Trigger(g_handle); ZAux_Direct_SetOp(g_handle, 0, 0); ZAux_Direct_HwTimer(g_handle, 2, 1000000, 500000, 2, 0, 0);//輸出口0變?yōu)閛n后，硬件定時(shí)器觸發(fā)開(kāi)始計(jì)時(shí)，500ms后切換為off; ZAux_Direct_SetOp(g_handle, 0, 1); |
||||||||||||||||
| 詳細(xì)說(shuō)明 |
（1）HW_TIMER只有1個(gè)，每次調(diào)用會(huì)強(qiáng)制停止之前的調(diào)用。 （2）ZMC420SCAN每個(gè)輸出口的HW_TIMER功能獨(dú)立。 （3）ZMC3系列部分、4系列及以上產(chǎn)品支持此功能。 （4）OP和MOVE_OP操作會(huì)關(guān)閉正在進(jìn)行的HW_TIMER脈沖，這樣可以使用HW_TIMER來(lái)實(shí)現(xiàn)類(lèi)似PWM的功能，OP輸出打開(kāi)脈沖輸出，下一個(gè)OP輸出關(guān)閉脈沖輸出，當(dāng)使用MOVE_OP精準(zhǔn)輸出時(shí)，可以實(shí)現(xiàn)精準(zhǔn)的PWM輸出無(wú)限脈沖功能。 |
04 MFC程序的運(yùn)行和讀寫(xiě)控制開(kāi)發(fā)
1.Demo交互界面如下
2.二維比較模式
（1）2D比較（模式25）
語(yǔ)法：HW_PSWITCH2(25，opnum，opstate，maxerr，num，tablepos) mode 25：二維的比較模式； opnum：對(duì)應(yīng)的輸出口；
opstate：第一個(gè)比較點(diǎn)的輸出狀態(tài)；
maxerr：比較位置每個(gè)軸左右的脈沖偏差，進(jìn)入偏差范圍后開(kāi)始比較，此參數(shù)不能寫(xiě)0；
num：table里面存儲(chǔ)的比較點(diǎn)坐標(biāo)個(gè)數(shù)；
tablepos：第一個(gè)比較點(diǎn)坐標(biāo)所在table編號(hào)。
說(shuō)明：比較點(diǎn)寫(xiě)在TABLE中，兩個(gè)連續(xù)的TABLE數(shù)據(jù)組成一個(gè)2D坐標(biāo)，每到達(dá)一個(gè)比較位置OP反轉(zhuǎn)一次。
圖中藍(lán)色段表示OP開(kāi)啟，各類(lèi)常用插補(bǔ)運(yùn)動(dòng)均支持比較，比較點(diǎn)坐標(biāo)一定的要準(zhǔn)確，否則會(huì)影響后面點(diǎn)的比較。
該模式主要功能為，碰到設(shè)置好的二維比較點(diǎn)之后，輸出口電平反轉(zhuǎn)。
該模式使用時(shí)需要指定高速輸出口，將首個(gè)比較點(diǎn)的輸出狀態(tài)、比較軸設(shè)置好之后，再設(shè)置比較點(diǎn)（即設(shè)置table寄存器，點(diǎn)數(shù)量等），設(shè)置比較點(diǎn)脈沖最大誤差等參數(shù)后，啟動(dòng)比較。緊接著驅(qū)動(dòng)軸運(yùn)動(dòng)即可。
脈沖偏差說(shuō)明：2D模式下設(shè)置XY坐標(biāo)需要準(zhǔn)確，軸運(yùn)動(dòng)不到準(zhǔn)確的TABLE比較點(diǎn)時(shí)將無(wú)法觸發(fā)，3D模式同理。故多維比較模式引入一個(gè)特殊參數(shù)maxerr位置范圍偏差，左右范圍均有效，即實(shí)際位置坐標(biāo)點(diǎn)與TABLE的比較點(diǎn)的差值在maxerr范圍內(nèi)便有效，觸發(fā)時(shí)刻為當(dāng)前位置進(jìn)入比較點(diǎn)的觸發(fā)范圍內(nèi)便觸發(fā)比較，比較范圍示意圖如下。
注意：maxerr的單位為脈沖數(shù)的偏差，不是距離的偏差。 如下圖所示，設(shè)置高速比較輸出口為0，首個(gè)比較點(diǎn)的輸出狀態(tài)為1，比較軸為0，1；設(shè)置兩個(gè)比較點(diǎn)，比較點(diǎn)坐標(biāo)分別為：（100，50），（160，80）。即當(dāng)軸運(yùn)動(dòng)到點(diǎn)（100，50）和點(diǎn)（160，80），誤差范圍在±50個(gè)脈沖左右的范圍時(shí)，都會(huì)觸發(fā)電平變化。
示波器波形如圖所示：在坐標(biāo)（100，50）時(shí)輸出為1，直到坐標(biāo)（160，80）的時(shí)候恢復(fù)為0。
（2）2D比較（模式26）
語(yǔ)法：HW_PSWITCH2(26，opnum，opstate，maxerr，num，tablepos，[ophwtimeus，ophwtimes，hwcyctimeus])
mode 26：二維的比較模式； opnum：對(duì)應(yīng)的輸出口； opstate：第一個(gè)比較點(diǎn)的輸出狀態(tài)； maxerr：比較位置每個(gè)軸左右的脈沖偏差，進(jìn)入偏差范圍后開(kāi)始比較，此參數(shù)不能寫(xiě)0； num：table里面存儲(chǔ)的比較點(diǎn)坐標(biāo)個(gè)數(shù)； tablepos：第一個(gè)比較點(diǎn)坐標(biāo)所在table編號(hào)； * 以下參數(shù)和HW_TIMER二選一，HW_TIMER單獨(dú)寫(xiě)可以動(dòng)態(tài)調(diào)整參數(shù) * ophwtimeus：脈沖時(shí)間； ophwtimes：脈沖個(gè)數(shù)； hwcyctimeus：脈沖周期。
說(shuō)明：比較點(diǎn)寫(xiě)在TABLE中，兩個(gè)連續(xù)的TABLE數(shù)據(jù)組成一個(gè)2D坐標(biāo)，每到達(dá)一個(gè)比較位置觸發(fā)OP，每個(gè)比較點(diǎn)OP反轉(zhuǎn)的次數(shù)和反轉(zhuǎn)周期由HW_TIMER設(shè)置；到達(dá)下一個(gè)TABLE位置，OP再次觸發(fā)。類(lèi)似模式7和模式36。
該模式主要功能為，碰到設(shè)置好的二維比較點(diǎn)之后，輸出口輸出一斷設(shè)置好的定時(shí)脈沖。 該模式使用時(shí)，需要指定高速輸出口，將首個(gè)比較點(diǎn)的輸出狀態(tài)、比較軸設(shè)置好之后，再設(shè)置比較點(diǎn)（即設(shè)置table寄存器，點(diǎn)數(shù)量等），設(shè)置好比較點(diǎn)之后再設(shè)置脈沖有效時(shí)間、脈沖周期時(shí)間，以及脈沖個(gè)數(shù)（重復(fù)次數(shù)），設(shè)置比較點(diǎn)的脈沖最大誤差等參數(shù)后，啟動(dòng)比較。緊接著驅(qū)動(dòng)軸運(yùn)動(dòng)即可。
如下圖所示，設(shè)置高速比較輸出口為0，首個(gè)比較點(diǎn)的輸出狀態(tài)為1，比較軸為0，1；設(shè)置兩個(gè)比較點(diǎn)，比較點(diǎn)坐標(biāo)分別為：（100，100），（200，200）。即當(dāng)軸運(yùn)動(dòng)到點(diǎn)（100，100），點(diǎn)（200，200），誤差范圍在±10個(gè)脈沖左右的范圍時(shí)，都會(huì)觸發(fā)兩個(gè)周期為60ms，脈沖有效時(shí)間為20ms的脈沖。
示波器波形如圖所示：在坐標(biāo)（100，100），（200，200）的時(shí)候都會(huì)觸發(fā)兩個(gè)周期為60ms，脈沖有效時(shí)間為20ms的脈沖。
3.三維比較模式
（1）3D比較（模式35）
語(yǔ)法：HW_PSWITCH2(35，opnum，opstate，maxerr，num，tablepos)
mode 35:三維的比較模式； opnum：對(duì)應(yīng)的輸出口； opstate：第一個(gè)比較點(diǎn)的輸出狀態(tài)； maxerr：比較位置每個(gè)軸左右的脈沖偏差，進(jìn)入偏差范圍后開(kāi)始比較，此參數(shù)不能寫(xiě)0； num：table里面存儲(chǔ)的比較點(diǎn)坐標(biāo)個(gè)數(shù)； tablepos：第一個(gè)比較點(diǎn)坐標(biāo)所在table編號(hào)；
說(shuō)明：比較點(diǎn)寫(xiě)在TABLE中，三個(gè)連續(xù)的TABLE數(shù)據(jù)組成一個(gè)3D坐標(biāo)，每到達(dá)一個(gè)比較位置觸發(fā)OP，每個(gè)比較點(diǎn)OP反轉(zhuǎn)的次數(shù)和反轉(zhuǎn)周期由HW_TIMER設(shè)置；到達(dá)下一個(gè)TABLE位置，OP再次觸發(fā)。類(lèi)似模式26和模式7。
該模式主要功能為，碰到設(shè)置好的三維比較點(diǎn)之后，輸出口電平反轉(zhuǎn)。
該模式使用時(shí)需要指定高速輸出口，將首個(gè)比較點(diǎn)的輸出狀態(tài)、比較軸設(shè)置好之后，再設(shè)置比較點(diǎn)（即設(shè)置table寄存器，點(diǎn)數(shù)量等），設(shè)置比較點(diǎn)的脈沖最大誤差等參數(shù)后，啟動(dòng)比較。緊接著驅(qū)動(dòng)軸運(yùn)動(dòng)即可。 如下圖所示，設(shè)置高速比較輸出口為0，首個(gè)比較點(diǎn)的輸出狀態(tài)為1，比較軸為0，1，2；設(shè)置4個(gè)比較點(diǎn)，比較點(diǎn)坐標(biāo)分別為：（80，40，20），（160，80，40），（240，120，60），（320，160，80）。即當(dāng)軸運(yùn)動(dòng)到點(diǎn)（80，40，20），（160，80，40），（240，120，60），（320，160，80），誤差范圍在±10個(gè)脈沖左右的范圍時(shí)，都會(huì)觸發(fā)電平變化。
示波器波形如圖所示：在坐標(biāo)（80，40，20），（160，80，40），（240，120，60），（320，160，80）時(shí)會(huì)發(fā)生電平變化。
核心程序示例：
?
/*參數(shù)：mode 25, 26 ,35,36.2D/3D的比較模式 Axisnum:軸數(shù)組 Opnum :對(duì)應(yīng)的輸出口 Opstate: 第一個(gè)比較點(diǎn)的輸出狀態(tài). maxerr:比較位置每個(gè)軸左右的脈沖偏差, 進(jìn)入偏差范圍后開(kāi)始比較. num :TABLE 里面存儲(chǔ)的比較點(diǎn)個(gè)數(shù). tablepos: 第一個(gè)比較點(diǎn)坐標(biāo)所在 TABLE 編號(hào) 與 hwtimer 并用時(shí), 可以動(dòng)態(tài)調(diào)整 hwtimer 參數(shù). ModePara1:脈沖時(shí)間 ModePara2:脈沖個(gè)數(shù) ModePara3:脈沖周期 */ int32 CMyControlDlg:: ZAux_Direct_HwPswitch2_2D(ZMC_HANDLE handle, int *Axisnum,int Mode,int Opnum , int Opstate,int maxerr,int num, int tablepos, float ModePara1, float ModePara2,float ModePara3) { if(0 > Axisnum[0] || Axisnum[0] > MAX_AXIS_AUX) { return ERR_AUX_PARAERR; } char cmdbuff[2048]; char tempbuff[2048]; char cmdbuffAck[2048]; //生成命令 sprintf(cmdbuff, "BASE(%d,%d) ", Axisnum[0], Axisnum[1]); switch(Mode) { case 25: sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d)", Mode, Opnum, Opstate, maxerr,num,tablepos); strcat(cmdbuff, tempbuff); break; case 26: sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d,%f,%f,%f)", Mode,Opnum, Opstate, maxerr,num,tablepos,ModePara1,ModePara2,ModePara3); strcat(cmdbuff, tempbuff); break; case 35: sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d)", Mode, Opnum, Opstate, maxerr,num,tablepos); strcat(cmdbuff, tempbuff); break; case 36: sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d,%f,%f,%f)", Mode,Opnum, Opstate, maxerr,num,tablepos,ModePara1,ModePara2,ModePara3); strcat(cmdbuff, tempbuff); break; default: return ERR_AUX_PARAERR; break; } //調(diào)用命令執(zhí)行函數(shù) int ret=ZAux_Execute(handle, cmdbuff, cmdbuffAck,2048); if (strlen(cmdbuffAck)!=0) return ERR_ACKERROR; return ret; }
?
（2）3D比較（模式36）
語(yǔ)法：HW_PSWITCH2(36，opnum，opstate，maxerr，num，tablepos， [ophwtimeus，ophwtimes，hwcyctimeus]) mode 36：三維的比較模式； opnum：對(duì)應(yīng)的輸出口； opstate：第一個(gè)比較點(diǎn)的輸出狀態(tài)； maxerr：比較位置每個(gè)軸左右的脈沖偏差，進(jìn)入偏差范圍后開(kāi)始比較，此參數(shù)不能寫(xiě)0； num：table里面存儲(chǔ)的比較點(diǎn)坐標(biāo)個(gè)數(shù)； tablepos：第一個(gè)比較點(diǎn)坐標(biāo)所在table編號(hào)； * 以下參數(shù)和HW_TIMER二選一，HW_TIMER單獨(dú)寫(xiě)可以動(dòng)態(tài)調(diào)整參數(shù) * ophwtimeus：脈沖時(shí)間； ophwtimes：脈沖個(gè)數(shù)； hwcyctimeus：脈沖周期。
該模式主要功能為，碰到設(shè)置好的三維比較點(diǎn)之后，輸出口輸出一斷設(shè)置好的定時(shí)脈沖。 該模式使用時(shí)，需要指定高速輸出口，將首個(gè)比較點(diǎn)的輸出狀態(tài)、比較軸設(shè)置好之后，再設(shè)置比較點(diǎn)（即設(shè)置table寄存器，點(diǎn)數(shù)量等），設(shè)置好比較點(diǎn)之后再設(shè)置脈沖有效時(shí)間，脈沖周期時(shí)間，以及脈沖個(gè)數(shù)（重復(fù)次數(shù)），設(shè)置比較點(diǎn)的脈沖最大誤差等參數(shù)后，啟動(dòng)比較。緊接著驅(qū)動(dòng)軸運(yùn)動(dòng)即可。 如下圖所示，設(shè)置高速比較輸出口為0，首個(gè)比較點(diǎn)的輸出狀態(tài)為1，比較軸為0，1，2；設(shè)置4個(gè)比較點(diǎn)，比較點(diǎn)坐標(biāo)分別為：（80，40，20），（160，80，40），（240，120，60），（320，160，80）。 即當(dāng)軸運(yùn)動(dòng)到點(diǎn)（80，40，20），（160，80，40），（240，120，60），（320，160，80），誤差范圍在±10個(gè)脈沖左右的范圍時(shí)，都會(huì)觸發(fā)電平變化。都會(huì)觸發(fā)兩個(gè)周期為40ms，脈沖有效時(shí)間為20ms的脈沖。
示波器波形如圖所示：在坐標(biāo)（80，40，20），（160，80，40），（240，120，60），（320，160，80）時(shí)會(huì)觸發(fā)兩個(gè)周期為40ms，脈沖有效時(shí)間為20ms的脈沖。
核心程序示例：
?
/*參數(shù)：mode 25, 26 ,35,36.2D/3D的比較模式
Axisnum:軸數(shù)組
Opnum :對(duì)應(yīng)的輸出口
Opstate: 第一個(gè)比較點(diǎn)的輸出狀態(tài).
maxerr:比較位置每個(gè)軸左右的脈沖偏差, 進(jìn)入偏差范圍后開(kāi)始比較.
num:TABLE 里面存儲(chǔ)的比較點(diǎn)個(gè)數(shù).
tablepos: 第一個(gè)比較點(diǎn)坐標(biāo)所在 TABLE 編號(hào)
與 hwtimer 并用時(shí), 可以動(dòng)態(tài)調(diào)整 hwtimer 參數(shù).
ModePara1:脈沖時(shí)間
ModePara2:脈沖個(gè)數(shù)
ModePara3:脈沖周期
*/
int32 CMyControlDlg:: ZAux_Direct_HwPswitch2_2D(ZMC_HANDLE handle, int *Axisnum,int Mode,int Opnum , int Opstate,int maxerr,int num, int tablepos, float ModePara1, float ModePara2,float ModePara3)
{
if(0 > Axisnum[0] || Axisnum[0] > MAX_AXIS_AUX)
{
return ERR_AUX_PARAERR;
}
char cmdbuff[2048];
char tempbuff[2048];
char cmdbuffAck[2048];
//生成命令
sprintf(cmdbuff, "BASE(%d,%d)
", Axisnum[0], Axisnum[1]);
switch(Mode)
{
case 25:
sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d)", Mode, Opnum, Opstate, maxerr,num,tablepos);
strcat(cmdbuff, tempbuff);
break;
case 26:
sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d,%f,%f,%f)", Mode,Opnum, Opstate, maxerr,num,tablepos,ModePara1,ModePara2,ModePara3);
strcat(cmdbuff, tempbuff);
break;
case 35:
sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d)", Mode, Opnum, Opstate, maxerr,num,tablepos);
strcat(cmdbuff, tempbuff);
break;
case 36:
sprintf(tempbuff, "HW_PSWITCH2(%d,%d,%d,%d,%d,%d,%f,%f,%f)", Mode,Opnum, Opstate, maxerr,num,tablepos,ModePara1,ModePara2,ModePara3);
strcat(cmdbuff, tempbuff);
break;
default:
return ERR_AUX_PARAERR;
break;
}
//調(diào)用命令執(zhí)行函數(shù)
int ret=ZAux_Execute(handle, cmdbuff, cmdbuffAck,2048);
if (strlen(cmdbuffAck)!=0)
return ERR_ACKERROR;
return ret;
}
?
審核編輯：劉清
工商網(wǎng)監(jiān)
評(píng)論