PLC控制伺服电机应用实例.docx

PLC控制伺服电机应用实例.docx

《PLC控制伺服电机应用实例.docx》由会员分享，可在线阅读，更多相关《PLC控制伺服电机应用实例.docx（9页珍藏版）》请在冰豆网上搜索。

PLC控制伺服电机应用实例

PLC控制伺服电机应用实例，写出组成整个系统的PLC模块及外围器件，并附相关程序.

        PLC品牌不限.之五兆芳芳创作

以松下FP1系列PLC和A4系列伺服驱动为例，编制控制伺服电机定长正、反旋转的PLC程序并设计外围接线图，此计划不采取松下的位置控制模块FPGPP11\12\21\22等，而是用晶体管输出式的PLC，让其特定输出点给出位置指令脉冲串，直接发送到伺伏输入端，此时松下A4伺服任务在位置模式.在PLC程序中设定伺服电机旋转速度，单位为（rpm），设伺服电机设定为1000个脉冲转一圈.PLC输出脉冲频率=（速度设定值/6）*100（HZ）.假定该伺服系统的驱动直线定位精度为±0.1mm，伺服电机每转一圈滚珠丝杠副移动10mm，伺服电机转一圈需要的脉冲数为1000，故该系统的脉冲当量或说驱动分辩率为0.01mm（一个丝）；PLC输出脉冲数=长度设定值*10.

以上的结论是在伺服电机参数设定完的根本上得出的.也就是说，在计较PLC收回脉冲频率与脉冲前，先按照机械条件，综合考虑精度与速度要求设定好伺服电机的电子齿轮比！

大致进程如下：

机械机构确定后，伺服电机转动一圈的行走长度已经固定（如上面所说的10mm），设计要求的定位精度为0.1mm（10个丝）.为了包管此精度，一般情况下是让一个脉冲的行走长度低于0.1mm，如设定一个脉冲的行走长度为如上所述的0.01mm，于是电机转一圈所需要脉冲数即为1000个脉冲.此种设定当电机速度要求为1200转/分时，PLC应该收回的脉冲频率为20K.松下FP140T的PLC的CPU本体可以发脉冲频率为50KHz，完全可以满足要求.

如果电机转动一圈为100mm，设定一个脉冲行走仍然是0.01mm，电机转一圈所需要脉冲数即为10000个脉冲，电机速度为1200转时所需要脉冲频率就是200K.PLC的CPU输出点任务频率就不敷了.需要位置控制专用模块等方法.

有了以上频率与脉冲数的算法就只需应用PLC的相应脉冲指令收回脉冲便可实现控制了.假定使用松下A4伺服，其任务在位置模式，伺服电机参数设置与接线方法如下：

 一、依照伺服电机驱动器说明书上的“位置控制模式控制信号接线图”接线：

   pin3（PULS1），pin4（PULS2）为脉冲信号端子，PULS1连接直流电源正极（24V电源需串连2K左右的电阻）,PULS2连接控制器（如PLC的输出端子）. 

   pin5（SIGN1），pin6（SIGN2）为控制标的目的信号端子，SIGN1连接直流电源正极（24V电源需串连2K左右的电阻），SIGN2连接控制器（如PLC的输出端子）.当此端子接收信号变更时，伺服电机的运转标的目的改动.实际运转标的目的由伺服电机驱动器的P41，P42这两个参数控制，pin7（com+）与外接24V直流电源的正极相连.pin29（SRV0N），伺服使能信号，此端子与外接24V直流电源的负极相连，则伺服电机进入使能状态，通俗地讲就是伺服电机已经准备好，接收脉冲便可以运转. 

   上面所述的六根线连接完毕（电源、编码器、电机线当然不克不及忘），伺服电机便可按照控制器收回的脉冲与标的目的信号运转.其他的信号端子，如伺服报警、偏差计数清零、定位完成等可按照您的要求接入控制器组成更完善的控制系统. 

