基于PLC和伺服电机的输送站控制系统设计.docx

《基于PLC和伺服电机的输送站控制系统设计.docx》由会员分享，可在线阅读，更多相关《基于PLC和伺服电机的输送站控制系统设计.docx（8页珍藏版）》请在课桌文档上搜索。

1、摘要：目的：利用P1.C和伺服电机实现对输送站机械手的位置控制，最终实现输送站机械手在各个工作站之间的精准定位。方法：采用MAP指令库的编程方法，控制机械手寻找原点和固定位置，使其能够在自动化生产线的供料站、加工站、装配站和分检站间进行物料的搬运和传送。结果：该系统设计可实现各站间的有机结合，保证整个自动化生产线的平稳有效运行。关键词：P1.C；伺服电机；位置控制；MAP指令库O引言随着工业4.0时代的到来，传统工业正逐步被各种各样的自动线取代。输送站在自动化生产线中起着联系各个站点，使站点之间能高效分工协作的作用，是自动化生产线中的核心工作站。为了能使自动化生产线平稳工作，输送站的机械手需精

2、准到达各个站点位置，因此对于机械手的定位控制就显得极为重要。本文主要研究如何实现机械手精准回零,找到固定位置。1 机械手装置结构和工作过程1.1 结构输送站机械手装置主要由抓取机械手装置、直线运动传动组件、拖链装置和P1.C等部件组成。抓取机械手装置安装在直线运动传动组件的滑动溜板上，在传动组件带动下整体作直线往复运动。驱动抓取机械手精准定位到指定站点，进行抓取和放下物料操作。为了方便阐述，本文设计了一个简单的控制流程，要求如下：(1)按下按钮开关SBl,机械手开始寻找原点，归零完成后指示灯H1.l亮；(2)按下按钮开关SB2,机械手以100mm/s的速度运行到600mm的位置，到位后延时3s

3、,再返回原点。只要实现了上述控制，要想驱动机械手精准定位到各个站点，只要修改个别数据即可。2 控制系统设计1 .1P1.C选型及I/O地址分配由于需要输出驱动伺服电机的高速脉冲，P1.C应采用晶体管输出型。本文选用西门子S7-226P1.Co根据控制要求进行了以下I/O地址分配，如表1所示。表1I/O地址分配表输入信号输出信号序号P1.C输入点信号名称序号P1.C输出点信号名称110.0原点传感器190.0脉冲210.1右限位保护2Q0.2方向310.2左限位保护3Q1.6H1.l指示灯411.2伺服报警512.4SBl612.5SB22 .2伺服控制器参数设置及接线本文采用松下MHMD022

4、G1U伺服电机和MADHT1507E伺服驱动装置，根据伺服电机手册，设置参数：PrO.01,设置数值为“0”；PrO.02,设置数值为“1”；PrO.03,设置数值为“13”；PrO.04,设置数值为“250”；PrO.06,设置数值为“1”；PrO.07,设置数值为“3”；PrO.08,设置数值为“6000”；Pr5.04,设置数值为“2”；Pr5.28,设置数值为“1”。2.2.2主要参数设置说明PrO.01是用来设置伺服电机的控制模式，本文设置的控制方式是位置控制，代码为P,对应的设定值为“0”。PrO.06与PrO.07需组合使用，采用“1”和“3”组合的方式。指令脉冲形态用“脉冲序列

5、+符号”，正方向用低电平驱动。极性设定值为1,在上升沿时读取脉冲序列。用PU1.S2输出到P1.C,P1.C依据收到的脉冲数来判断机械手是否到位。用SIGN2输出到P1.C,进行机械手运行方向的控制，低电平为正向，高电平为负向。PrO.08是设置伺服电机转动一圈的脉冲数，设置为6OOO个脉冲。本文用到的直线运动传动组件的同步轮齿距为5nun,共12个齿，旋转一周为60mmoA5系列的伺服电机，电机编码器反馈脉冲为每圈2500个。缺省情况下，电子齿轮分一倍频为4倍，可实现电机每转一圈向P1.C输出脉冲为10000个。为了方便计算，本文把指令脉冲电子齿轮分一倍频设置为100oo/6000,实现电机

6、每旋转一圈，向P1.C输出6000个脉冲，驱动机械手恰好移动60mm的整数倍关系。这样位置分辨率，即每1个指令脉冲的移动量加60mm/6000=0.01mm,即100个脉冲驱动机械手走1mmo2.2.3接线根据硬件接线手册，伺服电机简化接线图如图1所示。图1伺服电机简化接线图3程序设计程序设计软件使用STEP7-MicroWIN,实现控制的方法有两种，种是利用位置控制向导实现，另一种是利用脉冲输出指令库MAP实现。位置控制向导相对复杂，后期调试较困难。而脉冲输出指令库MAP控制方法简单，调试方便，本文采用这种方法。3.1 脉冲输出指令库MAPS7200系列的P1.C本体PTO提供了应用库MAP

