一种plc运动控制模块功能验证设备与验证方法
【技术领域】
[0001 ]本发明属于自动控制技术领域，涉及一种PLC运动控制模块功能验证设备与验证方法。
【背景技术】
[0002]PLC控制运动系统是工业生产的重要组成部分，可实现精确的定位控制，并且成本较低，硬件维护方便，在工业生产中得到广泛的应用。PLC运动控制指令分单轴、多轴和轴组指令。单轴指令主要由绝对定位指令和相对定位等指令组成;多轴指令主要由电子齿轮、电子凸轮两组指令组成；轴组指令提供空间直线、圆弧以及NURBS样条插补功能，通过型值点确定轨迹方程，在满足误差精度要求的情况下将轨迹方程转化为插补点执行。而在工业控制系统应用过程中，除上述指令外，通常还需要开发新的各类运动控制功能指令，以保证满足实际应用需求。尤其在PLC运动控制器进行多轴、轴组同步控制应用中，需要复杂的运动轨迹规划，运动控制指令及其参数设置对实际控制效果影响较大，需要软件修改运动控制指令，无法通过搭建模拟开发平台模拟程序的方式完成调试，而进行实际现场功能验证会增加项目开发周期。
[0003]因此，在项目初期的开发调试过程中，需要一种可在多种行业应用的运动控制模块功能验证设备，本实施例中的功能验证设备采用耦合型并联机构与控制器a2和控制器b3的双PLC运动控制器搭建的系统平台进行前期功能验证，以降低工业控制系统开发的成本，保证产品的开发质量和周期。
【发明内容】
[0004]针对PLC运动控制功能模块指令及控制程序开发和调试过程中出现的不足，本发明提供一种通用的集建模、优化、仿真及实验于一体的PLC运动控制模块功能验证方法，可从单轴、多轴、轴组等方面对PLC运动规划控制的性能进行高效验证，具有良好的灵活性和扩展性。
[0005]为实现上述目的，本发明通过以下技术方案实现:
[0006]一种PLC运动控制模块功能验证设备，包括PLC运动控制器系统、耦合型并联平台以及上位机。
[0007]所述的耦合型并联平台为三条并联支链和一个旋转伸缩轴组成的耦合型并联机构，在控制信号的激励下，耦合型并联平台能够实现三个方向的耦合平移运动和一个垂直方向的旋转运动，从单轴、多轴、轴组等多个方面对PLC运动控制规划的性能进行验证，实现轴组拆分、组合和变换功能验证;所述的耦合型并联平台具有三到六个自由度构成的多种形式的耦合型并联机构。
[0008]所述的PLC运动控制器系统包括控制器a2、控制器b3和伺服驱动系统;所述的控制器a2接受上位机发送的轨迹参数和目标位置信息，并向伺服驱动系统发送高速脉冲序列信号，伺服驱动系统驱动耦合型并联平台进行功能验证;所述的控制器b3与伺服驱动系统通信采集伺服系统反馈的脉冲数和角速度值，采集的数据由上位机进行读取，上位机对采集的数据进行分析处理;所述的伺服驱动系统包括多个伺服驱动以及其它附属传感器系统和逻辑电路等。
[0009]所述的PLC运动控制器a2通过发送高速脉冲的方式对伺服驱动进行精确控制。PLC运动控制器系统基于PLCOpen标准的功能块指令对耦合型并联平台进行速度控制、位置控制，实现耦合型并联平台的功能验证;PLC运动控制器系统使用FPGA进行高速计数、脉冲输出和轴组管理，实现耦合型并联平台的精确定位和多轴同步。
[0010]所述的上位机通过以太网6与控制器a2通信;通过RS485串口与控制器b3通信。
[0011]一种采用上述设备进行PLC运动控制模块功能验证方法，包括以下步骤:
[0012]1)建立耦合型并联平台II的运动学模型、动力学模型和运动轨迹模型，由运动学和动力学约束得到约束条件数学模型;根据约束条件数学模型与运动轨迹模型建立轨迹规划模型，利用MATLAB优化求解轨迹规划模型，获得电机驱动曲线。所述的电机驱动曲线包括驱动关节速度、加速度及转矩曲线。
[0013]2)搭建耦合型并联平台II的ADAMS仿真模型，ADAMS仿真模型采用插补轨迹规划方法对MATLAB优化求解的轨迹规划模型进行仿真分析，得到仿真结果;仿真结果验证轨迹规划模型对耦合型并联平台末端控制路径偏移以及驱动关节运动曲线动态性能的影响。所述的仿真结果为驱动关节的角速度、角加速度和转矩曲线。
[0014]3)基于PLC运动控制模块功能验证设备进行插补轨迹试验，控制器b3与伺服驱动系统通信采集伺服系统反馈的脉冲数和角速度值，处理后，电机速度及转矩曲线由上位机读取得到实验结果，上位机对当前电机运行状态进行实时跟踪测定。
[0015]4)将实验结果与仿真结果对比得到单轴、多轴、轴组功能验证结果。
[0016]上述的技术方案中，提供一种通用的集建模、优化、仿真及实验于一体的PLC运动控制模块功能验证设备与方法。
[0017]本发明的有益效果是:基于耦合型并联机构与控制器a2和控制器b3的双PLC运动控制器搭建的系统平台，通过数据采集与运动控制相互独立，从单轴、多轴、轴组等方面对PLC运动控制规划的性能进行高效验证，可在多种应用场合中验证运动控制指令及其参数设置对实际控制效果影响，具有较好的灵活性和扩展性。
【附图说明】
[0018]图1为PLC运动控制模块功能验证设备系统组成框图；
[0019]图2为PLC运动控制模块功能验证方法的流程图；
[0020]图3(a)原有门字型轨迹;图3(b)所提轨迹；
[0021]图4(a)所提轨迹下Matlab仿真驱动关节速度曲线；?0022]图4(b)所提轨迹下Matlab仿真加速度曲线；
[0023]图4(c)所提轨迹下Matlab仿真转矩曲线；
[0024]图5为耦合型并联平台ADAMS仿真模型；
[0025]图6(a)ADAMS仿真单一驱动关节的角速度曲线；
[0026]图6(b)ADAMS仿真单一驱动关节的角加速度曲线；
[0027]图6(c)ADAMS仿真单一驱动关节的转矩曲线
[0028]图7(a)实验采集的驱动关节转角位移曲线；
[0029]图7(b)实验采集的单一驱动关节角速度及转矩曲线；
[0030]图中:IPLC运动控制器系统；II耦合型并联平台；III上位机；1伺服驱动系统;a2控制器;b3控制器;4支链;5旋转伸缩轴;6以太网。
【具体实施方式】
[0031]下面结合附图对本发明进一步描述:
[0032]如附图1所示，一种PLC运动控制模块功能验证设备，包括PLC运动控制器系统1、耦合型并联平台II以及上位机III，其中:
[0033]上位机III通过以太网6与控制器a2通信，上位机III通过RS485串口与控制器b3通信。PLC运动控制器系统I包括用于接受上位机III发送的轨迹参数和目标位置并向伺服驱动系统1发送脉冲序列信号的控制器a2、用于和伺服驱动系统1通信数据采集并可由上位机III进行变量区数据读取的控制器b3