三菱plc控制四轴（X轴，Y轴，Z轴，旋转轴）伺服定位程序案例。 （包含CAD电气图纸，BOM表，plc人机界面程序）

最近在忙一个四轴定位项目，用三菱FX5U带四个MR-JE-20A伺服，从机械结构设计到PLC程序调试踩了不少坑。特别是那个360度无限旋转的第四轴，参数配置差点让我头发掉光。今天把核心代码和硬件方案整理出来，特别是伺服原点回归和绝对定位的骚操作值得重点说说。

硬件部分先看BOM表：

• 三菱FX5U-64MT/ES（带4轴脉冲输出）
• MR-JE-20A伺服驱动器*4
• GT2107-W1触摸屏
• 明纬S-350-24开关电源
• 正泰中间继电器模组

（完整清单在文末资料包）

!电气接线图

程序框架采用结构化编程，重点看轴参数初始化：

//伺服参数写入（以X轴为例）
MOV K2000 D8146     //加减速时间200ms
DMOV K100000 D100   //电子齿轮比分子
DMOV K1 D102        //分母
CALL P_SETPARA      //参数写入子程序

//原点回归程序
LD M8000
DDRVI K-50000 K5000 Y0  //先反向慢速找原点
LD M8029
ZRN Y0 X0 K500         //切换近点信号模式

这里用双速原点回归是因为现场有金属粉尘，普通ZRN指令容易误触发。DRVI指令的脉冲数用负数强制反方向运行，比改伺服参数更直接。

多轴联动时注意脉冲输出冲突，建议用表格定位：

//XY轴同步插补
MOV K1 D200        //表格号
TBL D200           //启动表格运行
//表格内容：
1: X目标=5000,Y目标=3000,速度=100KHz
2: X=8000,Y=4500,速度=80KHz

实测用表格方式比PLSV指令的轨迹平滑度提升40%，特别是圆弧过渡位置。注意每个表格行要配置加减速曲线，否则拐角会抖得像帕金森。

HMI界面做了个三维坐标预览功能（虽然实际是伪3D），核心是数值输入框绑定D寄存器：

//触摸屏坐标输入处理
IF X_Input <> D500 THEN
   MOV X_Input D500
   SET M100
ENDIF

重点是把浮点坐标转换成脉冲数时要做双重校验，防止超程。我们在屏幕底部加了动态坐标跟踪条，用红色渐变提示接近软限位的位置。

调试时遇到最坑爹的问题：旋转轴在连续运转时累积误差。后来发现是伺服参数Pr0.01设置成增量模式导致，改成绝对编码器模式后加了个每周清零程序：

//旋转轴归零程序
CMP D360 D200       //当前角度
<= CALL P_Reset     //超过360度时清零

这套方案在激光切割机上跑了三个月，重复定位精度能稳定在±0.02mm。完整程序里还有急停连锁、手自动切换、扭矩监控这些实用功能模块，需要案例包的兄弟评论区留言。

（项目资料包含：GX Works2程序文件、GT Designer界面工程、CAD接线图、伺服参数清单）