西门子/SIEMENS 品牌
经销商厂商性质
上海市所在地
西门子S7-200CPU代理商
西门子S7-200CPU代理商
SIEMENS 交、直流传动装置
1、 交流变频器 MICROMASTER系列:MM420、MM430、MM440、G110、G120.
MIDASTER系列:MDV
2、全数字直流调速装置 6RA23、6RA24、6RA28、6RA70、6SE70系列
SIEMENS 数控 伺服
SINUMERIK:801、802S 、802D、802D SL、810D、840D、611U、S120
系统及伺报电机,力矩电机,直线电机,伺服驱动等备件销售。
1 概述
2.1 MAP库的基本描述
现在,200系列 PLC 本体 PTO 提供了应用库MAP SERV Q0.0 和 MAP SERV Q0.1,分别用于 Q0.0 和 Q0.1 的脉冲串输出。如图2所示:
图2
注: 这两个库可同时应用于同一项目。
各个块的功能如表2所示:
表2
总体描述
该功能块可驱动线性轴。
为了很好的应用该库,需要在运动轨迹上添加三个限位开关,如图3:
? 一个参考点接近开关(home),用于定义位置 C_Pos 的零点。
? 两个边界限位开关,一个是正向限位开关(Fwd_Limit),一个是反向限位开关(Rev_Limit)。
? 位置? C_Pos 的计数值格式为 DINT ,所以其计数范围为(-2.147.483.648 to +2.147.483.647). ?
? 如果一个限位开关被运动物件触碰,则该运动物件会减速停止,因此,限位开关的安置位置应当留出足够的裕量?ΔSmin 以避免物件滑道尽头。
图3
2.2 输入输出点定义
应用MAP库时,一些输入输出点的功能被预先定义,如表3所示:
表3
2.3 MAP库的背景数据块
为了可以使用该库,必须为该库分配 68 BYTE(每个库)的全局变量,如图4所示:
图4
下表是使用该库时所用到的zui重要的一些变量(以相对地址表示),如表4:
表4
2.4 功能块介绍
下面逐一介绍该库中所应用到的程序块。这些程序块全部基于PLC-200 的内置PTO输出,完成运动控制的功能。此外,脉冲数将通过的高速计数器 HSC 计量。通过 HSC 中断计算并触发减速的起始点。
2.4.1 Q0_x_CTRL
该块用于传递全局参数,每个扫描周期都需要被调用。功能块如图5,功能描述见表5。
图5
表5
Velocity_SS 是zui小脉冲频率,是加速过程的起点和减速过程的终点。
Velocity_Max 是zui大小脉冲频率,受限于电机zui大频率和PLC的zui大输出频率。
在程序中若输入超出(Velocity_SS,Velocity_Max)范围的脉冲频率,将会被Velocity_SS 或 Velocity_Max 所取代。
accel_dec_time 是由 Velocity_SS 加速到 Velocity_Max 所用的时间(或由Velocity_Max 减速到 Velocity_SS 所用的时间,两者相等),范围被规定为 0.02 ~ 32.0 秒,但不要小于0.5秒。
警告:超出 accel_dec_time 范围的值还是可以被写入块中,但是会导致定位过程出错!
2.4.2 Scale_EU_Pulse
该块用于将一个位置量转化为一个脉冲量,因此它可用于将一段位移转化为脉冲数,或将一个速度转化为脉冲频率。功能块如图6,功能描述见表6。
图6
表6
下面是该功能块的计算公式:
2.4.3 Scale_ Pulse_EU
该块用于将一个脉冲量转化为一个位置量,因此它可用于将一段脉冲数转化为位移,或将一个脉冲频率转化为速度。功能块如图7,功能描述见表7。
图7
表7
下面是该功能块的计算公式:
2.4.4 Q0_x_Home
功能块如图8,功能描述见表8。
图8
表8
该功能块用于寻找参考点,在寻找过程的起始,电机首先以 Start_Dir 的方向,Homing_Fast_Spd 的速度开始寻找;在碰到limit switch (“Fwd_Limit” or “Rev_Limit”)后,减速至停止,然后开始相反方向的寻找;当碰到参考点开关(input I0.0; with
Q0_1_Home: I0.1)的上升沿时,开始减速到 “Homing_Slow_Spd”。如果此时的方向与 “Final_Dir” 相同,则在碰到参考点开关下降沿时停止运动,并且将计数器HC0的计数值设为 “Position” 中所定义的值。
如果当前方向与 “Final_Dir” 不同,则必然要改变运动方向,这样就可以保证参考点始终在参考点开关的同一侧(具体是那一侧取决于 “Final_Dir”)。
寻找参考点的状态可以通过全局变量 “Homing_State” 来监测,如表9:
表9
2.4.5 Q0_x_MoveRelative
该功能块用于让轴按照的方向,以的速度,运动的相对位移。功能块如图9,功能描述见表10。
图9
表10
2.4.6 Q0_x_MoveAbsolute
该功能块用于让轴以的速度,运动到的位置。功能块如图10,功能描述见表11。
图10
表11
2.4.7 Q0_x_MoveVelocity
该功能块用于让轴按照的方向和频率运动,在运动过程中可对频率进行更改。功能块如图11,功能描述见表12。
图11
表12
注意:Q0_x_MoveVelocity 功能块只能通过 Q0_x_Stop block 功能块来停止轴的运动。如图12:
图12
2.4.8 Q0_x_Stop
该功能块用于使轴减速直至停止。功能块如图13,功能描述见表13。
图13
表13
2.4.9 Q0_x_LoadPos
该功能块用于将当前位置的位置设置为预置值。功能块如图14,功能描述见表14。
图14
表14
注意:使用该块将使得原参考点失效,为了清晰地定义位置,必须重新寻找参考点。
2.5 校准
该块所使用的算法将计算出减速过程(从减速起始点到速度zui终达到Velocity_SS)所需要的脉冲数。但时在减速过程中所形成的斜坡有可能会导致计算出的减速斜坡与实际的包络不**。此时就需要对 “Tune_Factor” 进行校正。
校正因子 “Tune_Factor”
“Tune_Factor” 的*值取决于zui大、zui小和目标脉冲频率以及zui大减速时间。如图15:
图15
如图所示,运动的目标位置是B,算法会自动计算出减速起始点,当计算与实际不符时,当轴已经运动到B点时,尚未到达zui低速度,此时若位 ”Disable_Auto_Stop” = 0,则轴运动到B点即停止运动,若位 ”Disable_Auto_Stop” = 1,则轴会继续运动直至到达zui低速度。图中所示的情况为计算的减速起始点出现的太晚了。
确定调整因子
注意:一次新的校准过程并不需要将伺服驱动器连接到CPU。
步骤如下:
1. 置位 ”Disable_Auto_Stop”,即令 ”Disable_Auto_Stop” = 1。
2. 设置 “Tune_Factor” = 1。
3. 使用 Q0_x_LoadPos 功能将当前位置的位置设为0。
4. 使用 Q0_x_MoveRelative,以的速度完成一次相对位置运动(留出足够的空间以使得该运动得以顺利完成)。
5. 运动完成后,查看实际位置 HC0。Tune_Factor 的调整值应由 HC0,目标相对位移 Num_Pulses,预估减速距离 Est_Stopping_Dist 所决定。Est_Stopping_Dist 由下面的公式计算得出:
Tune_Factor由下面的公式计算得出:
6. 在调用 Q0_x_CTRL 的网络之后插入一条网络,将调整后的 Tune_Factor 传递给全局变量 +VD1,如图16。
图16
7. 复位 ”Disable_Auto_Stop”,即令 ”Disable_Auto_Stop” = 0。
2.6 寻找参考点的若干种情况
在寻找参考点的过程中由于起始位置、起始方向和终止方向的不同会出现很多种情况。
一个总的原则就是:从起始位置以起始方向 Start_Dir 开始寻找,碰到参考点之前若碰到限位开关,则立即调头开始反向寻找,找到参考点开关的上升沿(即刚遇到参考点开关)即减速到寻找低速 Homing_Slow_Spd,若在检测到参考点开关的下降沿(即刚离开遇到参考点开关)之前已经减速到 Homing_Slow_Spd,则比较当前方向与终止方向 Final_Dir 是否*,若*,则完成参考点寻找过程;若否,则调头找寻另一端的下降沿。若在检测到参考点开关的下降沿(即刚离开遇到参考点开关)之前尚未减速到 Homing_Slow_Spd,则在减速到 Homing_Slow_Spd 后调头加速,直至遇到参考点开关上升沿,重新减速到 Homing_Slow_Spd,zui后判断当前方向与终止方向 Final_Dir 是否*,若*,则完成参考点寻找过程;若否,则调头找寻另一端的下降沿。(Final_Dir 决定寻找参考点过程结束后,轴停在参考点开关的哪一侧)
下面的图形会反应不同情形下寻找参考点的过程。
Start_Dir=0, Final_Dir=0,如图17:
图17
Start_Dir=0, Final_Dir=1,如图18:
图18
Start_Dir=1, Final_Dir=0,如图19:
图19
Start_Dir=1, Final_Dir=1,如图20:
图20
6SE7033-2TG60