基于雷赛PMC运动控制器的机械手上下料系统.docxVIP

基于PMC6496运动控制器的机械手上下料系统深圳市雷赛智能控制股份有限公司 赵向前 左 力摘 要：PMC6496运动控制器全面支持IEC61131-3标准梯形图编程语言，不仅拥有强大的逻辑控制功能，不添加其它模块即可实现高精度的直线插补、圆弧插补、螺旋插补等轨迹控制。本文通过一个机械手上下料控制系统的案例，介绍采用PMC6496的梯形图程序进行多轴复杂轨迹控制的方法。关键词：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控制器硬件性能主要指标描述控制电机数4轴指令脉冲频率范围1~5.0 M Hz指令脉冲数-2,147,483,647 ~ +2,147,483,648（32位）脉冲输出模式脉冲+方向、双脉冲通用数字输入32路（即输入继电器X：X0~X31），低通RC滤波输入口可识别脉冲宽度 15 ms通用数字输出24路（即输出继电器Y：Y0~Y23），低通RC滤波PWM输出2路：最高频率1M Hz，0~100%占空比可调编码器接口4路编码器最高计数频率4M Hz编码器计数范围-2,147,483,647 ~ +2,147,483,648（32位）手摇脉冲发生器输入口1路，输入脉冲最大频率1M Hz掉电保护32K铁电存储器网络接口以太网，10M/100M串口通讯2路，RS-232U盘接口USB1.1(12Mb/s)外部电源24V dc，最大1100mA外壳尺m电源DC 24 V，最大1100 mA2. 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。Y轴X轴图2 机械手上下料系统组成通常，大多数用户会将X、Y的运动轨迹确定为矩形，即Y轴上下运动完成后X轴再水平运动，然后Y轴再次上下运动，如此反复进行。但这样的方式会导致比较强烈的抖动，并且造成一定的时间浪费。因此，可采用图4所示的运动轨迹，在2个