本文主要介紹正運動技術EtherCAT控制器在VS平臺采用C++語言實現的各種PSO功能。正運動提供多種PSO模式供用戶搭配不同的場景使用。

本節主要講解采用TABLE寄存器存儲的數據表觸發比較，更多周期比較模式、二維三維比較模式參見下一節說明。

01硬件介紹

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位置同步輸出功能，在加工圓角與曲線時即使進行有減速調整，在高速加工的場合中也能控制激光輸出的等間距輸出。

02PSO技術介紹

PSO（position synchronized output）即位置同步輸出，本質是通過采集實時的編碼器反饋位置(無編碼器可使用輸出的脈沖位置)與比較模式設定的位置進行比較，控制OP高速同步輸出信號，PSO示意圖如下。

PSO一般與激光器(或點膠噴射閥等設備)同步輸出信號進行相位同步，在運動軌跡的所有階段以恒定的空間(或恒定時間)間隔觸發輸出開關，包括加速、減速和勻速段，從而實現脈沖能量均勻地作用在被加工物體上。

PSO功能的特點是能高速且穩定的輸出信號，因為輸出精度足夠高，所以能夠在整個運動軌跡中以固定的距離觸發輸出信號而不用考慮總體速度，即在直線部分以很快的速度運動，而在圓角部分減速的同時也能保證輸出間距恒定。

通常圓角加工部分在整個加工過程中占有比較小的部分，這樣在保證加工效果的同時，就可以最大限度地提高產能。

正運動的PSO功能調用ZAux_Direct_HwPswitch2函數接口實現，該函數采用硬件實現IO的高速比較輸出，響應速度達到微秒級別，故名硬件比較輸出。

03MFC項目的開發

（一）新建MFC項目并添加函數庫

注：本例程在VS2010編譯環境下，基于.NET Framework 4.0框架創建的MFC窗體應用程序。

1.工具欄菜單“文件”→“新建”→“項目”，啟動創建項目向導。

2.選擇開發語言為“Visual C++”和.NET Framework 4以及MFC應用程序，填寫好程序名以及選擇好程序存放路徑，點擊確定。

3.點擊下一步。

4.選擇類型為“基于對話框”，點擊下一步或者完成即可。

（二）找到廠家提供的C++函數庫文件

1.進入廠商提供的光盤資料，找到“8.PC函數”文件夾，并點擊進入，找到C++函數庫，路徑如下（64位庫為例）。

2.選擇“函數庫2.1”文件夾。

3.選擇“Windows平臺”文件夾。

4.根據需要選擇對應的函數庫，這里選擇“64位庫”。

5.解壓C++壓縮包，里面有C++對應的函數庫。

6.函數庫具體路徑如下。

7.將廠商提供的C++庫文件以及相關文件復制到新建的項目中。

（三）在項目中添加靜態庫和相關頭文件

靜態庫：zauxdll.lib, zmotion.lib

相關頭文件：zauxdll2.h, zmotion.h

1.先右擊頭文件，接著依次選擇:“添加”→“現有項”。

2.在彈出的窗口中依次添加靜態庫和相關頭文件。

3.聲明用到的頭文件和定義控制器連接句柄。

至此，項目新建完成。

（四）查看PC函數手冊

用戶需要從PC函數手冊中獲取運動控制開發使用的函數接口，對照手冊說明使用，PC函數手冊在光盤資料查看，具體路徑如下：“光盤資料\8.PC函數\函數庫2.1\ZMotion函數庫編程手冊V2.1.pdf”。

（五）控制器網口連接函數接口

PC編程一般使用網口對控制器和工控機進行鏈接。ZAux_FastOpen（）；如果鏈接成功，該接口會返回一個鏈接句柄。通過操作這個鏈接句柄可以實現對控制器的控制。

ZAux_OpenEth()接口說明：

項目應用截圖：

（六）硬件比較輸出函數接口

使用對下位機寄存器操作的指令操作鏈接句柄“g_handle”，對控制器進行寄存器內容取值，實時控制下位機相關的指令如下。

實時全局變量指令：ZAux_Direct_HwPswitch2硬件比較輸出指令到位置后硬件自動觸發op輸出信號。

（七）硬件定時器函數接口

ZAux_Direct_HwTimer硬件定時器硬件比較輸出后一段時間還原電平。

04MFC程序的運行和讀寫控制開發

（一）Demo交互界面

Demo主要分為三個部分：

1.鏈接控制器，支持網口連接和串口連接。

2.配置基本軸參數。

