干自动化立体仓库项目的兄弟应该都有同感堆垛机是整个系统里最考验综合能力的设备。它既要跟WMS系统保持实时通信又要在巷道里高速行走、精准起升还要把货叉稳稳插进货架任何一个环节掉链子整个仓库就得停工。这篇文章要拆解的是一套基于西门子S7-300 PLC的大型堆垛机控制程序驱动层用的是G120变频器整套方案覆盖了上位机通信、定位算法、运动控制和安全保护四大块内容。不管你是刚做物流自动化的新手还是已经在现场调试设备的老手这套架构里的设计思路和实战经验应该都能给你提供一些参考。1. 项目整体拆解从硬件选型到系统架构1.1 堆垛机到底在干什么活堆垛机的本质是一台在自动化立体仓库巷道中来回穿梭的存取设备核心动作就三个行走、起升、伸叉。行走机构让整机沿着巷道导轨水平移动起升机构让载货台沿着立柱上下移动伸叉机构把货物从货架上取出或者放上货架。三个动作配合好才能做到“指哪打哪”——上位机下发一个货位地址堆垛机自动跑到该位置完成存取。听起来不复杂但实际工程里这个“指哪打哪”背后是通信、算法和运动控制三个系统在同时工作。一套完整的堆垛机控制系统通常不是只有PLC和变频器还包括激光测距仪、编码器、认址片、接近开关、光电传感器、安全光幕、松绳检测和货位检测等一系列外围设备。现场信号的稳定性和程序逻辑的严谨程度决定了这台设备能不能长期稳定运行。很多项目在验收时跑得挺好过几个月就开始出怪毛病十有八九是当初程序里对信号异常的处理不够到位。1.2 为什么是S7-300 G120这套组合现在的自动化项目里S7-1500已经越来越常见但老牌的大型立体仓库里S7-300依然有庞大的存量尤其是前些年的项目基本都被西门子S7-300系列包圆了。这套方案放在今天依然有很强的参考价值一是因为现有系统的维护和改造需求大二是因为S7-300配合STEP7经典环境在STL和SCL编程上有非常成熟的经验积累很多老师傅的程序架构值得借鉴。驱动层选G120而不是伺服驱动器主要是从负载特性和成本两个角度考虑。堆垛机的行走、起升机构转动惯量大但加减速要求相对不高用变频器加编码器的闭环控制就够了G120作为SINAMICS家族的通用变频器既支持PROFIBUS和PROFINET两种总线又可以通过BOP-2面板做快速调试现场适应性很强。比起伺服方案G120的维护门槛低备件费用也友好得多。1.3 系统层级与数据流向从整体架构来看堆垛机控制系统分三层管理层WMS仓库管理系统或上位机调度系统负责任务生成、货位分配、库存管理。控制层S7-300 PLC负责任务执行、定位计算、逻辑联锁、状态上报。驱动层G120变频器加电机负责执行PLC下发的速度指令并反馈状态。数据流向很简单但很关键WMS把任务指令比如入库、出库、倒库发给PLCPLC解析任务后把坐标换算成速度给定和定位目标通过PROFIBUS/PROFINET发给G120及其他执行机构同时PLC采集编码器、限位开关、认址信号实时修正运行状态。整个过程都是闭环的任何一个环节的数据出现偏差都会直接反映到定位精度和运行效率上。2. 通信方案WMS、PLC和变频器之间怎么对话2.1 上位机通信任务下发与状态回传堆垛机必须跟WMS“对话”。Common的做法是PLC和上位机走以太网用S7协议或者开放式TCP通信数据格式一般是固定长度的字节块包含任务类型、货位地址、托盘条码、优先级和校验码。比如一条出库指令上位机下发“任务号 源货位 目标货位 货物条码”PLC执行完再回传“任务完成 状态码 实际到位信息”。这段通信程序我建议单独做一个FB来处理不要跟运动控制逻辑混在一起。通信状态机要覆盖几个状态空闲、接收中、解析完成、执行中、执行完成、通信超时、错误重发。项目里碰到最多的问题就是上位机和PLC对报文格式的理解不一致比如校验位算法不同或者字节顺序大小端不同导致解析出来的指令驴唇不对马嘴。我的习惯是先把报文协议表格做成一个固定文档明确每个字节的用途、数据类型、取值范围写完程序再拿模拟报文逐条对。上位机通信还需要处理一个非常现实的问题如果WMS卡死了或者网络断了堆垛机不能傻等着。程序里要有通信监视功能比如超过3秒没收到心跳或新指令PLC就触发通信报警设备停止新任务但保留当前动作避免货物悬在半空。2.2 现场总线配置DP头、地址与终端电阻S7-300与G120之间的通信老项目里用PROFIBUS-DP的非常多。虽然PROFINET已经是大趋势但大量存量设备还在用DP总线而且DP在抗干扰和实时性表现上其实非常扎实。只要配置正确运行几年都不出问题。PROFIBUS-DP配置里最容易翻车的地方就是这几个从站地址重复导致总线反复报故障所以在给G120分配地址前一定要先确认总线上的地址占用表。终端电阻没拨对。PROFIBUS电缆两端即总线上第一个和最后一个设备必须把终端电阻拨到ON中间的设备全部OFF。这个看似不起眼却是丢站故障的最大根源之一。波特率不一致。PLC组态里设1.5Mbps变频器也要设1.5Mbps任何一台不匹配整条总线都起不来。屏蔽层接地问题。屏蔽线单端接地是基本要求如果两头都接地容易形成地环路干扰反而更大。我在现场吃过一次亏总线偶尔掉站查了半天才发现是DP头内部接线松动。这种“软故障”最折磨人所以现在每做一条DP线我一定用万用表逐针测试接线并在DP头上贴上地址标签。2.3 G120变频器报文控制字状态字速度值G120与S7-300通过总线通信时核心是报文结构。S7-300里调用DPWR_DAT和DPRD_DAT读写数据块或者组态里直接建立I/Q地址映射。G120的报文里最关键的就是控制字STW和状态字ZSW以及速度给定NDR和速度实际值NACT。控制字STW里的几个位必须搞清楚意思比如Bit0ON/OFF1给1才能运行给0停机。Bit1OFF2紧急停车命令。Bit2OFF3快速停车命令按斜坡时间停机。Bit3允许运行通常是使能脉冲。Bit4斜坡发生器使能。Bit5斜坡发生器复位。Bit7故障确认。状态字ZSW对应着变频器的实际状态比如Bit0准备就绪、Bit1运行就绪、Bit2运行中、Bit3故障激活、Bit7报警激活、Bit10到达设定值。程序里一定要读取状态字确认变频器“准备好”之后再发运行命令否则会有各种奇怪的启动失败。速度给定值的换算也容易搞错16位报文的速度给定一般是0~16384对应0~100%额定转速负速度通过带符号的16位整数表达比如-16384到16384对应-100%到100%。很多人刚上手时直接填一个几百就这么发过去结果电机不动。正确写法是把目标速度比如1200rpm除以电机额定转速比如1450rpm再乘以16384得到给定值。3. 运动控制算法从脉冲到毫米的定位哲学3.1 认址与定位系统堆垛机最核心的性能指标之一就是定位精度。常见立体仓库水平定位精度要求±5mm起升精度要求更严有的项目要做到±2mm。要达到这个精度光靠变频器本身是不够的必须有可靠的认址和测量手段。认址方式一般分两种。一种是用编码器和认址片配合编码器装在行走轮或电机轴上通过脉冲累计计算位置认址片是巷道地面或立柱上固定安装的金属片接近开关碰到认址片时把PLC当前计数值清零或记录。这种方案便宜可靠适合绝大多数工况。另一种是激光测距或条码带定位激光测距仪输出绝对距离PLC直接读距离值精度高、不怕打滑但成本也高。我建议在程序里把“绝对值计数”和“认址校准”结合起来。具体思路是PLC实时记录一个位置值正常运行由编码器脉冲累加每次过认址片时修正一次防止长时间累计误差。这样既保证了连续定位的平滑性又杜绝了长时间运行后的漂移。3.2 速度曲线规划为什么不能一脚油门一脚刹车堆垛机在巷道里跑如果PLC上来就发满速给变频器到了目标位置再急停轻则定位不准重则货物甩出去、机械结构受伤。合理的速度曲线是分段的启动加速段、匀速段、第一次减速段高速切中速、第二次减速段中速切爬行、停止段低速到位后停止。典型的做法是把目标位置换算成剩余距离然后根据剩余距离动态改变速度给定。我用得比较多的是多段速方案比如剩余距离大于2000mm时速度给定100%剩余距离在800mm到2000mm之间速度给定60%剩余距离在200mm到800mm之间速度给定25%剩余距离小于200mm时速度给定8%这个200mm的爬行距离不是拍脑袋定的要根据负载和变频器斜坡时间现场测。大致计算方法是爬行速度比如20m/min下从给定到实际停住会有响应延迟加上机械制动距离爬行距离至少要覆盖这两者的总和。如果爬行速度设为20m/min即333mm/s变频器斜坡从333mm/s降到0如果花0.5秒那这段距离就是83mm再留出余量200mm比较稳妥。更平滑的方案是S型曲线通过限制加速度的变化率来减少冲击适合对货物防摇有严格要求的场景。西门子S7-300里实现S型曲线可以用查表法把速度值和对应的时间点存在DB里PLC按节拍读取。对老项目改造来说这套逻辑简化为三步就够加速到V1、匀减速到V2、爬行到目标。效果已经比单纯急启急停好太多。3.3 防摇与位置校正高速运行的堆垛机最怕什么不是跑不到而是跑到了货还在晃。货物在载货台上随着加减速晃动轻则对不准货位重则撞到货架。防摇的核心在于减小加速度突变和让货物跟随运动。除了前面说的S型速度曲线还可以考虑起升机构的小幅反向补偿不过这个算法复杂度高一般用在超高层堆垛机或者对效率要求极高的项目里。常规项目只要把加速度限制在一个合理范围比如行走加速度不超过0.5m/s²货物晃动就能控制住。位置校正在程序里绝对不能省。编码器定位会有累计误差认址片修正只能消除系统误差但机械打滑、链条跳齿造成的误差是随机的。我的做法是每次操作任务开始前先做一次“寻址校零”——低速运行到最近的认址片把当前位置强制为设定值再开始任务。这个动作看上去多花了点时间但换来的是定位稳定性和后续排障的便利。4. S7-300程序架构与关键功能块实现4.1 程序块划分OB、FB、FC、DB各司其职一套稳定的堆垛机程序架构一定要清晰。S7-300的程序里我习惯把功能拆成独立的块OB1主循环里完成大部分逻辑调用。OB100完成初始化。OB35作为定时中断可以承担周期性的定位计算。FB负责核心控制比如通信解析、行走定位、起升控制、货叉控制。FC做转换比如坐标换算、速度计算。DB存数据包括任务接口、坐标表、系统参数、报警信息。程序千万不能把所有逻辑堆在OB1里否则后期维护就是灾难。我的习惯是一个动作对应一个FB。比如FB20专门管行走内部包括目标值读取、脉冲计数、速度分段输出、到位判断FB21专门管起升FB22专门管货叉。各FB之间只通过共享DB交换数据不互相直接访问全局变量这样万一某个轴出问题排查范围可以缩小很多。4.2 定位FB的编写逻辑以行走定位FB为例我用SCL描述大致逻辑实际项目里用STL或LAD都行SCL更直观FUNCTION_BLOCK FB20 // 行走定位控制 VAR_INPUT enable: BOOL; // 使能 target_pos: REAL; // 目标位置单位mm cur_pos: REAL; // 当前位置来自编码器累计 max_speed: REAL; // 最大速度给定 END_VAR VAR_IN_OUT speed_setpoint: REAL; // 速度给定输出 status: WORD; // 状态字 END_VAR VAR delta: REAL; // 剩余距离 mode: INT; // 当前运行阶段 END_VAR // 计算剩余距离 delta : target_pos - cur_pos; IF abs(delta) 2.0 THEN // 到位阈值 speed_setpoint : 0.0; status : 16#0001; // 到位 mode : 0; ELSE CASE mode OF 0: // 启动阶段直接给加速速度 IF abs(delta) 2000 THEN speed_setpoint : max_speed; mode : 1; ELSE speed_setpoint : max_speed * 0.25; // 相对距离不足直接中速 mode : 2; END_IF; 1: // 高速阶段 IF abs(delta) 800 THEN speed_setpoint : max_speed * 0.25; mode : 2; END_IF; 2: // 中速阶段 IF abs(delta) 200 THEN speed_setpoint : max_speed * 0.08; // 爬行速度 mode : 3; END_IF; 3: // 爬行阶段 IF abs(delta) 2 THEN speed_setpoint : 0.0; status : 16#0001; mode : 0; END_IF; END_CASE; END_IF;上面的例子很简单但已经把定位的核心状态机表达清楚了。实际项目里还要考虑方向和符号处理比如目标位置在当前位置左边时速度给定就是负数。另外所有阈值2000、800、200、2都应该放在DB参数表里方便现场调试时调整而不是硬编码在程序里。4.3 变频器控制字/状态字解析范本处理G120报文的时候我一般会单独写一个转换FC把从站读到的原始数据拆解到结构体里。比如从输入区读到一个整数作为状态字ZSW然后逐位判断FUNCTION FC30 : VOID VAR_INPUT zsw: WORD; END_VAR VAR_OUTPUT ready: BOOL; // 准备就绪 running: BOOL; // 运行中 fault: BOOL; // 故障 at_setpoint: BOOL; // 到达设定值 END_VAR ready : zsw.0; // ZSW Bit0 running : zsw.2; // ZSW Bit2 fault : zsw.3; // ZSW Bit3 at_setpoint : zsw.10; // ZSW Bit10控制字STW的发送也建议做成结构体启动时先做“故障确认”然后“准备运行”再“使能”最后给速度。这种分步启动虽然代码量多一截但是能避免很多上电瞬间的误动作。尤其要注意的是抱闸逻辑必须在变频器实际输出足够转矩之后再打开机械抱闸否则重载会溜车。S7-300里可以通过读取变频器状态字的“运行中”Bit2和“到达设定值”Bit10来间接判断更稳妥的是接一个抱闸继电器的反馈触点进PLC。4.4 安全联锁与急停回路堆垛机的安全保护必须分成两层硬回路和软逻辑。硬回路包括急停按钮、安全门开关、巷道端部机械限位、断绳保护装置这些必须通过安全继电器硬接线直接切断动力电源不能只靠PLC程序跳停。程序层面的联锁是“锦上添花”不是“救命稻草”。软逻辑里至少要有这些基本联锁行走机构运行前确认巷道内无人员检测信号漫反射/光电地磁。起升机构在载货台上升前确认货叉已完全退回。货叉伸出前确认起升已到位防止叉到货架横梁。堆垛机与堆垛机之间的互锁防止两机交叉进入同一巷道。超载检测和松绳检测触发时立即停止快速运行只允许低速回退。急停复位逻辑也要仔细设计。急停按下后变频器必须处于自由停车状态OFF2急停复位不能自动恢复运行必须等操作员在触摸屏上手动发“故障复位”命令再确认任务状态没有异常。我们遇到过急停复位后设备自己接着跑的情况非常危险后来在程序里明确规定急停复位后所有运行模式必须回到手动待命状态自动任务必须重新下发。5. G120变频器调试参数、优化与常见警告5.1 上电初始化与快速调试G120的调试第一步是复位到出厂设置尤其是二手或者别人动过的机器不清干净后面会冒出各种奇怪问题。复位后再通过BOP-2面板做快速调试设置P0003访问等级、P00101快速调试然后按顺序填入电机参数额定电压、额定电流、额定频率、额定转速、额定功率。这些参数必须按电机铭牌一字不差地填填错了后面自动优化也没法纠正。电机数据填完之后做电机辨识。G120里常见的办法是设置P1900按负载情况选择。堆垛机的特点是机械传动链长、转动惯量大动态辨识通常需要电机脱开负载旋转现场如果做不到就选静态辨识得到的结果也基本够用了。做完辨识后再跑一段空载确认变频器输出的电流和转速都正常再接入PLC总线控制。第一次上电前一定要手动盘车确认机械没有卡阻这也是老带新时最容易忽略的一条。5.2 总线通讯报文与运行优化如果S7-300和G120之间走PROFINET组态里直接选对应的GSD文件然后在设备视图里指定报文类型。堆垛机场景一般选标准报文1STW1/ZSW1/速度给定/速度实际值就够用了。如果还要通过总线读更多监测数据可以选扩展报文但没必要因为大量的运行数据可以让PLC通过状态字的其他位去判断。调试中一个经常被忽略的点是速度环和位置环的匹配。PLC按位置偏差给出的速度给定到了变频器那里变频器内部的斜坡发生器可能会把速度变化改成它自己的斜坡导致PLC判断“我已经让电机制动了但实际速度还在往上走”。解决办法是PLC发速度给定后把变频器的斜坡时间设为一个很小的值比如0.1秒让速度跟随主要由PLC的位置环来完成。这个细节很关键能避免很多“追不上”的定位问题。5.3 常见报警代码快速解读现场最常遇到的G120报警和故障代码值得整理成一张速查表贴在手边代码含义常见原因排查方向F0001过流电机堵转、加减速过猛、参数错误检查机械卡阻、延长加速时间、做电机辨识F0002过电压制动能量回馈导致直流母线电压过高加制动电阻、检查减速时间、检查供电电压F0003欠电压电源波动、软启动未完成检查供电回路、暂停运行、加电抗器F0005I2t过载长期过载或散热不良检查负载、清理散热器、核对额定电流F0021超速编码器反馈异常、参数设置错误检查编码器接线、核对最高转速参数遇到故障不要急着复位先把故障代码和故障时间记下来再结合设备当时的动作状态去判断。比如堆垛机带着重载上升时报F0001多半是机械卡阻而不是变频器本身的问题。盲目的复位只会让故障反复出现而且容易掩盖真正的原因。6. 现场调试避坑实录我在这类项目上踩过的坑6.1 定位不准先查机械再查程序调试堆垛机碰到定位不准我现在的习惯是遵循“先机械、后电气、再程序”的排查顺序。先检查编码器连轴器有没有松动、电机与减速机之间有没有打滑然后检查认址片安装是否稳固、接近开关间隙是否合适。机械没有问题时再查程序里的脉冲换算系数。换算公式是实际行走距离除以编码器实际脉冲数得到脉冲当量mm/脉冲把这个实测值跟理论计算值对比偏差超过2%就说明哪里有问题。有一个很隐蔽的坑是变频器对编码器信号的干扰。某些堆垛机的行走编码器安装在电机侧编码器电缆和动力电缆走同一个线槽变频器一运行PLC高速计数模块上就多出脉冲来。解决办法是把编码器电缆单独屏蔽、单独走线并保证屏蔽层在PLC侧单端接地动力电缆与信号电缆保持至少20cm的距离。6.2 通信丢站DP网络维护的几个细节PROFIBUS丢站不是每次都发生而是运行一段时间才掉一下这种间歇性故障排查起来最费神。我在这类问题上的经验顺序是先检查DP头和终端电阻再检查接头屏蔽层有没有可靠压接到位然后用万用表测总线电阻。这里有个实用技巧断电状态下在总线末端量A、B线之间的电阻正常应该在90~110欧姆左右。如果量出来是无穷大总线一定在某个地方断开了。另外G120从站的地址设定完成后一定要断电重启才生效。我见过几个新手工程师改了地址发现不起作用急得满头汗其实就是忘了断电重启。跟设备地址相关的还有S7-300的组态从站地址必须跟G120面板上实际设定一致差了哪怕1都会导致找不到从站。6.3 抱闸时序重载溜车事故的根源堆垛机的起升机构一般都有机械抱闸而且是失电抱闸型也就是没电的时候抱死。抱闸的控制时序如果搞不好就会出现溜车或者闷车。起升启动时必须先让变频器建立励磁和输出力矩再抱闸释放停车时先让变频器速度降到零再报抱闸。整个过程如果反了重载时电机会溜车货叉跟货架撞上也不是没可能。PLC给G120的启动命令和抱闸继电器控制信号之间最好加一个可调的延时参数。开抱闸延时我一般设置在1到2秒关抱闸延时0.2到0.5秒具体情况现场调试时根据实际负载调整。同时抱闸继电器的反馈触点要接进PLC开闸命令发出后如果在设定时间内没收到反馈必须报故障停止下一步动作。6.4 调试顺序慢一步反而快十步堆垛机调试最忌讳一上来就跑全自动高速。我的标准操作顺序是先手动模式低速点动每个轴确认方向、限位、报闸都正常然后做零位校准和认址测试再在低速自动模式下跑几个空载任务确认定位逻辑没问题接着把速度逐步提高到额定值验证减速曲线和定位精度最后才挂WMS做全自动联调。这个过程看上去慢但每个阶段能暴露的问题都是不一样的。跳过低速直接高速跑出了问题往往又是撞货架又是掉货损失远大于那点调试时间。最后再说一个我自己的习惯堆垛机程序的每个参数比如爬行距离、到位阈值、加减速时间我都会单独做一张触摸屏参数页面留出来而不是每次改参数都重新下载程序。现场调机时拿着触摸屏改参数比抱着笔记本连PLC快得多。这个项目做完整套程序的架构和调试方法基本沉淀成了标准模板后面再遇到类似的大型堆垛机项目直接复制这套思路去填细节效率能提升一倍不止。