
三菱PLC FX5u结构化4轴伺服机器人程序及相关资料汇编
这个月刚做完一套FX5u控制的四轴伺服+工业机器人集成项目,现场调试终于跑通了。分享点干货,
真实项目里的结构化编程套路和那些手册里不会写的实战技巧。
先看整体架构:FX5u-32MT做主站,四个MR-JE-C伺服带1kg级水平关节机械手,HMI用维纶通MT8071i
E。重点在于多轴同步和机器人路径规划的逻辑配合。
轴参数结构化封装是个好东西,把每个轴的配置打包成FB块。比如这个回原点的处理:
```st
FUNCTION_BLOCK AxisHome_FB
VAR_INPUT
bExecute: BOOL;
END_VAR
VAR_OUTPUT
bDone: BOOL;
bBusy: BOOL;
END_VAR
VAR
stAxis: ST_AxisControl;
iStep: INT := 0;
END_VAR
CASE iStep OF
0:
IF bExecute THEN
MC_Home(stAxis); //调用运动控制指令
iStep := 10;
END_IF
10:
IF stAxis.dStatus THEN
bDone := TRUE;
iStep := 0;