西门子S7-1200三轴机械手控制系统结构化编程实现

先说结论：用西门子S7-1200做一套三轴直角坐标机械手的控制系统，完全可行。而且这套东西的编程思路一旦整理成模板，后面再接手同类型的上下料、搬运、码垛项目，基本就是改参数的事，不用从头再撸一遍程序。我手头这套程序已经在两台设备上跑过，从最开始单轴点动调试到三轴联动跑完整个搬运节拍，中间踩了不少坑，也把结构化编程的套路彻底磨顺了。这篇文章就把它拆开讲透。

这个项目解决的是最典型的三轴机械手搬运场景：X轴加Y轴做平面移动，Z轴做升降，末端挂一个气动夹爪，把工件从传送带取料到托盘上。控制核心是S7-1200，配合三套伺服驱动器、触摸屏和传感器，构成一套完整的工艺闭环。适合谁看？正在做1200运动控制项目的电气工程师、准备把机械手控制做成标准化模板的团队，以及第一次接触PLCopen运动控制指令的工控新手。下面进入正题。

1. 为什么用1200做三轴机械手：方案选型与系统架构

1.1 需求明确与核心难点

我把需求先列清楚：三根轴分别是X轴（横移）、Y轴（纵移）、Z轴（升降），形成直角坐标结构。末端气动夹爪用来夹取工件，工件到位检测靠光电传感器，Z轴带原点开关和上下限位，X/Y轴也各有原点和限位。客户要求的动作是：传送带检测到工件到位，机械手从取料位抓取，放到托盘指定位置，完成一个循环后继续抓下一个，托盘放满后报警提示换盘。

这里面真正的技术难点其实只有一个，就是三轴联动。所谓联动，不是简单的三根轴各动各的，而是要求它们在同一段时间内协调运动，保证末端执行器走出一条符合工艺要求的空间轨迹。比如Z轴先上升到安全高度，X/Y轴同时运动到目标点上方，这段过程里如果X和Y速度不匹配，机械手走的就不是直线而是折线，姿态来回扭，不仅难看，还会加大机械磨损。后面第三节我会专门讲怎么处理。

另外还有个管理层面的隐性需求：客户工厂里不止一台设备，后续可能还有不同规格的机械手，所以程序必须做成可复用的模板，不能每个项目从零开始写。这就自然引出了结构化编程的要求。

1.2 硬件选型与两种驱动器方案对比

S7-1200到底能不能驱动三轴机械手？能，但它有个绕不过去的坎：1200没有S7-1500那种轴组（Kinematics）功能，不能直接调用MC_MoveLinear这类空间插补指令。这意味着1200上的"联动"只能靠工艺逻辑和速度匹配去实现，而不是硬件级的插补。这个现实问题我在做方案时反复确认过，最后确认它不影响本项目，因为直角坐标机械手做搬运，90%的运动路径都可以拆成"先垂直、再直线、再垂直"的组合，根本不需要真正的空间直线插补。

驱动器方案我对比过两种：一种是PN通信控制V90伺服，另一种是PTO脉冲口控制步进驱动器。

最终选型是V90方案，主要原因是Z轴垂直方向必须用带抱闸的伺服电机，断电时自动锁轴，这是安全要求，步进电机只能做到电气锁定，做不到机械锁定，断电会往下溜。项目预算允许的情况下，V90是正解。如果做小负载、低速度的轻载设备，步进方案也不是不行，就是要在程序里多写丢步检测和超时报警。

1.3 系统拓扑与硬件清单

最终硬件配置如下：

• 西门子S7-1200 CPU 1215C DC/DC/DC，固件V4.5以上
• 三套V90伺服驱动器加60mm伺服电机，Z轴配抱闸
• KTP900 Basic触摸屏
• 工业交换机若干口的就够
• 光电传感器、原点接近开关、上下限位开关
• 气动夹爪、电磁阀、磁性开关

网络拓扑很简洁：CPU的PN口接交换机，交换机下面挂三个V90和触摸屏。我用交换机而不是CPU直连V90，是因为后续可能加视觉系统上位机，先留好扩展口。通信报文这里注意一下，V90在EPOS模式下用TIA组态时我选的是报文111（位置控制PZD），工艺对象挂上去之后MC_Power、MC_MoveAbsolute这些指令才认轴。不同固件版本支持的报文列表可能有差异，组态时以设备视图里实际能选到的为准。如果报文选错，症状就是使能发下去驱动器没反应或者直接报通信类故障，这个坑很多人都会遇到。