二、设置伺服电机驱动器的参数. 

  1、Pr02控制模式选择，设定Pr02参数为0或是3或是4.3与4的区别在于当32（CMODE）端子为短路时，控制模式相应变成速度模式或是转矩模式，而设为0，则只为位置控制模式.如果您只要求位置控制的话，Pr02设定为0或是3或是4是一样的. 

  2、Pr10，Pr11,Pr12增益与积分调整，在运行中按照伺服电机的运行情况相应调整,达到伺服电机运行平稳.当然其他的参数也需要调整（Pr13，Pr14,Pr15,Pr16，Pr20也是很重要的参数），在您不太熟悉前只调整这三个参数也可以满足根本的要求. .

  3、Pr40指令脉冲输入选择，默认为光耦输入（设为0）便可.也就是选择3（PULS1），4（PULS2），5（SIGN1），6（SIGN2）这四个端子输入脉冲与标的目的信号. 

  4、Pr41，Pr42复杂地说就是控制伺服电机运转标的目的.Pr41设为0时，Pr42设为3,则5（SIGN1），6（SIGN2）导通时为正标的目的（CCW），反之为反标的目的（CW）.Pr41设为1时，Pr42设为3,则5（SIGN1），6（SIGN2）断开时为正标的目的（CCW），反之为反标的目的（CW），正、反标的目的是相对的，看您如何定义了，正确的说法应该为CCW，CW .

  5、Pr48、Pr4A、Pr4B电子齿轮比设定.此为重要参数，其作用就是控制电机的运转速度与控制器发送一个脉冲时电机的行走长度.  

   其公式为：

   伺服电机每转一圈所需的脉冲数=编码器分辩率×Pr4B／（Pr48×2^Pr4A） 

   伺服电机所配编码器如果为：

2500p/r5线制增量式编码器，则编码器分辩率为10000p/r 

   如您连接伺服电机轴的丝杆间距为20mm，您要做到控制器发送一个脉冲伺服电机行走长度为一个丝（0.01mm）.计较得知：

伺服电机转一圈需要2000个脉冲（每转一圈所需脉冲确定了，脉冲频率与伺服电机的速度的关系也就确定了） .

   三个参数可以设定为：

Pr4A=0，Pr48=10000，Pr4B=2000，约分一下则为：

Pr4A=0，Pr48=100，Pr4B=20. 

   从上面的叙述可知：

设定Pr48、Pr4A、Pr4B这三个参数是按照我们控制器所能发送的最大脉冲频率与工艺所要求的精度.在控制器的最大发送脉冲频率确定后，工艺精度要求越高，则伺服电性能达到的最大速度越低.松下FP140T型PLC的程序梯型图如下：

     S7—200PLC在数字伺服电机控制中的应用 

 首先了解plc如何控制伺服电机

1、电机的连线及控制

      本应用实例选择的是位置控制模式，脉冲输入方法有集电极开路方法和差动驱动方法两种，为了便利的实现同时对两部电机的控制，采取差动驱动方法.与PLC的接线图如图所示.

                                                                                PLC与伺服缩小器接线图

图中L+为公共PLC端子，接24VDC正端，通过控制内部晶体管的开关使得输出Q呈现不合的电平信号或收回脉冲信号.L+一PG—PlM—L+为脉冲输入回路，PLC控制该回路中的发光二极管的亮灭，形成脉冲编码输入.L+一NG—NP一1M—L+为电机旋转标的目的控制回路，当该回路的发光二极管点亮时，电机正转，不然反转.由于伺服缩小器内部电阻只有100欧，为

了避免电流过大烧坏内部的发光二极管，需要外接电阻R，其阻值的计较如下：

按照公式

（1），可以选择R=3．9KO

2、电子齿轮比

数字交换伺服系统具有位置控制的功效，可通过上位控制器收回位置指令脉冲.而伺服系统的位置反应脉冲当量由编码器的分辩率及电机每转对应的机械位移量等决定.当指令脉冲当量与位置反应脉冲当量两者不一致时，就需要使用电子齿轮使两者匹配.使用了电子齿轮功效，就可以任意决定一个输入脉冲所相当的电机位移量.具有电子齿轮功效的伺服系统结构如图3所示.若机械传动机构的螺距为w，指令脉冲当量为△L，编码器每转脉冲数为P，又考虑到一般电机轴与传动丝杠为直接相连，则位置反应脉冲当量△=W／4P.

                                                                        具有电子齿轮功效的伺服系统结构图

由于脉冲当量与反应脉冲当量不一定相等，就需要使用电子齿轮比来成立两者的关系.具体计较公式为：

AL=3M×CMX/CDV

.因此按照一个指令脉冲的位置当量和反应脉冲的位置当量，就可以确定具体的电子齿轮比.三菱该系列伺服电机的电子齿轮比的设定规模

