运动控制器PSO视觉飞拍与精准输出的C++开发（一）：单轴PSO_运动控制器_PSO功能

运动控制器PSO视觉飞拍与精准输出的C++开发（一）：单轴PSO

2023/2/27 15:34:22

本文主要介绍正运动技术EtherCAT控制器在VS平台采用C++语言实现的各种PSO功能。正运动提供多种PSO模式供用户搭配不同的场景使用。

本节主要讲解采用TABLE寄存器存储的数据表触发比较，更多周期比较模式、二维三维比较模式参见下一节说明。

硬件介绍

ZMC408CE是正运动推出的一款多轴高性能EtherCAT总线运动控制器，具有EtherCAT、EtherNET、RS232、CAN和U盘等通讯接口，ZMC系列运动控制器可应用于各种需要脱机或联机运行的场合。

企业微信截图_20230223105245.png

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位置同步输出功能，在加工圆角与曲线时即使进行有减速调整，在高速加工的场合中也能控制激光输出的等间距输出。

PSO技术介绍

PSO（position synchronized output）即位置同步输出，本质是通过采集实时的编码器反馈位置(无编码器可使用输出的脉冲位置)与比较模式设定的位置进行比较，控制OP高速同步输出信号，PSO示意图如下。

企业微信截图_20230223105332.png

PSO一般与激光器(或点胶喷射阀等设备)同步输出信号进行相位同步，在运动轨迹的所有阶段以恒定的空间(或恒定时间)间隔触发输出开关，包括加速、减速和匀速段，从而实现脉冲能量均匀地作用在被加工物体上。

PSO功能的特点是能高速且稳定的输出信号，因为输出精度足够高，所以能够在整个运动轨迹中以固定的距离触发输出信号而不用考虑总体速度，即在直线部分以很快的速度运动，而在圆角部分减速的同时也能保证输出间距恒定。

通常圆角加工部分在整个加工过程中占有比较小的部分，这样在保证加工效果的同时，就可以最大限度地提高产能。

企业微信截图_20230223105346.png

正运动的PSO功能调用ZAux_Direct_HwPswitch2函数接口实现，该函数采用硬件实现IO的高速比较输出，响应速度达到微秒级别，故名硬件比较输出。

MFC项目的开发

（一）新建MFC项目并添加函数库

注：本例程在VS2010编译环境下，基于.NET Framework 4.0框架创建的MFC窗体应用程序。

1.工具栏菜单“文件”→“新建”→“项目”，启动创建项目向导。

企业微信截图_20230223105357.png

2.选择开发语言为“Visual C++”和.NET Framework 4以及MFC应用程序，填写好程序名以及选择好程序存放路径，点击确定。

企业微信截图_20230223105407.png

3.点击下一步。

企业微信截图_20230223105421.png

4.选择类型为“基于对话框”，点击下一步或者完成即可。

企业微信截图_20230223105431.png

（二）找到厂家提供的C++函数库文件

1.进入厂商提供的光盘资料，找到“8.PC函数”文件夹，并点击进入，找到C++函数库，路径如下（64位库为例）。

企业微信截图_20230223105442.png

2.选择“函数库2.1”文件夹。

企业微信截图_20230223105452.png

3.选择“Windows平台”文件夹。

企业微信截图_20230223105504.png

4.根据需要选择对应的函数库，这里选择“64位库”。

5.解压C++压缩包，里面有C++对应的函数库。

企业微信截图_20230223105522.png

6.函数库具体路径如下。

企业微信截图_20230223105535.png

7.将厂商提供的C++库文件以及相关文件复制到新建的项目中。

（三）在项目中添加静态库和相关头文件

静态库：zauxdll.lib, zmotion.lib

（一）Demo交互界面

Demo主要分为三个部分：

1.链接控制器，支持网口连接和串口连接。

2.配置基本轴参数。

3.配置硬件比较输出，可选多种模式测试，部分模式需要先配置TABLE的比较点数据才能启动。

企业微信截图_20230223105957.png

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

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时，都会触发电平变化。

企业微信截图_20230223110020.png

示波器波形如图所示：由图可得输出口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）

企业微信截图_20230223110038.png

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时，都会触发电平变化。