三菱Fx3U三轴定位控制程序，其中两轴为脉冲输出同步运行360度转盘，3轴为工作台丝杆。 1.本程序结构清晰，有公共程序，原点回归，手动点动运行，手动微动运行。 报警程序，参数初始化程序等。 2.自动程序，有绝对位置控制，与相对位置控制程序 3.程序中使用到的计算程序全部使用St语言与FB.函数块，逻辑程序使用FBD梯形图（类似西门子程序）。 完美的梯形图与St需要赞美结合。 4.通过威纶通触摸屏的宏指令与三菱的ST语言写了一个动态码加密程序，密码每分钟变化一次。 使用时间到期或者触摸屏与PLC通信断开PLC立即停止运行，本程序中加密一般破解不了。
三菱FX3U的定位控制玩得溜，关键得看程序架构怎么搭。咱今天聊的这个三轴项目，把转盘和丝杠玩出了花——两轴脉冲同步转360度不带飘，第三轴丝杠精准到位，这底层程序有点东西。
先说程序骨架，典型的模块化设计。公共程序里藏着全局变量和系统状态字，原点回归直接用梯形图做了个状态机。看这段手动点动的梯形图逻辑：
[ X10 ]--[PLS D100 K1000]--(Y0) //X10触发时向Y0发送1000个脉冲 [ X11 ]--[DRVI K-5000 Y1] //X11长按驱动Y1反向运动脉冲指令和轴控制指令直接挂在输入信号上，结构干净得像强迫症写的。手动微动更狠，用ST语言封装了步进补偿算法：
FUNCTIONBLOCK JOGFineAdjust
VAR_INPUT
Axis : INT;
PulsePerClick : DINT;
END_VAR
IF RisingEdge(Trigger) THEN
ActualPos[Axis] := ActualPos[Axis] + PulsePerClick;
PLS(PulsePerClick, Axis);
END_IF;
这函数块把微动量抽象成参数，调用时直接填轴编号就行，比传统梯形图省了80%的重复逻辑。
三菱Fx3U三轴定位控制程序，其中两轴为脉冲输出同步运行360度转盘，3轴为工作台丝杆。 1.本程序结构清晰，有公共程序，原点回归，手动点动运行，手动微动运行。 报警程序，参数初始化程序等。 2.自动程序，有绝对位置控制，与相对位置控制程序 3.程序中使用到的计算程序全部使用St语言与FB.函数块，逻辑程序使用FBD梯形图（类似西门子程序）。 完美的梯形图与St需要赞美结合。 4.通过威纶通触摸屏的宏指令与三菱的ST语言写了一个动态码加密程序，密码每分钟变化一次。 使用时间到期或者触摸屏与PLC通信断开PLC立即停止运行，本程序中加密一般破解不了。
自动程序才是重头戏。绝对定位用FB封装了S型加减速算法，ST写的运动控制函数块里藏着这段硬核计算：
CurveSpeed := BaseSpeedSIN(3.1416CurrentStep/TotalSteps);
CurrentPos := CurrentPos + CurveSpeed * TimeDelta;
动态调整速度曲线，转盘运行稳如老狗。相对定位模式更骚，通过触摸屏输入偏移量自动计算目标位置，算法里带机械背隙补偿，实测重复定位精度±0.02mm。
加密程序堪称一绝。威纶通宏指令搞动态密码，ST这边同步生成验证码：
TIMETOSTRING(T#Now, StrTime);
MD5(StrTime + 'SaltKey', DynamicCode);
每分钟变一次密码，暴力破解？不存在的！通信中断检测机制更狠：
IF NOT COM_Heartbeat THEN
EMERGENCY_STOP(TRUE);
END_IF;
心跳包超过3秒没收到直接急停，想拔网线偷程序？门儿都没有！
这套程序最牛的是梯形图和ST的完美联姻。逻辑控制用梯形图直观看流程，算法处理扔给ST搞精确计算。FB函数块把复杂逻辑打包成乐高积木，特别是那个带运动学模型的定位函数块，调用时参数往里一填，三轴联动自动解算脉冲量——这设计，老工程师看了直呼内行！
