松下FP-XH伺服控制程序，上下料整套程序。
拆开松下FP-XH控制柜的瞬间，伺服电机特有的青轴色编码线格外显眼。这套老牌PLC在运动控制领域依然能打，今天咱们就扒一扒它的伺服控制实战——特别是上下料这种既要精度又要效率的活。
硬件搭台
控制箱里FP-XH C60T通过20针扩展口连着两个松下A6BE伺服驱动器。注意脉冲类型要选对，Y0/Y1输出高速脉冲得设置成差动输出模式：
MOV K2 D9036 // 设置Y0/Y1为差动输出 MOV K3 D9037 // 设置Y2/Y3为差动输出遇到过现场干扰大的情况？接地铜排记得单独拉线到驱动器PE端，别偷懒接到控制柜地线汇流排，电机一跑起来就报Err16编码器异常的坑我替你们踩过了。
伺服参数玄学
别被手册上几十个参数吓到，实战中重点盯这几个：
- Pr0.01=3（位置控制模式）
- Pr0.06=5000 // 每转脉冲数要和PLC侧一致
- Pr0.17=150 // 刚性调整，数值越大响应越快但容易抖
调试时最头疼的是刚性参数。有次机械手抓料总晃，把Pr0.17从200降到130，同时加了个速度前馈：
// 运动指令示例 MC_MoveAbsolute( Axis:=Axis1, Position:=300.0, Velocity:=50.0, Acceleration:=1000.0, Deceleration:=1000.0, Jerk:=2000.0, BufferMode:=MC_BUFFERED);这个Jerk参数是加加速度控制，相当于给运动曲线"抹圆角"。特别是上下料这种频繁启停的场景，不加这个料盘到位时晃得能跳机械舞。
松下FP-XH伺服控制程序，上下料整套程序。
上下料编程套路
整个流程要像德芙一样丝滑，得处理好三段式：
- 真空吸盘下压时加压力检测
- 水平轴移动玩速度同步
- 异常处理别只会急停
看这段真空控制的代码：
LD X10 // 物料到位传感器 AND X11 // 气压正常信号 OUT Y10 // 开启真空发生器 TMR T0 K50 // 50ms建立真空时间 LD T0 AND X12 // 真空压力开关 OUT M100 // 允许移载标志重点在于T0定时器和X12的与逻辑——有些新手会直接用真空开关触发移载，结果吸着不稳就移动，现场表演天女散花。加个50ms延迟让真空度稳定，成品率直接提升三成。
遇到过移载中途真空失效？在运动过程中持续监控：
IF NOT Axis1.IsContinuous AND NOT VacuumOK THEN MC_Stop(Axis1,Deceleration:=2000.0, Jerk:=3000.0); AlarmCode:=16#1001; RETURN; END_IF急停时2000的减速度要跟机械工程师确认，别按默认值瞎用，否则急停比正常运行还费皮带。
现场玄学三则
- 原点回归时偶尔过冲？试试把近点狗信号的触发位置调后5mm
- Z相脉冲干扰大时，把Pr0.08改成2（Z相滤波增强）
- 用FP-XH的CH2脉冲通道时，记得改CTBL寄存器分配
这套程序在汽车零部件产线跑了两年，最大的收获是——永远别相信气缸到位传感器的第一次信号。现在我的安全逻辑里都带双重验证：
LD X20 // 气缸伸出传感器 AND X21 // 磁性开关确认 TMR T1 K30 // 30ms防抖 LDI X20 // 伸出传感器消失 AND X22 // 气缸缩回传感器 TMR T2 K30两个定时器构成的状态机，专治各种误信号。毕竟在工厂里，传感器比女朋友还善变。
最后说个真事：有次设备突然所有轴乱动，查了两天发现是接地线被老鼠啃了。所以各位，搞自动化的不仅要懂代码，还得会抓老鼠啊。