2. 结构化编程整体设计：从变量到FB的分层拆解

2.1 数据建模：用UDT把轴变成"一张表"

结构化编程的第一步不是写代码，而是设计数据结构。我把每个轴的所有参数和状态封装成一个UDT（用户自定义数据类型），名字叫UDT_AxisData。打个比方，这个UDT就像一张体检表，轴的"身高、体重、病史、体检结果"全在里面，拿到这张表就能完整描述一根轴。

UDT里我分成了四组：

• 指令接口：Enable使能、Home回原、MoveAbs绝对定位、MoveRel相对定位、Stop停止、JogPlus正点动、JogMinus负点动
• 工艺参数：目标位置、运行速度、加减速度、回原方向、位置上下限
• 机械参数：丝杆导程、编码器每转脉冲数、电子齿轮比（用于单位换算）
• 状态反馈：当前位置、当前速度、到位标志、回原完成标志、错误代码、总线状态

有了这个UDT，轴的数据定义就统一了。程序中用三个背景实例分别代表X、Y、Z轴，数据块结构完全一样，只是参数值不同。这也是模板化的第一层：数据结构统一，程序逻辑才能统一。

2.2 程序骨架：OB1怎么搭

程序组织上我用的是经典的分层结构：

OB100 初始化 → 读取断电保持参数、复位状态 OB1 主循环 → 调用FB_RobotSequence主流程状态机 FB_RobotSequence → 调用FB_MotionManager（三轴协同调度） FB_MotionManager → 调用FB_AxisControl × 3（X/Y/Z各一个实例） FC_Convert → 单位换算工具函数 FC_SpeedCalc → 联动速度匹配计算函数

这样的好处是层次清晰：最外层状态机只管"设备现在该干什么"，中间层只管"怎么把目标点分给三根轴"，最内层只管"单根轴怎么执行定位指令"。改动作不用动底层，换电机不用动上层，各改各的。

语言选择上我基本全用SCL，安全回路和急停逻辑用LAD。SCL写状态机、数组、公式计算特别顺手，LAD画互锁和急停回路直观。有人觉得1200必须用梯形图，其实固件V4.0以上SCL已经是完整支持的，不用怕。

2.3 FB封装细节：FB_AxisControl参数接口设计

FB_AxisControl是我整个程序里复用率最高的功能块，它的作用就是把西门子PLCopen运动控制指令（MC_Power、MC_Home、MC_MoveAbsolute、MC_MoveRelative、MC_Stop）统一封装成一个标准接口，外部只需要给指令和参数，不用关心内部怎么调工艺对象。

FB内部的结构大概是：首先调用MC_Power使能轴，使能逻辑里我处理了报错复位和急停联动。回原模式我选的是MC_Home的Mode=3，也就是找参考点开关加编码器零脉冲，每次回原位置的一致性很好。定位方面，绝对运动和相对运动都用标准指令实现，到位判断不是完全依赖指令的Done位，而是额外用实际位置和目标位置的偏差窗口判断，偏差小于0.2mm且保持200ms才算到位，这样可以过滤掉伺服微调过程中的抖动。

调用这个FB的时候，我对三根轴分别实例化：FB_AxisControl 实例名 X_Axis背景数据块DB_Axis_X、Y_Axis背景数据块DB_Axis_Y、Z_Axis背景数据块DB_Axis_Z。三份代码完全一致，只是工艺对象和参数不同。以后要加一根轴，只需要再拖一个实例，改一下参数接口就行，代码一行不用变，这就是结构化编程复用性的直观体现。

3. 三轴联动控制实现：速度匹配与路径规划

3.1 先泼冷水：1200没有轴组插补，联动怎么理解

我得先把话说清楚，免得有人拿着这个方案往点胶机、激光切割机上套，然后跑不起来骂我。S7-1200不支持MC_MoveLinear、MC_MoveDirect这类轴组插补指令，这是硬件和固件层面的限制，别指望用1200做真正的三轴联动空间直线插补。真正的插补要上S7-1500配轴组工艺对象，或者外挂独立运动控制器。

那1200的"联动"怎么做？答案是软联动。即不追求每个插补周期都精确同步，而是通过运动任务拆分和速度匹配，让多根轴在同一时段内并行运动，并保证在选定的同步点（比如从取料位的点走到放料位的点）同时到达。搬运场景下机械手走的是直角路径（上升、平移、下降、取放件），软联动完全够用。

