基于PMC6496运动控制器的机械手上下料系统

一 PMC6496的特点

PMC6496运动控制器是雷赛公司在独立式运动控制器的基础上，精心研发的一款具有PLC特点的高性能产品。由于其全面支持IEC61131-3标准梯形图编程语言，在逻辑控制上完全可以与中、小型PLC媲美。同时，其强大的运动控制功能更是传统中、小型PLC无法匹敌的。

1 .PMC6496的硬件性能

图1为PMC6496运动控制器的硬件结构图。



图1 PMC6496运动控制器硬件结构

PMC6496基于嵌入式处理器和FPGA的硬件结构，插补算法、脉冲信号的产生及加速和减速控制、I/O信号的检测处理，均由硬件和固件实现，确保了运动控制高速、高精度及系统稳定。该系列控制器可控制4个步进或伺服电机，具有最高5MHz脉冲频率、四轴直线插补、两轴圆弧插补、连续曲线插补、S形曲线速度控制等高级功能。通过简单的编程即可开发出稳定可靠的高性能连续轨迹运动控制系统。

除了4个电机控制端口外，还提供了丰富的I/O接口和通讯接口：光电隔离I/O接口、扩展I/O接口、D/A输出、PWM输出、编码器接口、手摇脉冲发生器接口。1个网络接口、2个串行口，可通过网口或串口与PC机通信；同时还可以通过串口连接其它设备，如：手持编程器、触摸屏、PLC等。可通过U盘接口用U盘方便地存储文件和参数。Flash用于存储用户程序、铁电存储器用于参数的掉电保存。PMC6496的主要技术指标详见表1。

表1 PMC6496控制器硬件性能



2. PMC6496的功能特性

PMC6496运动控制器运动控制性能优异的，工作稳定可靠，梯形图编辑环境友好。其主要特点如下：

简单易学：由于梯形图是自动化行业工程师最熟悉的编程语言，因此PMC6496的推出，大大降低了运动控制器的应用门槛，使用户更容易上手，快速开发自己的设备。

强大的运动控制功能：PMC6496可控制4轴步进电机或伺服电机进行4轴直线插补，任意2轴圆弧插补，多轴连续插补。可进行椭圆，螺旋等轨迹控制。并且，PMC6496配置了2048段指令缓冲，有效地保证了高速轨迹运动的连续性和平滑度。

友好的梯形图编辑环境：全面支持IEC61131-3标准梯形图编程语言，支持子程序，梯形图比较，看门狗，单步调试等功能，梯形图开发更加方便快捷。

HMI设备支持：PMC6496可与基于标准Modbus协议的人机界面进行通讯，包括：触摸屏、文本显示器、手持编程器等。用户只需在人机界面设计时，按相应的寄存器地址映射公式正确设置各种软元件的Modbus地址即可，而几乎不需要编写任何程序代码。

网络通讯：PMC6496是一款基于10/100M以太网的PLC，可以使得梯形图调试、下载等在线操作更加流畅。

二 机械手上下料的运动轨迹

某客户的生产线上需要使用机械手上下料，结构如图2所示。X轴执行水平左右运动，Y轴执行竖直上下运动，手爪由气缸控制执行抓取动作。它们的任务是将右侧工装上的工件依次抓取至左侧传送带上。X轴原点距离传送带上工件放置点为W，工装上第一个工件距离传送带上工件放置点为S，工装上每个工件之间的距离均为L。



图2 机械手上下料系统组成

通常，大多数用户会将X、Y的运动轨迹确定为矩形，即Y轴上下运动完成后X轴再水平运动，然后Y轴再次上下运动，如此反复进行。但这样的方式会导致比较强烈的抖动，并且造成一定的时间浪费。

因此，可采用图4所示的运动轨迹，在2个拐弯处，X、Y轴进行一段半径为R的圆弧插补运动，这样可大大减弱抖动，且能节省时间。A点为起始点，抓取并放置第1个工件的路径为A→B→C→D→E→F→G→H→I→J→K，抓取并放置第2个工件的路径与第一个相同，只不过A→B和F→G的距离增加了长度L，第3个、第4个、第5个亦然。

PMC6496支持连续插补运动，在连续插补模式下，速度是连续的，各插补段之间没有加减速过程，从而使得运动更加平滑。运行CONTI_ENTER功能块后进入连续插补模式，加入要求的插补运动轨迹，使用LINE_START功能块启动连续插补运动，PMC6496以连续插补模式运行完所有运动轨迹。



图3 连续插补运动



图4 机械手上下料运动轨迹

三 机械手上下料控制系统流程

绘制流程图，如图5所示。每次启动时，将抓取次数重置为0，抓取5次后结束。“夹紧”和“松开”为气缸动作。





图5 机械手上下料流程图



四 机械手上下料控制系统的程序



机械手上下料控制系统程序如图6所示。







图6 机械手上下料程序(程序1-4节)



图6（续2） 程序5-22节