对于输入的脉冲，可以乘上其中任意倍率使机械运行.

下面是plc控制私服的具体应用

3、PIC控制原理及控制模型

     本例采取了西门子s7．200系列CPU226作为主控制器.它是s7．200系列中的高级PLC，本机自带24个数字输人口、l6个数字输出口及两个RS422／485串行通讯口，最多可扩展7个应用模块j.实际项目中，通过扩展EM231模拟量输入模块来收集电压信号，输入的模拟信号可在0～10V±5V、0～20mA等多种信号输入方法中选择.最终，PLC按照输入电压信号的大小控制脉冲发送周期的长短，从而达到控制伺服电机速度的目的.

     3.1高速数字脉冲输出

     西门子s7．200系列AC／DC／DC（交换供电，直流I/O）类型PLC上集成了两个高速脉冲输出口，两个高速脉冲输出口辨别

通过Qo．0、Qo．1两个输出端子输出，输出时可选择PWM（脉宽调制）和PIO（脉冲串）方法.PIO方法每次只能收回固定脉冲，脉冲开始发送后直到发送完毕才干开始新的脉冲串；PWM方法相对灵活，在脉冲发送期间可随时改动脉冲周期及宽度，其中脉冲周期可以选择微秒级或毫秒级.

     3.2PID功效特性

     该系列PLC可以通过PID回路指令来进行PID运算，在一个程序中最多可以用8条PID指令，既最多可同时实现8个PID

控制算法.在实际程序设计中，可用STEP7Micro／Win32中的PID向导程序来完成一个闭环控制进程的PID算法，从而提高

程序设计效率.

     3.3控制模型

    控制模型方框图如下图所示，其中Uset为极间电压给定值（此时产气状态最佳），Uf为极间电压采样值，Vout为伺服电机

运转速度.通过对电弧电压采样值与弧间电压给定值的比较并经过PLC的PID调节回路控制，可以得出用于控制伺服电机旋

转的脉冲发送周期T，从而使伺服电机的送棒速度不断的得到调整，这样就达到了控制两极间距的目的.包管了两极间距的

相对稳定，也就包管了极间电压的稳定性.

                                                                            PID调节控制原理框图

按照极间距对极间电压的影响，可以设定PLC的PID调节回路调整战略如下：

Uset—uf<0，T减小；

Uset—uf>0，T增大.

通过上述控制办法，能够比较精确的实现对UF的控制.

4、程序设计

以下应用程序是经过简化的，没有涉及异常情况.其设计以本文前面所述办法及原理为依据，并给出了详尽的程序注释.

 4.1主程序

NErW0RK1

①IJDSM0．1

／／SM0．1=1仅第一次扫描有效

②MOVW+0，VW450

／／PID中断计数器初始化

③MOVB100，SMB34

／／设置定时中断时间距离为lOOms

④ATCHINT—PWM—PID，10

／／设定中断，启动PID执行

⑤ENI

//开中断

4．2中断程序

①NETWORK1

LDSM0．0

／／SM0．0=1每个扫描周期都有效

ICWV VW450

／／调用中断程序次数加1

②NETWORK2

LDW>=VW450．+10

／／查抄是否应进行PID计较

M0VW+0，VW450

／／如果如此，清计数器并持续

N0T

JMP0

／／不然，转人中断程序结尾

③NETWORK3

／／计较并装载PIDPV（进程变量）

IDSM0．0

RPS

XORWVW464，VW464

／／清除任务区域

M0VWArW0．VW466

／／读取模拟数值

AV466．7

M0VW16#FFFF．VW464

／／查抄符号位，若为负则扩展符号

LRD

DTR VD464．VD396

／／将其转化成实数并装载人PV 

LPP

／R32000．0，VD396

／／正常化至0．0至1．0之间的数值

④NETWORK4

IDSM0．0

MOVRVIM00，VIM00

／／VIM00为设定值

⑤⑥NETWORK6

IDSM0．0

PIDVB396，0

／／进行PID计较

⑦NETWORK7

LDSM0．0

M0vRVD404．VD464

／／装载PID输出至任务区

+RVD400，VD464

*R1000．0.VIM64

／／缩放数值

TRUNCVD464,VD464

／／将数值转化成整数

MOVWVW466．VW1000

／／VW1000为PLC输出脉冲周期

⑧NETWORK8

／／伺服电机右反转控制（PWM）

