西门子S7-1200 PLC脉冲控制伺服电机实战解析

1. 项目概述

在工业自动化控制领域，PLC（可编程逻辑控制器）与伺服系统的配合应用可以说是最基础也最核心的技术组合之一。今天要分享的这个案例，是我去年为一个包装生产线改造项目开发的西门子S7-1200 PLC脉冲控制伺服程序。这个案例特别之处在于同时提供了梯形图(LAD)和SCL（结构化控制语言）两种实现方式，方便不同编程习惯的工程师参考。

这个程序主要实现了通过PLC发送脉冲信号精确控制伺服电机的位置和速度，适用于需要精确定位的各种工业场景，比如包装机械的送料定位、装配线的工件搬运等。项目中我们使用的伺服驱动器是三菱MR-JE-20A，但程序架构具有通用性，稍作修改即可适配其他品牌的脉冲控制型伺服驱动器。

2. 硬件配置与接线

2.1 硬件选型清单

• PLC：西门子S7-1214C DC/DC/DC（6ES7 214-1AG40-0XB0）
• 伺服系统：三菱MR-JE-20A伺服驱动器 + HC-KFS13伺服电机
• 电源：24V DC开关电源（给PLC和伺服驱动器供电）
• 其他：急停按钮、限位开关等安全元件

注意：S7-1200系列PLC的脉冲输出能力有限，最高频率为100kHz。如果需要更高频率的脉冲输出，应考虑使用S7-1500或专门的定位模块。

2.2 电气接线要点

PLC与伺服驱动器的接线是项目成功的关键，这里有几个需要特别注意的地方：

1. 脉冲信号接线：

   • PLC的Q0.0（Pulse+）接伺服驱动器的PP（脉冲正）
   • PLC的Q0.2（Direction+）接伺服驱动器的NP（方向正）
   • 伺服驱动器的COM-（脉冲负）和COM-（方向负）短接后接到PLC的M端子

2. 伺服使能信号：

   • 通过PLC的Q0.4输出控制伺服驱动器的SON（伺服使能）端子
   • 建议在程序中加入使能延时逻辑，避免上电瞬间误动作

3. 原点/限位信号：

   • 机械原点信号接PLC的I0.0
   • 正限位接I0.1，负限位接I0.2
   • 这些信号建议使用常闭触点，提高安全性

3. PLC程序架构设计

3.1 程序组织块(OB)规划

在S7-1200中，我采用了以下OB结构：

1. OB1（主循环）：处理非实时性逻辑，如模式选择、状态显示等
2. OB35（循环中断）：每100ms执行一次，用于伺服状态监控
3. OB30（硬件中断）：响应原点信号和限位信号

3.2 数据块(DB)设计

创建了几个关键的数据块来组织变量：

1. DB1（Servo_Para）：伺服参数设置

   • 脉冲当量（PulsePerMM）
   • 最大速度（MaxSpeed）
   • 加减速时间（AccelTime）

2. DB2（Servo_Status）：伺服状态监控

   • 当前位置（CurrentPos）
   • 当前速度（CurrentSpeed）
   • 报警代码（ErrorCode）

3. DB3（Motion_Cmd）：运动控制命令

   • 目标位置（TargetPos）
   • 运动速度（MoveSpeed）
   • 运动完成标志（Done）

4. 梯形图(LAD)实现详解

4.1 脉冲输出配置

在S7-1200中配置脉冲输出需要以下步骤：

1. 在设备配置中启用PTO（脉冲串输出）功能
2. 设置脉冲输出参数：
   • 输出类型：PTO（脉冲串输出）
   • 脉冲输出点：Q0.0
   • 方向输出点：Q0.2
   • 基准时间：1ms
   • 最大频率：100kHz

4.2 关键梯形图逻辑

1. 伺服使能控制：

   code复制Network 1: 伺服使能控制
   LD     Mode_Auto       // 自动模式
   AND    NOT Emergency   // 非急停状态
   AND    NOT Alarm       // 无报警
   =      Servo_On        // 输出伺服使能信号
   

2. 原点回归控制：

   code复制Network 2: 原点回归启动
   LD     Home_Start      // 原点回归启动信号
   AND    NOT Moving      // 不在运动中
   S      Home_Active     // 置位原点回归激活标志
   
   Network 3: 原点回归执行
   LD     Home_Active
   CTU    Home_Timer, 50  // 50ms延时，防止抖动
   LD     Home_Timer.DN
   =      PTO_Home        // 触发PTO原点回归
   

3. 位置控制指令：

   code复制Network 4: 位置移动启动
   LD     Move_Start      // 移动启动信号
   AND    NOT Moving      // 不在运动中
   MOV    Target_Pos, PTO_Pos  // 传送目标位置
   MOV    Move_Speed, PTO_Speed // 传送运动速度
   =      PTO_Start       // 启动PTO运动
   

5. SCL结构化控制实现

5.1 运动控制功能块

使用SCL可以创建更结构化的运动控制功能块：

scl复制FUNCTION_BLOCK FB_MotionControl
VAR_INPUT
    Execute : BOOL;       // 执行命令
    Position : REAL;      // 目标位置(mm)
    Velocity : REAL;      // 运动速度(mm/s)
    HomeCmd : BOOL;       // 原点回归命令
END_VAR