7、SERVQ0.0和MAPSERVQ01,分别用于Q00和Q01的脉冲串输出。本文用指令库MAPSERVQ0.0进行程序设计，应用该库时，一些输入输出点的功能被预先定义。在程序设计时，这些输入输出点不能再作他用。输出点Q0.0只能作为脉冲输出，QO.2作为方向输出，分别接到伺服电机的PU1.S2和SIGN2。输入点I00只能作为参考点输入，高速计数器只能使用HCOo3.2 程序设计步骤第一步，调用QOJ1.CTR1.功能块，如图2所示。图2调用虬OKl网功能块Velocity_SS是最小脉冲频率，是加速过程的起点和减速过程的终点。此处设为脉冲2000个s,依据前文算出的位置分辨率，*O.Olmm

8、,即电机最小速度为20mm/s。VeIOCity_Max是最大脉冲频率，此处设为脉冲10OOO个s,即电机最大速度为100mm/so在程序中其他地方设置的脉冲频率要在这个范围内，否则将会被Velocity-SS或VelocityJfax所取代。accel_dec_time是加减速时间，设为0.5s,即由最小速度加速到最大速度（或由最大速度减速到最小速度）所用时间为0.5So10.1和10.2分别是机械手传送装置的左限位保护开关和右限位保护开关。第二步，用Q0_0_Home功能块寻找参考点，如图3所示。SMOOIIQO-OJomeENEXEarPositiDgeStatDirEnocM100M1

9、01II12.4TIIP0-MOO-图3寻找参考点在寻找过程的起始，电机首先以Start_Dir设定的方向，在本程序中MO.O为“0”，以负方向寻找参考点（MO.0为“1”，以正方向寻找参考点）。本文涉及的传输装置机械手一般位于参考点的正方向上，故采用负方向寻找参考点，即MO.0设置为“0”。寻找参考点时，以Homing_Fast_Spd的速度开始寻找，Homing_Fast_Spd默认值=Velocity_Max/2=5000,即电机速度为50mm/s。在碰到IimitSWitCh（“Fwc1.1.imit”or“Rev_1.imit”）后，即左限位保护开关10.1和右限位保护开关10.2减

10、速至停止，然后开始反方向寻找。当检测到参考点开关10.0的上升沿时，减速到“Homing_Slow_Spd”。Homing_Slow_Spd的默认值=VelOCity_SS=2000,即电机速度为20mm/sO如果此时的方向与“Final_Dir（寻找参考点过程中的最后方向）相同，在检测到参考点开关下降沿时停止运动，将计数器HCO的计数值设为“Position”中所定义的值，本文为“0”。如果当前方向与“Final_Dir”不同，则改变运动方向，这样就可以保证参考点始终在参考点开关的同一侧（具体是哪一侧取决于“Final_Dir）。本文设置为参考点的右侧，所以电机在寻找参考点过程中的最后方向是

11、负方向,“FinalDirw的标志位相对地址+V0.2应该设置为“0”。第三步，调用QoJ1.1.oadPOS功能块。由于第二步找到的参考点位置与实际控制要求的参考点有一定的偏差，在本控制系统中偏差值为+15mm,为了清晰地定义绝对位置，必须重新寻找参考点，使得原参考点失效。本文中15mm对应的脉冲数为1500个，因此“New_Pos”设置为“1500”，如图4所示，用于将当前位置的绝对位置设置为预置值。SMOOM10.01500-QOJ1.1.oadPosENExEClr-M10.2WBl71CPoshVD506图4装载零点第四步，调用Q0_0_MoveAbsolute功能块，让电机以指定的

12、速度100mm/s运动到指定的绝对位置600mm处，如图5所示。延时3s,再返SMOO125回原点，如图6所示。Q。一O-MoveAbs*ENEXEClTPositionDoneVebcv-M10.560000-10000-SMOOIIQoJ1.MoVeAb/IItiNT37IIIPIEXECU-IIIpI-POKionDone10000-VelocityM10.3图6返回原点4结语基于P1.C和伺服电机控制的输送站系统，可以使输送站在自动化生产线上的各个站点精准定位，使自动化生产线上的加工、装配、分检等站点连成一个整体，实现产品的自动化操作，提高生产效率，改善劳动条件。该控制系统用MAP指令库编程，方法简单，检修和维护方便，可在实际生产中推广应用。