／／SMW68／78lIFO周期值

／／SMW70／80PWM脉冲宽度

／／SMD72／82lIFO脉冲计数值

LDSM0．0

MOVB16#D3．SMB77

／／输出脉冲周期为500微秒

MOVWVW1000，SMW78

MOVWVW1000．VW1118

／I+2．VWl118

MOVWVW1118．SMW80

PIS1

⑨NETWORK9 

LBL 0

本例给出了利用西门子PLC的高速脉冲输出及PID控制功效，实现对数字式交换伺服电机进行控制的原理及相应编程办法.此控制办法已成功用于水燃气生产控制系统中，效果良好

                                                          基于1756M08SE模块的多轴交换伺服控制系统（二轴）

    由于开发程序较大，这里我们只给出伺服的点动，正反向，等的控制！

先介绍如下：

        总体概述：

罗克韦尔伺服传动习惯于用EQU（等于指令）比较数字量输入模块0号位输入次数的奇偶次数来辨别控制伺服环的闭合和断开.其中MSO指令用于直接激活伺服驱动器并且使能与物理伺服轴相关的已组态伺服环.触发MSO指令后，指定轴进入伺服控制状态.当轴处于移动状态时，执行该指令无效.如果这时触发了该指令，MSO指令会产生一个“AxisinMotion”的毛病.MSF指令用于直接立即关断伺服驱动器输出，并且禁止物理伺服轴的伺服环.这会使轴处于准备状态.该指令可以禁止任意正在执行的其他运动计划.且若需要直接用手来移动轴时，可以用该指令关断伺服操纵.

要成功执行以上两条运动状态指令，有个需要的前提，即目标轴必须组态为伺服轴，如果该条件不满足，该指令会产生错误.

      成立坐标也是主程序中一个很是重要的环节.无论是在产业现场或是其它地方的运动控制系统中，根本上都须要成立一个坐标系.若不成立一个坐标系，虽然可以用增量式的控制方法来实现一些复杂的控制，但是这样的方法不克不及实现对实际位置的反应等操纵，并且控制方法庞杂.所以在成熟公道的控制系统中成立坐标系是必不成少的一个环节.坐标系的成立可以使控制变得很便利，且可实现对系统当前所在位置的实时反应等功效.

本次设计所控制的轴为以罗克韦尔公司型号为Y10022H00AA的电动驱动的两根丝杆.丝杆长330mm，每个螺距为5mm，其实物如图1所示.（伺服轴）

系统的架构如下图：

系统的实现：

    在硬件上一个完整的伺服系统由控制器、通信网络、驱动器、电动机、执行机构及检测装置组成.其中控制器相当于人的大脑，用来阐发各类输入信号（命令和反应等）；通信网络相当于人的神经系统，如SERCOS接口、DeviceNet接口等；而驱动器则像是肌肉所起的作用一样，用于将控制信号进行功率缩小，以驱动电动机；电动机相当于手，而人手中的生产东西则是伺服系统的中执行机构（如滚珠丝杆等，将电动机的旋转运动转化为直线运动）.在以上两章系统阐发和设计中论述了系统各个部分的功效和特点，而要实现本次设计的功效的硬件连接如图4.1所示.

最经常使用指令介绍：

本次设计中利用MAJ和MAS指令来实现手动程序的编写.在程序中MAJ（MotionAxisJog）指令用于点动伺服轴.点动轴的轮廓可设置为依照S形曲线平滑达到设定速度，也可依照梯形曲线达到设定速度，同时该指令可将任何当前轴的运动转换为单纯的点动运动.轴在点动运行进程中，可以使用MAS指令停止该轴，或触发另一个MAJ指令.MAS（MotionAxisStop）指令用于停止指定物理轴的任意运动，而无需禁止其伺服环（如果伺服环闭合）.对于任何被控制的轴运动均可使用该指令以设定的加速度进行停止，其可选用的停止方法有点动停止方法、齿轮停止等.

程序设计如下：

注：

其中的一些中间存放器为上位机HMI设置用的.可以不考虑！

PLC控制台达伺服电机图片：

－、接线图：

（草图，有待整理优化）

1、PLC接线图

  K1A、K1B－－－K3B等中间继电器采取固态继电器.

2、伺服控制器接线图

伺服控制器为北京欣斯达特数字科技有限公司产品，该MicroStepTX3H504D驱动器性能如下：

二、编程：