3.配置硬件比較輸出，可選多種模式測試，部分模式需要先配置TABLE的比較點數據才能啟動。

（二）常用模式例程功能與效果

1.單軸比較（模式1）

ZAux_Direct_HwPswitch2（ZMC_HANDLE handle,int Axisnum,int Mode， int Opnum，int Opstate，float ModePara1， float ModePara2，float ModePara3，float ModePara4）.

（1）handle：控制器連接句柄；

（2）Axisnum：比較軸號；

（3）Mode：1-啟動比較器；

（4）Opnum：對應的輸出口；

（5）Opstate：第一個比較點的輸出狀態；

（6）ModePara1：第一個比較點絕對坐標所在TABLE寄存器編號；

（7）ModePara2：最后一個比較點絕對坐標所在TABLE寄存器編號；

（8）ModePara3：第一個點判斷方向，0坐標負向，1坐標正向，-1不使用方向；

（9）ModePara4：模式1里面，該參數無意義，填0或其他任意值。

模式1主要功能為：在TABLE寄存器里面設置好比較點，碰到設置好的單軸比較點之后，輸出口電平反轉。

該模式使用時需要指定高速輸出口，將首個比較點的輸出狀態、比較軸設置好之后，再設置比較點（即設置table寄存器，點數量等），最后設置比較點的運動方向，啟動比較。緊接著驅動軸運動即可。

如下圖所示，設置高速比較輸出口0，首個比較點的輸出狀態為1，設置比較軸為0。設置4個比較點，比較點坐標分別為：100，200，300，400。即當軸運動到100，200，300，400時，都會觸發電平變化。

示波器波形如圖所示：由圖可得輸出口OP（0）在100，200，300，400時會發生電平變化。

2.清除比較點（模式2）

ZAux_Direct_HwPswitch2（ZMC_HANDLE handle,int Axisnum，int Mode， int Opnum，int Opstate，float ModePara1, float ModePara2，float ModePara3，float ModePara4）.

（1）handle：控制器連接句柄；

（2）Axisnum：比較軸號；

（3）Mode：2-清除比較緩沖區；

（4）Opnum：對應的輸出口；

（5）Opstate：模式2里面，該參數無意義，填0；

（6）ModePara1：模式2里面，該參數無意義，填0；

（7）ModePara2：模式2里面，該參數無意義，填0；

（8）ModePara3：模式2里面，該參數無意義，填0；

（9）ModePara4：模式2里面，該參數無意義，填0。

使用前需要調用此模式，清除可能沒有比較完成的數據。使用過程中也可以發送此命令，停止比較。

3.矢量比較方式（模式3）

ZAux_Direct_HwPswitch2（ZMC_HANDLE handle，int Axisnum，int Mode， int Opnum，int Opstate，float ModePara1， float ModePara2，float ModePara3，float ModePara4）.

（1）handle：控制器連接句柄；

（2）Axisnum：比較軸號；

（3）Mode：3-啟動比較器；

（4）Opnum：對應的輸出口；

（5）Opstate：第一個比較點的輸出狀態；

（6）ModePara1：第一個矢量距離比較點絕對坐標所在TABLE寄存器編號；

（7）ModePara2：最后一個矢量距離比較點絕對坐標所在TABLE寄存器編號；

（8）ModePara3：模式3里面，該參數無意義，填0或其他任意值；

（9）ModePara4：模式3里面，該參數無意義，填0或其他任意值。

模式3主要功能為:在TABLE寄存器里面設置好比較點，碰到設置單軸矢量距離比較點之后，輸出口電平反轉。

該模式使用時需要指定高速輸出口，將首個比較點的輸出狀態、比較軸設置好之后，再設置比較點（即設置TABLE寄存器，點數量等），啟動比較。緊接著驅動軸運動即可。

如下圖所示，設置高速比較輸出口0，首個比較點的輸出狀態為1，設置比較軸為0。設置4個比較點，比較點坐標分別為：100，200，300，400。即當軸矢量距離運動到100，200，300，400時，都會觸發電平變化。

示波器波形如圖所示：由圖可得輸出口OP(0)在100，200，300，400時會發生電平變化。

本次，正運動技術運動控制器PSO視覺飛拍與精準輸出的C++開發（一）：單軸PSO，就分享到這里。

更多精彩內容請關注“正運動小助手”公眾號，需要相關開發環境與例程代碼，請咨詢正運動技術銷售工程師：400-089-8936。

本文由正運動技術原創，歡迎大家轉載，共同學習，一起提高中國智能制造水平。文章版權歸正運動技術所有，如有轉載請注明文章來源。