这个认知非常重要。我见过有工程师答应客户"1200做联动控制"，最后写程序才发现插补指令在1200上根本不存在，项目直接卡壳。做方案前先确认硬件的运动控制边界，比什么都重要。

3.2 速度匹配算法：基准轴与比例速度

软联通的关键就是速度匹配。假设机械手要从点A(x1, y1)平移到点B(x2, y2)，且要求X轴和Y轴同时启动、同时到位，这样才能走出一条45度方向的平滑斜线（在XY平面上）。数学上很简单：两轴运行时间相等，而距离可能不等，所以速度比必须等于距离比。

设X轴行程dx = |x2 - x1|，Y轴行程dy = |y2 - y1|。为了节拍最快，行程大的轴（基准轴）按允许最大速度运行，行程小的轴按比例降速。具体计算：

1. 计算基准轴行程dMax = max(dx, dy)
2. 取基准轴速度Vmax为允许运行速度
3. 计算运行时间T = dMax / Vmax
4. 另一轴速度 V = 对应行程 / T

换算成程序，就是把FC_SpeedCalc写成一个函数，输入两轴的目标位置和当前位置，输出两轴各自的运行速度。放到程序里是这样：

// FC_SpeedCalc 核心逻辑（SCL伪码） dx := ABS(DB_Axis_X.PosTarget - DB_Axis_X.PosActual); dy := ABS(DB_Axis_Y.PosTarget - DB_Axis_Y.PosActual); IF dx >= dy THEN vBase := V_MAX_X; T := dx / vBase; vY := dy / T; vX := vBase; ELSE vBase := V_MAX_Y; T := dy / vBase; vX := dx / T; vY := vBase; END_IF;

这里注意一个细节：基准轴的速度不能超过该轴的最大速度，非基准轴计算出来的速度也不能超限。如果非基准轴算出的速度超了，说明两轴距离比超出了速度比范围，这时就要反过来校验：先设定非基准轴的最大速度，再反推基准轴速度，保证两边都合法。

节拍优化上也有一点心得：如果X轴距离是Y轴的几倍，速度比差距很大，那么斜线会比较"扁"，这是物理限制，程序改不了。想优化只能改机构布局，让两个方向行程接近一些。这个案例里X方向行程600mm，Y方向200mm，所以联动时X基本跑满速，Y按比例降到大约三分之一，整体运动时间是流畅的。

3.3 位置换算与电子齿轮比

伺服系统里有两个"单位体系"，一种是PLC里的工程单位（毫米、毫米每秒），一种是伺服内部的脉冲单位。如果不做换算，程序里看到的数值和实际位置就对不上，调试时非常容易乱。

V90增量编码器默认2500线，4倍频后每转10000个脉冲。配的丝杆导程是5mm，也就是说电机转一圈负载移动5mm。所以每毫米对应的脉冲数：

每毫米脉冲数 = 10000 ÷ 5 = 2000 脉冲/mm

位置分辨率就是 1 ÷ 2000 = 0.0005mm，这个精度对搬运应用绰绰有余。在TIA的工艺对象"机械参数"里，我设置"电机每转的负载位移 = 5mm"、"每转脉冲数 = 10000"，工艺对象会自动完成换算，PLC程序里直接使用毫米单位，不用手工转换。

这个换算关系一定要在项目文档里写清楚，不然换个人维护程序，看到工艺对象里面的10000和5，不知道是什么参数，很容易改错。我习惯在UDT的机械参数里把丝杆导程、编码器分辨率、电子齿轮比全部显式存一份，注释写明计算过程，哪怕工艺对象里改了，程序里也能查得回原始机械数据。

3.4 一个完整搬运动作的路径拆解

三轴机械手做一个完整的"取料-放料"循环，路径是这样拆解的：

第一步：Z轴从当前位置上升到安全高度（比如100mm位置），这个动作只有Z轴动，其他轴保持。 第二步：X/Y轴联动，从取料位上方移动到放料位上方。这里用FC_SpeedCalc计算两轴速度，配合FB_AxisControl同时触发两个轴的绝对定位。 第三步：Z轴下降到放料高度，执行放料动作，气动夹爪打开。 第四步：Z轴再次上升，然后X/Y轴联动返回到取料位上方。

