1. 项目背景与核心需求
在液晶背光板生产线上,压合工序一直是个技术难点。传统方案要么采用纯位置控制导致过压损坏产品,要么使用纯转矩控制造成响应速度过慢。我们这次接到的项目要求:在3秒内完成20mm行程的快速定位,并在终点位置保持15±0.5N的恒定压力持续10秒。
经过多轮测试,最终确定采用三菱Q系列PLC+QD77MS运动模块的解决方案,核心创新点在于:
- 前段95%行程采用位置控制模式(速度300mm/s)
- 末端5mm切换为转矩控制模式(切换阈值可调)
- 压力闭环采用带死区的PID算法(死区范围0.5N)
这种混合控制策略实测定位时间缩短至2.8秒,压力波动控制在±0.3N以内,完全满足生产工艺要求。
2. 硬件系统架构设计
2.1 主要设备选型
| 设备类型 | 型号规格 | 关键参数 |
|---|---|---|
| PLC主机 | Q06UDEHCPU | 支持结构化文本(ST)编程 |
| 运动控制模块 | QD77MS16 | 16轴控制,同步周期最小1ms |
| 伺服系统 | MR-J4-B-RJ040B | 400W,23bit绝对值编码器 |
| 压力传感器 | HCA730 | 量程0-50N,精度±0.1%FS |
| HMI | WEINVIEW MT8071iE | 支持双Y轴曲线显示 |
2.2 电气设计要点
-
安全回路设计:
- 急停按钮直接切断伺服主电源
- 抱闸回路与伺服使能信号互锁
- 压力传感器供电采用隔离电源
-
信号连接方案:
- 编码器反馈通过SSCNETⅢ光纤传输
- 压力传感器信号接入PLC模拟量模块QX82
- 模式切换信号通过运动模块专用DO输出
特别注意:QD77MS的同步周期参数必须设置为2ms,否则转矩模式切换时会出现明显的响应延迟。我们在初期调试中就因为这个参数设置不当导致压力超调达到2N。
3. 控制程序深度解析
3.1 运动控制参数配置
st复制// QD77MS轴参数设置(摘录关键部分)
轴1.控制模式 := 16#2100; // 位置+转矩混合模式
轴1.位置环增益 := 35; // 单位0.1Hz
轴1.速度环增益 := 150; // 百分比
轴1.转矩限幅 := 300; // 30%额定转矩
轴1.模式切换阈值 := 5000; // 单位μm(5mm)
伺服参数调试技巧:
- 先进行伺服自整定(参数PA19.01设为1)
- 刚性调整建议从30%开始逐步上调
- 观察JOG运行时的振动情况,最佳刚性值应在轻微振动临界点前
3.2 核心控制逻辑实现
st复制FUNCTION_BLOCK PressureControl
VAR_INPUT
TargetPos : REAL; // 目标位置(mm)
HoldForce : REAL; // 保持力(N)
END_VAR
VAR_OUTPUT
ActualForce : REAL; // 实时压力反馈
END_VAR
VAR
fbPID : PID_CTRL; // 三菱标准PID功能块
fbModeSwitch : ModeSwitch;
END_VAR
// 位置控制阶段
IF fbModeSwitch.ControlMode = 1 THEN
MC_MoveAbsolute(轴1, TargetPos);
END_IF
// 转矩控制阶段
IF fbModeSwitch.ControlMode = 2 THEN
fbPID(
SET := HoldForce,
PV := ActualForce,
Kp := 150.0,
Ti := 200.0,
Td := 0.0,
MAN := FALSE,
OUT => 转矩输出);
MC_TorqueControl(轴1, 转矩输出);
END_IF
3.3 带死区的PID算法优化
st复制// 改进型PID运算(压力环)
偏差 := 设定压力 - 反馈压力;
IF ABS(偏差) < 死区阈值 THEN
// 死区内保持当前输出
输出转矩 := 保持值;
// 冻结积分项防止饱和
PID.Integral := PID.Integral_Backup;
ELSE
// 正常PID运算
输出转矩 := PID.Kp * 偏差
+ PID.Ki * PID.Integral
+ PID.Kd * (偏差 - 上次偏差);
// 备份积分项
PID.Integral_Backup := PID.Integral;
END_IF;
4. 人机界面设计要点
4.1 压力监控画面
-
双曲线同屏显示:
- 左侧Y轴:位置(0-30mm)
- 右侧Y轴:压力(0-20N)
- X轴:时间(0-15秒)
-
关键参数在线修改:
- 模式切换阈值(3-10mm可调)
- PID参数(比例带/积分时间)
- 转矩限幅值(10-50%)
4.2 报警管理设计
| 报警代码 | 内容 | 处理建议 |
|---|---|---|
| E01 | 压力超限 | 检查传感器零点校准 |
| E02 | 位置跟随误差过大 | 调整伺服刚性参数 |
| E03 | 模式切换失败 | 检查QD77MS模块状态 |
| E04 | 转矩达到限幅 | 检查机械结构是否卡死 |
5. 调试经验与故障排除
5.1 典型问题解决方案
-
压力波动大:
- 检查机械结构的背隙(建议≤0.02mm)
- 降低PID比例增益(Kp)
- 增加压力采样滤波时间(建议50-100ms)
-
模式切换抖动:
- 调整切换前减速曲线(S型加减速)
- 检查伺服参数中的"转矩指令滤波"(建议20-30Hz)
- 确保位置环和速度环参数已调谐
-
过压保护触发:
- 设置两级压力阈值(警告值15.5N,停机值16N)
- 在触摸屏添加压力实时趋势图
- 检查压力传感器安装是否松动
5.2 关键参数推荐值
| 参数类别 | 初始值 | 可调范围 | 影响说明 |
|---|---|---|---|
| 切换阈值 | 5mm | 3-10mm | 影响定位时间和稳定性 |
| PID比例增益 | 150 | 100-200 | 响应速度与超调量 |
| 积分时间 | 200ms | 100-500ms | 消除静差能力 |
| 伺服刚性 | 45% | 30-60% | 系统响应特性 |
| 转矩限幅 | 30% | 20-50% | 过载保护 |
6. 项目优化方向
- 自适应参数调整:
st复制// 根据不同产品自动切换参数
CASE 产品类型 OF
1: // 薄型背光板
切换阈值 := 3.0;
HoldForce := 12.0;
2: // 厚型背光板
切换阈值 := 8.0;
HoldForce := 18.0;
END_CASE;
- 压力预测控制:
- 在位置阶段提前采集压力趋势
- 通过移动平均算法预测终点压力
- 动态调整切换点和PID参数
- 机械结构改进建议:
- 采用直线导轨替代普通导柱
- 增加气液增压机构(适用于高压场合)
- 优化压头形状减少局部应力
这个项目让我深刻体会到,好的自动化方案必须是机械、电气、软件的完美结合。特别是在调试PID参数时,发现机械结构的微小变形都会影响控制效果,最终通过增加预压弹簧补偿了这部分误差。建议同行们在类似项目中一定要先确保机械精度,再优化控制参数。
