Cam曲线运动方程式应用简介

1、OMRONCam曲线运动方程式应用简介三次曲线、五次曲线拼接实例丛龙辉2013/3/26通过实例，简单介绍了创建自定义“功能FC/功能块FB”并导出、导入的方法，介绍了自定义计算三次曲线系数、五次曲线系数FC的源代码，利用该自定义FC修改CAM表的过程及其效果。目录1.用到的凸轮曲线运动方程式- 1 -2.自定义功能/功能块库- 2 -2.1.新建库工程- 2 -2.2.自定义Functions/Function Blocks库的导出/导入- 4 -3.测试自定义Function及通过程序修改CAM曲线效果- 5 -1. 用到的凸轮曲线运动方程式假设第n段Cam曲线上任意一点的Phase为 ，

2、Distance为 ，其始末点用表示，令，则曲线通式为：u 三次曲线运动方程通式及系数方程令边界条件为时，时可求得五次曲线任意拼接时的运动方程式为：u 五次曲线运动方程通式及系数方程令边界条件为时，时可求得五次曲线任意拼接时的运动方程式为：注意：以上公式中的、都是曲线始末点的类速度、类加速度，不是真实的速度、加速度。 对上述公式的验证见后续内容。2. 自定义功能/功能块库2.1. 新建库工程打开Sysmac Studio软件，选择新建工程，注意在工程类型中选择“库工程”，设备类型及版本可根据需要选择，如果没有用到高版本中的新增的指令，可选择最低版本即可。在数据类型中新建一个自定义的结构体数据类

3、型CurvePoint，包含三个成员,如下图所示：该数据类型用于存储曲线始末点信息，需要注意的是其中的vel和acc并不是实际的速度和加速度，而是类速度、类加速度，反映的是该点的Distance相对于Phase的变化情况。如在Cam曲线设置中设置曲线类型为直线，起点为主轴0、从轴0，终点为主轴10，从轴10，则该段曲线末点（即下段曲线起点）的distance为10，phase为10，vel为1，acc为0。在POU中新建2个Function，分别用于计算三次曲线和五次曲线的系数，具体代码如下：PHI:=EPoint.Point.Phase-SPoint.Point.Phase;H:=EPoin

4、t.Point.Distance-SPoint.Point.Distance;IF (PHI=0.0) THEN Err:=TRUE; Err_Code:=1;/错误码1，凸轮转角为0ELSE/计算曲线系数C0:=SPoint.Point.Distance;C1:=SPoint.vel;C2:=(3*H-PHI*EPoint.vel-2*PHI*SPoint.vel)/(PHI*PHI);C3:=(PHI*SPoint.vel+PHI*EPoint.vel-2*H)/(PHI *PHI *PHI );三次系数:=TRUE;Err:=FALSE;Err_Code:=0;END_IF;PHI:=E

5、Point.Point.Phase-SPoint.Point.Phase;H:=EPoint.Point.Distance-SPoint.Point.Distance;IF (PHI=0.0) THEN Err:=TRUE; Err_Code:=1;/错误码1，凸轮转角为0ELSE/计算曲线系数C0:=SPoint.Point.Distance;C1:=SPoint.vel;C2:=SPoint.acc/2;C3:=(EPoint.acc-3*SPoint.acc)/2/PHI-(4*EPoint.vel+6*SPoint.vel)/(PHI*PHI)+10*H/PHI/PHI/PHI;C4:

6、=(3*SPoint.acc-2*EPoint.acc)/2/PHI/PHI+(7*EPoint.vel+8*SPoint.vel)/PHI/PHI/PHI-15*H/PHI/PHI/PHI/PHI;C5:=(EPoint.acc-SPoint.acc)/2/PHI/PHI/PHI-3.0*(EPoint.vel+SPoint.vel)/PHI/PHI/PHI/PHI+6*H/PHI/PHI/PHI/PHI/PHI;五次系数:=TRUE;Err:=FALSE;Err_Code:=0;END_IF;2.2. 自定义Functions/Function Blocks库的导出/导入u 设置库属性：选

7、择菜单“工程库库设置”，设置库名称、版本号、作者等内容，在下方的元素选择对话框中勾选需要保存到库中的内容（本文中为自定义的2个功能FC：三次系数、五次系数），注意的是如果使用了其它自定义的功能或功能块，需要勾选包含引用库文件。u 创建库选择菜单“工程库创建库”，在弹出的“创建库文件”对话框中选择库文件的存放位置，默认路径为“C:OMRONDataLib”。u 导入库新建标准工程后，选择菜单“工程库显示索引”，点击“+”按钮，在弹出的“引用库文件”对话框中选择已创建的库文件，导入到工程中，可以看到，库中自定义的功能、结构体数据类型都导入到了程序中。3. 测试自定义Function及通过程序修改C

8、AM曲线效果新建标准工程并导入自定义库后，添加CAM表CamT1，Cam数据设置如下：可以看到该CAM曲线由三段直线构成，实际上，这样设置的曲线是不合理的，在曲线连接处其类速度、类加速度存在突变，有柔性冲击。现在要做的，就是将中间这段直线通过程序修改为三次曲线或四次曲线。首先确定该段曲线始末点相关参数，由于前后两段都是直线，故其类加速度为0，类速度分别为1和1.4，得到起点SPoint为Phase=10.0，Distance=10.0，vel=1，acc=0，末点EPoint为Phase=20.0，Distance=16.0，vel=1.4，acc=0编写如下程序修改CAM曲线并保存。*由于实际要修改的Cam曲线类型多种多样，始末点坐标、Pitch数据、修改点数多变，为节省变量内存，采用程序直接计算而不是制作成功能块。要修改成三次曲线或五次曲线时，首先计算系数，然后根据公式修改对应点的Distance，如果要从NJ控制器中将CAM表导出成文件，则必须执行MC_SaveCamTable功能块。然后通过。由于Sysmac Studio软件中无法查看通过程序修改得到的CAM表且使用仿真功能时也无法导出Cam表到文件，故只能自控制器中将Cam