整个循环里，真正用到联动算法的就是第二步和第四步。为什么要先把Z升到安全高度再联动？因为在机械手平移过程中，如果Z轴还插在料堆里，容易撞到工件或托盘。这个安全高度是工艺参数，可以在HMI上调整，换产品时不用改程序。

运动中还有个细微处：第二步联动开始时，Z轴已经到达安全高度，但到位信号和X/Y启动信号之间有几十毫秒延迟，程序里要做等待，否则可能出现Z还没到位X就开始跑的情况。我采用的做法是，状态机在Z轴到位后再置位下一个运动使能，到位判断用位置窗口偏差而不是Done位，窗口偏差设为0.3mm，确保稳定。

4. 工艺流程状态机与手自动安全逻辑

4.1 状态机与状态枚举

三轴机械手如果不写状态机，代码会变成一大堆M继电器散落在各处，改一个动作牵一发动全身。我全部用SCL的CASE语句写状态机，状态枚举定义在一个全局DB里：

S_INIT := 0, // 上电初始化 S_HOME := 1, // 回原点 S_READY := 2, // 准备就绪 S_PICK_APPROACH := 3, // 到取料位上方 S_PICK_DOWN := 4, // 下降取料 S_GRIP_ON := 5, // 夹爪闭合 S_PICK_UP := 6, // 上升 S_PLACE_APPROACH:= 7, // 到放料位上方 S_PLACE_DOWN := 8, // 下降放料 S_GRIP_OFF := 9, // 夹爪打开 S_PLACE_UP := 10, // 上升 S_COMPLETE := 11 // 单循环完成

状态机的好处是所有状态转换都在一个CASE里，逻辑一目了然。每个状态都有明确的进入动作和退出条件，比如S_PICK_DOWN状态里，进入时触发Z轴下降到取料位置，退出条件是"Z轴到位且夹爪松开状态确认"。如果条件超时没满足，就跳到故障处理状态。

我还加了一个状态转换超时监视，每个状态都有独立的计时器。比如S_PICK_DOWN设置了3秒超时，如果3秒内没有到取料位置，说明Z轴可能被卡住或者机械故障，程序直接进入报警停止状态，防止继续动作造成损坏。这个超时时间可以根据节拍调整，但远比没有超时安全。

4.2 自动运行流程与节拍估算

自动运行的主流程是这样的：设备启动后先检查是否回原，没回原不允许进入自动；确认回原后等待工件到位信号；工件到位，状态机从S_READY开始往下走；执行完放料，如果是托盘最后一个位置，置位"托盘满"报警并在HMI弹窗；换盘后按复位键清除报警，继续下一轮。

节拍上做个粗略估算。假设Z轴行程50mm、速度250mm/s，单次上升或下降需要0.2秒，考虑加减速实际约0.4秒；X/Y联动行程600mm和200mm，联动时间约3秒；夹爪闭合和打开各0.5秒。单循环总时间大约7秒左右，一小时能处理约500个工件，对这个物料尺寸来说效率是够的。如果客户要求更快的节拍，一般优先从三个方面优化：提高最大运行速度、缩短夹爪动作时间、优化路径减少无效行程。

4.3 手自动切换、急停与回原设计

手自动切换这个细节要处理好，否则设备在生产中一切手动，状态机就会错乱。我的方案是手动模式禁止状态机运行，所有轴动作由HMI点动按钮直接触发；切回自动之前，必须先将机械手移动到安全位置或者重新执行回原，然后才允许启动自动循环。回原的必要性在于，手动操作后PLC记录的坐标可能与机械实际位置不一致，贸然跑自动轻则撞料重则撞机。

回原时序也要规范：X和Y轴先回原，Z轴最后回原。原因是Z轴如果先回去并且停在不安全高度，X/Y运动时可能撞到Z轴上挂的夹爪或工件。回原完成后，每个轴的回原完成标志都置位，任何一根轴报错掉使能，所有轴的完成标志都要清掉，要求重新全部回原，这是最保守也最安全的方式。

急停逻辑分两层：外接急停按钮直接接入伺服驱动器的STO端子，物理上切断驱动器的使能输出，这是硬件级保护；同时急停信号也接到PLC输入点，程序里把状态机强制跳转到急停状态，封锁所有轴运动指令、关闭夹爪输出，并记录当前是哪个状态被中断。复位时不能直接回到自动，必须先手动确认安全、清除故障、再执行回原，才能恢复。安全无小事，这里我宁可流程繁琐一点，也不给事故留机会。

