禾川 HCQ1 PLC 控制张力控制器的完整程序（适配电商物流分拣线）

禾川HCQ1PLC控制张力控制器的完整程序（适配电商物流分拣线）一、应用场景说明在电商物流分拣线中，张力控制器主要用于：分拣皮带/滚筒的物料张力稳定（避免包裹打滑/卡料）；格口挡料气缸推送时的张力缓冲控制；高速分拣时的张力动态补偿。本次程序适配磁粉/伺服张力控制器（支持ModbusRTU），PLC通过RS485与张力控制器通信。二、硬件与通信配置1.硬件清单设备型号/规格通信接口接线方式禾川HCQ1PLCHCQ1-3232MTRS485（COM1）A接张力控制器A，B接张力控制器B，GND共地张力控制器凯瑞达KTC828ARS485（ModbusRTU）供电DC24V，A/B接PLCRS485，输出接磁粉离合器张力传感器张力检测器（应变片式）模拟量4-20mA接PLCAI5通道（新增）2.PLC通信参数设置（HDevelop）st//全局变量：ModbusRTU通信参数VAR_GLOBAL//通信配置Modbus_Baud:INT:=9600;//波特率9600Modbus_Parity:INT:=0;//校验位：0=无，1=奇，2=偶Modbus_StopBit:INT:=1;//停止位1Tension_SlaveID:INT:=1;//张力控制器从站地址1//张力控制器寄存器（参考KTC828A手册）Tension_Set:REAL:=50.0;//目标张力（0-100N）Tension_Actual:REAL:=0.0;//实际张力（采集值）Tension_Output:INT:=0;//张力输出值（0-4000）Tension_Auto:BOOL:=FALSE;//自动/手动切换（TRUE=自动）Tension_Manual_Out:INT:=2000;//手动输出值（50%）//PID参数PID_Kp:REAL:=2.0;//比例系数PID_Ki:REAL:=0.5;//积分系数PID_Kd:REAL:=0.1;//微分系数PID_Out:REAL:=0.0;//PID输出//故障报警Tension_Alarm:BOOL:=FALSE;//张力异常报警Tension_High:REAL:=80.0;//张力上限Tension_Low:REAL:=20.0;//张力下限END_VAR三、核心控制程序（ST语言）1.ModbusRTU通信模块（读取/写入张力控制器）st//模块1：ModbusRTU初始化（程序启动时执行）VARModbus_Init_Flag:BOOL:=FALSE;END_VARIFNOTModbus_Init_FlagTHEN//初始化RS485端口（COM1）ModbusRTU_Init(Port:=1,Baud:=Modbus_Baud,Parity:=Modbus_Parity,StopBit:=Modbus_StopBit);Modbus_Init_Flag:=TRUE;END_IF;//模块2：读取张力控制器实际值（周期100ms）VARRead_Timer:TIMER:=T#100MS;Read_Result:BOOL:=FALSE;END_VARIFRead_Timer.QTHEN//读取张力控制器0x0000寄存器（实际张力，REAL型）Read_Result:=ModbusRTU_Read(Port:=1,SlaveID:=Tension_SlaveID,FuncCode:=3,//读保持寄存器StartAddr:=0,//起始地址0RegCount:=2,//读取2个寄存器（REAL占2个）DataPtr:=ADR(Tension_Actual));//读取失败报警IFNOTRead_ResultTHENTension_Alarm:=TRUE;END_IF;Read_Timer.IN:=FALSE;Read_Timer.IN:=TRUE;END_IF;//模块3：写入张力控制器参数（自动/手动切换）VARWrite_Timer:TIMER:=T#200MS;Write_Result:BOOL:=FALSE;END_VARIFWrite_Timer.QTHENIFTension_AutoTHEN//自动模式：写入PID输出值Tension_Output:=TO_INT(PID_Out*40);//0-100→0-4000ELSE//手动模式：写入手动输出值Tension_Output:=Tension_Manual_Out;END_IF;//写入目标张力（0x0002寄存器）Write_Result:=ModbusRTU_Write(Port:=1,SlaveID:=Tension_SlaveID,FuncCode:=16,//写多个寄存器StartAddr:=2,RegCount:=2,DataPtr:=ADR(Tension_Set));//写入输出值（0x0004寄存器）Write_Result:=ModbusRTU_Write(Port:=1,SlaveID:=Tension_SlaveID,FuncCode:=16,StartAddr:=4,RegCount:=1,DataPtr:=ADR(Tension_Output));//写入自动/手动模式（0x0006寄存器，1=自动，0=手动）Write_Result:=ModbusRTU_Write(Port:=1,SlaveID:=Tension_SlaveID,FuncCode:=16,StartAddr:=6,RegCount:=1,DataPtr:=ADR(Tension_Auto));Write_Timer.IN:=FALSE;Write_Timer.IN:=TRUE;END_IF;2.PID调节模块（张力自动控制核心）st//模块4：PID运算（周期100ms）VARPID_Timer:TIMER:=T#100MS;Error:REAL:=0.0;//偏差（目标-实际）Error_Last:REAL:=0.0;//上一次偏差Error_Sum:REAL:=0.0;//偏差积分END_VARIFPID_Timer.QANDTension_AutoTHEN//计算偏差Error:=Tension_Set-Tension_Actual;//积分限幅（避免积分饱和）Error_Sum:=Error_Sum+Error*0.1;//0.1为周期（100ms）IFError_Sum>100.0THENError_Sum:=100.0;ELSIFError_Sum<0.0THENError_Sum:=0.0;END_IF;//PID运算PID_Out:=PID_Kp*Error+PID_Ki*Error_Sum+PID_Kd*(Error-Error_Last)/0.1;//PID输出限幅（0-100）IFPID_Out>100.0THENPID_Out:=100.0;ELSIFPID_Out<0.0THENPID_Out:=0.0;END_IF;//保存上一次偏差Error_Last:=Error;PID_Timer.IN:=FALSE;PID_Timer.IN:=TRUE;END_IF;3.张力异常报警模块st//模块5：张力上下限报警VARAlarm_Delay:TIMER:=T#2S;//报警延时2s，避免误报END_VAR//实际张力超出上下限，延时报警IFTension_Actual>Tension_HighORTension_Actual<Tension_LowTHENAlarm_Delay.IN:=TRUE;IFAlarm_Delay.QTHENTension_Alarm:=TRUE;Q3.0:=TRUE;//报警指示灯亮//联动分拣线减速（保护设备）Roller2_Speed:=Roller2_Speed*0.5;END_IF;ELSEAlarm_Delay.IN:=FALSE;Tension_Alarm:=FALSE;Q3.0:=FALSE;END_IF;//模块6：手动/自动切换（HMI/本地按钮触发）VARAuto_Button:BOOL:=FALSE;//I3.0，自动模式按钮Manual_Button:BOOL:=FALSE;//I3.1，手动模式按钮END_VAR//输入映射Auto_Button:=I3.0;Manual_Button:=I3.1;//模式切换（互锁）IFAuto_ButtonTHENTension_Auto:=TRUE;ELSIFManual_ButtonTHENTension_Auto:=FALSE;END_IF;4.模拟量张力传感器采集（备用）若张力控制器无通信功能，可直接采集张力传感器模拟量：st//模块7：AI5采集张力传感器4-20mA信号VARAI5_Raw:INT:=0;//AI5原始值（0-27648）END_VAR//读取AI5原始值（4mA=5530，20mA=27648）AI5_Raw:=AIRead(Channel:=5);//转换为实际张力（0-100N）Tension_Actual:=(AI5_Raw-5530)/(27648-5530)*100.0;//数值滤波（避免波动）Tension_Actual:=(Tension_Actual+Tension_Actual_Last)/2;Tension_Actual_Last:=Tension_Actual;四、程序集成与调试要点1.与原有分拣线程序集成将上述模块添加到原有程序的「工艺控制」分区，周期设为100ms；张力异常报警（Tension_Alarm）接入原有故障汇总逻辑（Fault_Sum）；张力自动减速逻辑联动滚筒线速度变量（Roller2_Speed）。2.调试步骤通信测试：用Modbus调试工具测试PLC与张力控制器的通信，确保能读写寄存器；监控Tension_Actual，手动调整张力控制器，数值应实时变化。PID参数调试：先设PID_Kp=1.0、PID_Ki=0、PID_Kd=0，逐步增大比例系数；观察张力波动，调整积分/微分系数，直到实际张力稳定在目标值±2N内。报警测试：手动设置Tension_Set=80N，模拟张力超限，验证报警指示灯和减速逻辑是否生效。3.关键函数说明函数名作用参数说明ModbusRTU_Init初始化RS485端口Port：串口号（1=COM1）；Baud：波特率ModbusRTU_Read读取寄