VAR_OUTPUT
    Done : BOOL;          // 运动完成
    Busy : BOOL;          // 运动中
    Error : BOOL;         // 错误状态
    ErrorID : WORD;       // 错误代码
END_VAR

VAR
    InternalState : INT;  // 内部状态机
    PulseCount : DINT;    // 脉冲计数
END_VAR

// 主逻辑实现
BEGIN
    CASE InternalState OF
        0: // 空闲状态
            IF Execute THEN
                PulseCount := REAL_TO_DINT(Position * "Servo_Para".PulsePerMM);
                "PTO_Ctrl".Start := TRUE;
                "PTO_Ctrl".Position := PulseCount;
                "PTO_Ctrl".Velocity := Velocity;
                InternalState := 1;
            ELSIF HomeCmd THEN
                "PTO_Ctrl".Home := TRUE;
                InternalState := 2;
            END_IF;
            
        1: // 位置移动中
            IF "PTO_Ctrl".Done THEN
                Done := TRUE;
                InternalState := 0;
            ELSIF "PTO_Ctrl".Error THEN
                Error := TRUE;
                ErrorID := "PTO_Ctrl".ErrorID;
                InternalState := 0;
            END_IF;
            
        2: // 原点回归中
            IF "PTO_Ctrl".HomeDone THEN
                Done := TRUE;
                InternalState := 0;
            ELSIF "PTO_Ctrl".Error THEN
                Error := TRUE;
                ErrorID := "PTO_Ctrl".ErrorID;
                InternalState := 0;
            END_IF;
    END_CASE;
    
    Busy := InternalState <> 0;
END_FUNCTION_BLOCK

5.2 PTO控制功能块

scl复制FUNCTION_BLOCK FB_PTOControl
VAR_INPUT
    Start : BOOL;         // 启动运动
    Home : BOOL;          // 原点回归
    Position : DINT;      // 目标位置(脉冲)
    Velocity : REAL;      // 运动速度(脉冲/秒)
END_VAR

VAR_OUTPUT
    Done : BOOL;          // 运动完成
    HomeDone : BOOL;      // 原点回归完成
    Error : BOOL;         // 错误状态
    ErrorID : WORD;       // 错误代码
END_VAR

VAR
    // 与硬件PTO相关的内部变量
END_VAR

BEGIN
    // 实际的PTO控制逻辑实现
    // 这里会调用西门子提供的运动控制指令
END_FUNCTION_BLOCK

6. 伺服参数调试技巧

6.1 基本参数设置

在伺服驱动器侧需要设置以下关键参数：

1. 基本参数：

   • PA01：控制模式选择，设为0（位置控制模式）
   • PA05：电子齿轮比分子
   • PA06：电子齿轮比分母
   • PA07：指令脉冲分频分子
   • PA08：指令脉冲分频分母

2. 增益调整：

   • PB06：位置环增益
   • PB07：速度环增益
   • PB08：积分时间常数

提示：电子齿轮比的计算公式为：
实际移动量 = (电机每转脉冲数 × 电子齿轮比) / (丝杠螺距 × 指令分频比)
需要根据机械传动参数精确计算。

6.2 调试步骤建议

1. 先设置较低的转速和加速度，确保电机能正常转动
2. 测试原点回归功能，确认机械原点信号有效
3. 进行短距离移动测试，观察是否有振动或过冲
4. 逐步提高速度和加速度，观察系统稳定性
5. 最后进行长距离全速测试，检查定位精度

7. 常见问题与解决方案

7.1 脉冲输出不稳定

现象：伺服电机运行时有抖动或丢步现象

可能原因及解决：

1. 脉冲频率设置过高 → 降低PTO输出频率
2. 信号线受干扰 → 使用双绞屏蔽线，缩短接线长度
3. 电源不稳定 → 检查24V电源容量和电压波动

7.2 原点回归不准确

现象：每次原点回归停止位置不一致

解决方法：

1. 检查机械原点传感器的安装是否牢固
2. 调整伺服驱动器的原点回归速度（通常设为较低速度）
3. 在PLC程序中加入软件滤波，消除信号抖动

7.3 定位精度不足

现象：实际停止位置与目标位置有偏差

排查步骤：

1. 检查电子齿轮比计算是否正确
2. 确认机械传动系统是否有背隙
3. 调整伺服驱动器的位置环增益参数

8. 程序优化建议

在实际项目中应用这个程序框架后，我总结了几点优化建议：

1. 加入动态调整功能：根据负载情况自动调整伺服增益参数，可以在DB1中增加一组"自动调谐"参数，通过SCL算法实现。

2. 完善安全逻辑：在原程序基础上增加更多安全互锁，比如：

   • 运动中禁止修改目标位置
   • 急停时立即停止脉冲输出
   • 限位触发时禁止向危险方向移动

3. 添加诊断功能：扩展DB2的内容，加入更多状态信息：

   • 累计运行时间
   • 历史错误记录
   • 维护提醒标志

4. 模块化扩展：将运动控制功能封装成更完善的FB块，方便在不同项目中复用。可以加入以下功能：

   • 多段速控制
   • 连续运动模式
   • 电子凸轮功能

这个案例程序虽然基础，但涵盖了PLC控制伺服系统的核心要点。在实际应用中，根据具体设备特点调整参数和逻辑，可以满足大多数定位控制需求。特别推荐使用SCL实现复杂运动逻辑，代码可读性和维护性都比梯形图更好。