我需要将FX5U的K7轴上电时能回零,目前只有一个零点感应,为了保证每次回到标准零点,需要空转一圈找到零起点,继续转找到零终点,然后利用DSZR回零,程序如下:
问题是第4步回零时报错,说轴被占用了。 但是我已经将M106置为FALSE, 监视PLC也表明了这一点,为啥还会出现轴被占用? 谢谢大家
PLSV(M106, D16, K7, Y64);
DSZR(M100,1000,100,K7,M60);
DRVI(M101,D104,D100,K7,M62);
IF NOT M40 THEN
Y64:=TRUE;
Y65:=TRUE;
CASE D110 OF
0:
D110:=D110+1; //初始化
M106:=TRUE;
1:
D16:=D100; //找到零起点
IF X65 THEN
D16:=0;
END_IF;
IF X65 THEN
D110:=D110+1;
END_IF;
2:
IF X65 THEN //找到零终点
D16:=D100;
ELSE
D16:=0;
END_IF;
IF NOT X65 THEN
D110:=D110+1;
END_IF;
3:
M106:=FALSE; //准备DSZR回零点
M51:=TRUE;
M55:=TRUE;
D110:=4;
4:
M16:=TRUE; //回零
IF X65 AND X62 THEN
D110:=D110+1;
M40:=TRUE;
END_IF;
ELSE
M40:=TRUE;
END_CASE;
END_IF;
(*Manual Control*)
(*进入手动控制页面,M51手动控制标志*)
IF M51 THEN
(* IF M0 AND Y4=FALSE AND X0=FALSE THEN
END_IF;*)
IF M55 THEN //分步动作
M106:=FALSE;
M107:=FALSE;
M108:=FALSE;
ELSE
M106:=TRUE; //全手动动作
M107:=TRUE;
M108:=TRUE;
END_IF;
IF M6 OR M16 OR M26 THEN
IF M6 THEN
IF Y64 THEN
D16:=D0;
ELSE
D16:=-D0;
END_IF;
END_IF;
IF M16 THEN //回零点
set (NOT X65,M100);
IF M60 OR X65 THEN
M100:=FALSE;
M60:=FALSE;
M16:=FALSE;
M120:=FALSE;
END_IF;
END_IF;
IF M26 THEN
set(NOT M100 AND NOT M120,M101);
IF M62 OR M120 THEN
M120:=TRUE;
M101:=FALSE;
M62:=FALSE;
M26:=FALSE;
END_IF;
END_IF;
ELSE
D16:=0;
M102:=FALSE;
M103:=FALSE;
END_IF;
END_IF;