5. 调试实录与常见问题排查

5.1 分阶段调试顺序

三轴机械手联调如果直接上自动循环，出问题根本不知道是哪个环节。我的做法是严格按阶段来：

第一个阶段，单轴点动验证。在HMI手动画面里逐轴点动，确认每个轴的电机方向、限位方向、原点开关逻辑都正确。这一步最关键，曾经遇到过Z轴因为电机相序接反，点动上升实际是下降，幸好限位和急停都生效，没造成损失。方向验证通过以后才允许配置回原。

第二个阶段，单轴回原验证。分别对X、Y、Z回原，反复执行十次以上，确认每次停在原点位置一致，偏差小于0.1mm才算通过。如果回原位置有漂移，先检查原点开关信号有没有抖动，给输入点加滤波时间，再检查回原模式是否使用了Z相脉冲。

第三个阶段，程序状态机空跑。不上工件、不动作夹爪，让程序把状态机跑一遍，看状态转换顺序和时间点是否符合预期。这时候可以用HMI上的状态显示页面来观察，每个状态都有指示灯，出问题一眼能看出来卡在哪个状态。

第四个阶段，带上夹爪和工件做完整循环。先从低速倍率50%开始跑，确认路径安全以后再逐步提升到100%。最后连续跑两小时以上验证稳定性，同时记录实际节拍与设计节拍的差距。

5.2 用Trace观察速度曲线调参数

TIA Portal自带的Trace功能在这个项目里立了大功。调联动参数时，我用Trace同时记录X轴和Y轴的实际速度曲线、位置曲线，然后检查联动段两条速度曲线是否按比例同步变化。如果发现某根轴速度波动大，一般是加减速时间设置不合理，或者是机械上存在爬行现象。

调加减速的经验值：加速度设在1000到1500mm/s²之间比较稳妥，太小影响节拍，太大会引起机械抖动和过冲。我一开始把加速度设在2500mm/s²，结果X轴到目标点以后位置过冲明显，Trace上看到一个约1mm的过冲回退，说明机械刚性扛不住这么大的加速度。后来逐步降到1500mm/s²，过冲基本消失，节拍损失只有零点几秒，完全能接受。

Trace还能验证我的速度匹配算法是否正确。如果X和Y到达目标点的时间差超过50ms，就需要检查是哪个轴的到位判断逻辑延迟了，或者是某个轴的负载偏重导致实际速度跟不上给定值。V90伺服有自动增益和优化功能，我用它在带负载状态下做了自动优化，机械响应改善很明显。

5.3 常见问题速查表

调试过程中遇到的问题记录下来，整理成一张速查表，后面维护时能节省大量排查时间。

这些只是高频问题，实际项目中还会有各种奇葩现象。我的经验是，遇到问题先别急着改程序，先用Trace或者程序状态监控把现象复现出来，看清楚是不是自己预期的逻辑在执行，很多时候问题出在传感器信号或者机械卡滞，不在程序本身。

5.4 模板复用经验与扩展方向

这套程序模板现在已经沉淀成形，我第二次做类似项目时就体会到了模板的价值：换了一台龙门式三轴机械手，轴行程和负载都变了，但程序部分只改了UDT里的机械参数和HMI上的工艺参数，状态机、联动算法、手自动逻辑一行没动，从组态到跑通节拍只花了三天。这就是结构化编程对项目交付速度的提升。

模板还能怎么扩展？如果后续要把S7-1200升级到S7-1500，程序可以平滑迁移，因为UDT和状态机的设计跟硬件平台无关，迁移时只需要把工艺对象重新组态一遍，然后把1500才支持的轴组插补功能挂到相关状态里，原来写的软联动逻辑正好作为降级备份。

如果加视觉系统做定位引导，也只需在状态机前面加一个"视觉拍照-坐标标定"环节，视觉反馈的像素坐标通过标定矩阵换算成机械手坐标，然后写入UDT里的目标位置，其他的联动逻辑不用动。实际上我第二台设备就是加了视觉的，这套结构撑住了。

最后再分享一个小技巧：调试阶段在HMI上做一个"坐标写入"页面，可以直接输入任意轴的设定位置并执行绝对定位，方便测试不同工位的坐标值，比每次修改程序里的目标位置再下载要高效得多。有了这个页面，调试人员不需要懂程序也能帮忙测点位，项目进度快很多。