去年做了一条挂扣自动组装线控制核心用的是三菱FX5U带4台汇川伺服组成4轴定位系统。这种非标设备在自动化行业里算是很典型的项目但越是典型越能检验基本功工艺节拍、电气选型、IO表单、设备平面图、程序框架、伺服调试外加回原点参数设置、双伺服龙门同步、手轮跟随这些细节一项都不能省。这篇文章我不打算只讲某个指令怎么用而是把整个项目从头到尾捋一遍从工艺分析到交付文档从伺服参数到程序结构再到现场调试踩过的坑按一个真实项目的推进顺序来写。如果你正在做或者准备接手类似的多轴组装线这篇应该能帮你少走不少弯路。1. 挂扣组装线到底在做什么从工艺流程到4轴分工1.1 工艺动作拆解先说这条线是干嘛的。产品是一个带挂扣的塑料件前道工序把壳体和挂扣分别做好这条线要做的事情就是把挂扣精准地压装到壳体上。整个自动循环可以拆成这么几步壳体通过输送线送到装配工位的工装板上侧向定位气缸伸出把壳体卡死振动盘把挂扣排序后送到直振导槽末端光纤传感器检测到挂扣到位机械手从取扣位抓起挂扣抬升到安全高度龙门机械手横移到装配位旋转轴根据来料角度把挂扣摆正下压装配让挂扣卡入壳体卡槽装配完成后机械手退回定位气缸松开输送线把成品送走。整套动作看起来简单但节拍要求6秒一件也就是说从取料到装配完成必须在5秒多一点的时间内搞定给传感器的响应、伺服的加减速、气缸的动作时间都留得很紧。这种项目工艺动作没有多高端真正花时间的是怎么把每个动作的时间压下来、怎么保证重复定位精度。1.2 为什么是4台伺服其中两条轴要做成龙门设备的核心运动机构是一台三坐标机械手加一个旋转轴。很多人一听“4轴”就默认是4个直线坐标轴实际上这条线的4台伺服分布是这样的轴编号用途电机规格说明X1/X2机械手横移750W 双伺服组成龙门同步驱动Y轴机械手升降400W取放挂扣R轴挂扣旋转400W带减速机角度对位所以真正的直线坐标只有2.5套R轴是旋转轴。X方向行程1200mm如果只用单根电机放在一侧驱动横梁跨度太大运动时会产生明显的偏摆机械手两端的定位精度完全没法保证。用双伺服龙门同步驱动相当于两台电机同时在两头出力横梁受力均匀刚性也上来了。这也是现在中大型龙门结构的主流做法。这个设计决定了后面程序的复杂度单纯控制4个伺服各自动不难难的是让X1和X2这两台伺服始终保持同步不然龙门会扭导轨会憋死严重的时候会直接报警过载。1.3 节拍、精度和视觉扩展的约束精度要求方面X轴的重复定位精度要控制在±0.05mm以内Y轴因为涉及下压装配要求更高一点R轴的旋转定位精度要求±0.1°。这个精度要求对丝杆传动加伺服来说不算苛刻但前提是机械装配要到位联轴器不能松动龙门两侧的同步不能出问题。另外甲方预留了一个视觉扩展的接口后续可能在取扣位加装工业相机用来检测来料角度偏差然后把偏差值补偿给R轴。也就是说程序上要预留视觉坐标补偿的运算空间PLC和相机之间的通信协议也要提前定好免得后期硬件加上了、程序结构不支持那就麻烦了。这也是为什么我在选PLC的时候直接跳过了FX3U。2. 电气系统搭建与选型FX5U为什么够用清单里缺不了什么2.1 控制器的取舍FX5U内置脉冲轴的实用边界三菱FX5U内置4轴高速脉冲输出最大频率200kHz对本项目来说完全够用。X轴丝杆导程16mm电机每转一圈跑16mm200kHz的脉冲频率对应每个脉冲0.01mm时最高速度也有120m/min实际运行速度我们只用到30m/min左右离上限还远得很。Y轴和R轴的速度更低频率压力更小。有人可能会问为什么不直接上FX5U加简单运动模块或者干脆走SSCNET总线伺服我的判断是这个项目的4轴都是标准定位动作没有电子凸轮、插补、高速同步这类需求用内置脉冲轴就够了。增加运动模块或者换总线伺服成本要高出不少调试难度也更大对甲方后期维护的要求更高。做非标设备的选型原则就一条满足节拍和精度的前提下怎么让系统简单可靠怎么来。不过FX5U内置脉冲轴有个边界要留意它虽然叫4轴但轴与轴之间的联动是靠程序扫描周期来协调的不是真正的硬件同步。如果以后要做插补运动或者要求很高的联动精度那就必须换FX5-16ET/ES-H这类带插补功能的运动模块或者直接上升级到总线方案。这一点在项目初期就要跟甲方讲清楚。2.2 伺服和电机的选型匹配关系伺服系统我选的是汇川IS620N系列。选它的原因很实在性价比高调试软件InoDriverShop功能完整在中小型非标设备里用的非常多后期要是客户设备出问题随便在当地找个电工都能上手看。电机的功率配置是我根据负载做的粗略计算。X轴龙门横梁加机械手加挂扣抓取机构总负载质量估算下来在80kg左右双电机驱动意味着每台承担40kg配750W伺服电机惯量比大概在3倍以内这个匹配在项目里算很健康的位置。Y轴负载主要是机械手上下考虑到下压装配时需要一定的持续推力选了400W配刹车保持功能防止断电时机械手突然下坠。R轴负载不大但挂扣的对位精度要求高所以加了1:5的减速机相当于把电机端的分辨率放大了5倍旋转定位精度更容易保证。2.3 一张可以照抄的电气清单骨架电气清单是项目交付的重要文件甲方维护设备、采购备件都靠它。我整理一个简化版的清单骨架实际项目里你还要根据具体外购件型号把细节补完整类别元件名称型号/规格数量备注控制器PLC三菱FX5U-64MT/ES1内置4轴脉冲输出人机界面触摸屏威纶通MT8121IE1也可选三菱GOT伺服系统伺服驱动器汇川IS620N42台750W2台400W伺服系统伺服电机汇川MS1H系列4带刹车/不带刹车低压元件断路器/接触器施耐德或正泰若干总进线及分路保护电源开关电源明纬24V/10A2PLC和传感器分开供电传感器原点/限位开关欧姆龙接近开关8每轴DOG加正负限位传感器光纤放大器基恩士/奥普士2挂扣到位检测执行元件定位气缸SMC/亚德客2工装板定位气动元件电磁阀组汇通/SMC汇流板1控制气缸动作操作元件急停/按钮/旋钮施耐德XB2系列1套含手自动旋钮清单设计有几个细节值得提一下。第一急停回路一定要用硬线切断伺服使能不能只靠PLC程序去停这是安全底线。第二PLC输出的伺服使能、方向控制这些信号中间要加小型继电器隔离防止驱动器侧干扰倒灌进PLC。第三24V电源建议把PLC电源和传感器电源分开现场传感器短路时不会直接把PLC拖死。3. IO表单与设备平面图项目交付的两个关键文档3.1 IO表单设计的几个原则IO表单看起来就是把PLC的输入输出点列一张表但实际设计得好不好直接影响后期编程和查线的效率。我自己设计IO表单时有几个习惯输入点和输出点按功能分区排列不要按硬件顺序排到哪算哪每台伺服的DOG、正限位、负限位放在连续的区域里方便程序里统一处理按钮、旋钮、指示灯这些面板信号单独分区不与传感器混在一起预留10%~15%的备用点分布在各区的末尾方便后期加功能每个IO点在表单里要写清楚用途、常闭/常开类型、所在端子号最好再过一遍安全逻辑。很多新手画草图的时候不重视IO规划等到现场发现程序里要用一个信号结果那个点位已经被占用了只能改接线或者换PLC点那真是又费时间又容易把线搞乱。IO表单这一步做扎实了后面无论是写程序还是售后去现场排查故障都会轻松很多。3.2 这份项目的IO分块表节选下面是我这个项目的IO分配节选不完整但足以说明分块思路。FX5U的输入编号从X0开始输出从Y0开始地址名称功能说明类型备注X0X1轴DOG龙门横移侧1原点狗输入常开X1X2轴DOG龙门横移侧2原点狗输入常开X2Y轴DOG升降轴原点狗输入常开X3R轴DOG旋转轴原点狗输入常开X5-X10正/负限位四轴硬限位输入常闭X12壳体到位输送线定位检测输入常开X13挂扣到位直振导槽末端光纤输入常开X14定位气缸到位工装板夹紧检测输入常开X20启动按钮自动循环启动输入常开X21停止按钮暂停并停在当前节拍输入常闭X22手自动切换手动/自动模式输入旋钮X23回原点按钮各轴回零启动输入常开Y0-Y3脉冲输出4轴脉冲指令输出FX5U高速口Y4-Y7伺服使能4台驱动器使能输出经继电器Y8报警复位伺服报警清除输出经继电器Y10-Y12三色灯运行/报警/待机输出灯塔Y13-Y15气缸控制定位缸/夹紧缸等输出经电磁阀注意X14这种信号气缸动作后传感器有响应延时程序里要加滤波延时不能直接用瞬时状态去触发下一步动作否则偶尔会丢信号导致节拍卡住。3.3 从设备平面图推导程序状态机设备平面图不是画着好看的它是程序状态机设计的直接依据。这条线的平面布局大概是这样的设备中央是装配工位龙门机械手的两根立柱分布在左右两侧横梁跨在装配工位上方X轴的运动区域分成三段左段是取扣区中段是装配区右段是待机区振动盘和直振供料单元放在左后方输送线从头到尾贯穿设备。画完平面图之后每个工位之间的物料流向、机械手动作范围、传感器安装位置就都清楚了。程序里的状态机实际上就是平面图上动作流程的抽象待机状态下机械手停在右段待机区定位于壳体到位后状态机跳入取料逻辑取料完成后进入搬运逻辑搬运到位后进入装配逻辑。后面写程序的时候只需要对照平面图把每个动作接通状态机的动作顺序和互锁关系自然就出来了。我经常跟刚入行的同事说拿到新项目先别急着写程序把平面图琢磨透了再动手效率反而高得多。4. 伺服调试实录回原点、汇川参数、龙门同步和软件连不上伺服4.1 回原点参数设置近点狗方案的关键参数4台伺服我全部采用近点狗DOG回原点方式在三菱FX5U的程序里用的是DSZR指令。回原点的过程分成两步快速向原点方向移动碰到DOG信号后减速到爬行速度继续移动当DOG信号消失的瞬间停止然后把这个位置作为机器原点。回原点参数设置里最容易出问题的是爬行速度。我在这条线调试时一开始把爬行速度设成了25mm/s想着快一点能压缩回零时间结果DOG信号消失的瞬间机械结构还在往前冲一小段每次回完原点坐标都会偏差零点几毫米定位精度直接崩了。后来把爬行速度降到10mm/s停止位置一下子就稳定了。所以回原点的爬行速度我建议设在8到15mm/s之间宁可多花0.2秒回零也不要带着漂移去跑自动。还有两个参数要配套设置原点回归速度和原点偏移量。原点回归速度决定碰到DOG之前的高速接近速度我一般设在进给速度的50%左右。原点偏移量是在DOG信号点基础上再偏移一段距离用于让机械手停在更有利的取料位置上这个值也是要靠试产时的实际装配效果来微调的。4.2 汇川伺服参数设置从电子齿轮比到端子功能汇川IS620N的很多调试工作可以在InoDriverShop软件里完成但有几个参数我习惯直接在驱动器面板上确认因为参数比较多软件操作反而容易漏。首先是控制模式位置模式要确认在H00-03里设成1。然后是脉冲形式FX5U输出的是脉冲加方向所以脉冲输入方式要选对常见的是“脉冲方向”这一档。接下来是电子齿轮比这是定位精度的基础。举个例子计算一下电机编码器分辨率是131072脉冲/圈丝杆导程10mm我的控制目标是每个指令脉冲对应0.01mm移动量那么电机转一圈需要1000个指令脉冲电子齿轮比就是131072比1000化简成整数比是16384比125。如果中间加了减速机分母还要乘以减速比这个千万别漏。再来说说热词里提到的“汇川伺服02-01设置”。IS620N的H02组参数在多数版本里是输入端子功能定义区H02-01对应的是DI1端子的功能选择。现场遇到过伺服使能没反应的查了半天最后发现是DI端子功能被改过使能被分配到了别的端子上去了。所以拿到新驱动器第一件事就是通过InoDriverShop导出一份出厂参数表把DI、DO端子的功能分配和PLC的接线图核对一遍不要想当然地以为DI1默认就是使能。4.3 双伺服龙门的同步调试双伺服龙门是这类设备里最考验功力的部分。X1和X2两个轴如果不能保持同步龙门会歪导轨阻力会变大低速时还可能听到导轨发出“咯咯”的响声。我的做法是在X1轴的主伺服输出端直接并联把脉冲指令接到X2轴的跟随输入上也就是让X1发了多少脉冲X2就原样收到多少脉冲这样两个轴的指令天然就是同步的。PLC里的4轴脉冲口只发X1的脉冲X2的脉冲不是PLC发的而是从X1驱动器级联出来的。这种主从同步方案的好处是省掉了PLC扫描周期带来的误差两个伺服接收到的是同一个脉冲序列同步精度只取决于伺服的响应一致性。如果伺服驱动器本身支持龙门同步模式也可以在InoDriverShop里直接把从轴设成龙门模式让驱动器内部做跟随PLC视角下只有X1一个轴需要管理。不过我在这个项目里没这么用因为保留X2轴单独可控在安装调试时可以利用X2的单独点动去校正机械Y方向的安装误差等机械校正完再切回级联同步。龙门抖动问题也是调试现场常遇到的原因大多是位置增益太高或者机械刚性不足。处理办法是先降位置比例增益再把加速时间适当拉长让加减速更平缓最后在驱动器里打开振动抑制功能。不要一上来就想着靠提高增益去压抖动机械结构的刚性摆在那里电气增益再高也压不住物理瓶颈。4.4 InoDriverShop搜索不到伺服一次网络排查实录这条线调试到第三天的下午现场工程师突然喊我过去说InoDriverShop软件里搜索不到伺服地址4台驱动器的网线都查了一遍灯都是亮的电机就是“离线”。我到现场后没有急着在软件里折腾先做了一件事让工程师把电脑的网卡IP设置打开看看当前IP段是什么。结果发现这台电脑有两块网卡一块连着办公室局域网IP是192.168.1.x另一块连着驱动器的调试网络IP是192.168.8.x。InoDriverShop在扫描的时候明明可以选网卡但软件默认走了第一块物理网卡结果一直在办公室局域网里做广播当然搜不到伺服。处理办法很简单把不用的那块网卡临时禁用掉然后再重新搜索4台驱动器一下就全出来了。这个坑非常典型尤其新手容易遇到。如果你在项目现场怎么也搜不到伺服按这个顺序排查电脑和伺服驱动器的网络接口是否都插好网线是不是好的电脑网卡IP是否和驱动器在同一个网段如果电脑有多块网卡只保留与驱动器相连的那一块有效关闭Windows防火墙或者允许InoDriverShop通过防火墙以上都确认了还不行看驱动器面板显示是否有报错有些驱动器的通信参数出错会导致不响应。5. 4轴定位程序怎么写从状态机到手轮跟随5.1 程序整体结构FX5U定位指令怎么选FX5U的定位编程我采用的是模块化结构主程序只做几件事调用回原点模块、调用手动操作模块、调用自动状态机模块、调用报警处理模块。每个模块做成独立的子程序或者FB块调试的时候单独调每个模块互不干扰。定位指令的选择上绝对定位用DDRVA相对定位用DRVI回原点用DSZR。自动状态下装配位置、取料位置都是固定的用绝对定位更合适因为程序里不需要记录上一次移动了多少直接告诉伺服目标坐标就行。手动点动用相对定位每次点一下按钮就移动一段距离。注意DRVI和DDRVA混用时最好在切模式的时候把当前坐标刷新到系统寄存器里避免手动移动后自动坐标对不上。加减速参数我设在PLC的定位参数表里4轴统一用250ms加速时间、250ms减速时间。这个值一开始是凭经验给的后来试产时发现R轴旋转定位结束时角度有点过冲把减速时间调到350ms就好了。所以加减速参数不是一次定死的要根据实际装配效果微调。5.2 手动/手轮模式和自动模式的切换逻辑手动和自动模式的切换看着简单实际容易出问题的地方在于坐标管理。比如手动模式下把Y轴抬高了切到自动模式后程序如果直接执行“下压到装配位”Y轴可能还在中间位置就直接往下移动轻则压坏工件重则撞坏治具。我的做法是手动模式下每根轴移动后都会实时刷新“轴已移动”的标记切到自动模式时程序先检查这些标记只要有任何一根轴被手动移动过自动循环就不允许直接启动强制要求手动把机械手移回待机位或者重新回一次原点。这个检查逻辑加上去之后车间操作员再也不用担心手动动过的轴把自动程序带跑偏了。另外手动模式下伺服使能、回原点按钮、各轴点动按钮都要和机械限位互锁。点动时接近限位要立刻停这个停止逻辑要走硬限位不能只靠PLC扫描周期去判断否则高频点动的时候可能冲出限位。5.3 手轮控制伺服跟随的实现思路手轮在这条线里用于机械手调试对位方便操作员手动把机械手摇到某个位置可以模拟自动动作检查干涉。FX5U读取手轮的A/B相脉冲我用的是内置高速计数器功能A相接C251的输入端子B相接C251的另一个端子计数方向由A/B相位差自动识别。手轮的脉冲实时值读到PLC后程序每隔一个固定周期我用10ms定时中断把当前计数值和上一次的计数值做差得到这个周期内手轮转了多少脉冲。把这个差值乘以倍率×1、×10、×100换算成轴目标位置的增量在当前目标位置基础上累加然后输出DDRVA指令让伺服定位到新的目标点。这里有个经验手轮跟随不要每一个扫描周期都去刷新DDRVA扫描周期不稳定会导致运动不平滑反而有明显的顿挫感。用固定周期中断配合伺服自身的加减速曲线手轮摇起来就顺畅得多。这套思路其实不限于FX5U后来有人问我汇川Easy521的PLC怎么实现手轮跟随我说原理完全一样只是Easy521有电子齿轮和凸轮功能可以把编码器输入直接映射到轴的跟随运动硬件的实时性比FX5U的循环刷新更好。但如果你已经用了FX5U用中断加DDRVA的方案完全够用。5.4 视觉定位坐标补偿的扩展思路前面提到这条线预留了视觉接口。视觉补偿的基本思路是相机在固定位置拍到来料的实际位置和角度把偏差值通过通信发给PLCPLC把偏差换算成R轴和X轴的脉冲补偿量叠加到目标坐标上再执行定位。角度换算脉冲的公式也不复杂R轴转1度需要多少个脉冲这个值取决于减速比和电子齿轮比比如减速比1:5、编码器分辨率131072那么电机轴转5圈对应旋转轴转1度脉冲数就是131072乘以5再除以电子齿轮比对应的指令脉冲系数。这个值算好之后程序里直接用偏差角度乘以脉冲系数就能得到补偿脉冲数。视觉补偿最容易出问题的是坐标系的镜像关系。相机图像中看到的左右方向和机械手的运动方向可能是反的标定的时候要先把正方向测试出来记录到参数表里。否则装上去之后方向反了轻则定位失败重则强行把工件顶坏。6. 现场试产遇到的问题清单送给刚接手这类设备的你试产两周把遇到的主要问题整理一下这些问题都不是高精尖的故障但每一条都实打实地耽误过时间写出来供大家参考。现象根因处理方式龙门低速移动时有抖动位置增益过高机械刚性不足降低P增益延长加减速开启振动抑制回原点后坐标偏差0.3mm爬行速度太高DOG信号晚停爬行速度调到10mm/s重新回零测试伺服偶尔过载报警负载偏大Y轴下降时重力灌入设置重力轴扭矩补偿合理调整惯量比InoDriverShop搜不到伺服电脑多网卡软件走错网卡禁用无关网卡手动指定IP段自动循环偶尔停在中途气缸到位信号有延时程序判断过早传感器信号增加20ms滤波确认R轴装配角度偶尔超差原点偏移量未精确校正通过试产数据微调R轴原点偏移量触摸屏报警信息不全报警文本未细分到每个轴按照轴号和报警类型建立报警映射这里面的每一条我自己都在现场花过不少冤枉时间。印象最深的是龙门抖动那条当时我在驱动器参数里调了一下午位置环增益从低到高试了个遍后来发现是横梁导轨的固定螺栓松了两颗机械刚性不足电气参数调得再漂亮也没用。所以遇到运动抖动、过载这类问题先确认机械安装状态再动电气参数顺序不能反。另一个想重点提醒的是触摸屏上的报警信息一定要做得细致。现场操作工不是每个人都能看懂PLC程序报警信息如果只写“伺服报警”操作工根本不知道是哪根轴出了问题。把报警文本按照“轴号报警类型处理建议”的格式写清楚比如“X1轴伺服过载检查导轨是否有卡阻”这样会降低很多售后沟通成本。很多工程师觉得报警管理是小事其实对设备好不好用影响特别大。最后说点个人体会。这种4轴定位组装线项目难度不在某一台伺服或者某一行程序上而在于把机械、电气、程序、文档四样东西拧成一股绳。FX5U这类PLC本身其实已经非常稳定真正影响项目成败的往往是你对工艺的理解、对现场细节的敏感度还有做IO表单和设备平面图时有没有花心思。尤其是IO表单和电气清单它们不只是给甲方交差的文件更是你自己调试和后续维护的地图。项目收尾之后我把这套文档重新整理了一遍下一台类似设备如果再让我做估计能比这次至少快出三分之一的时间。做非标就是这样每个项目都是在为下一个项目积累底子。