//急停控制

IF NOT E_Stop THEN

Equipment_EStop:=1;

ELSIF Reset AND Equipment_EStop THEN

Equipment_EStop:=0;

END_IF;

O_ResetSafety:= Reset;

//模式选择

Manual_Mode:= NOT Mode ;

Auto_Mode:= MODE;

//启动&停止

IF Run AND NOT Fault AND NOT i_Stop AND NOT Equipment_EStop  AND  Auto_Mode AND NOT LOCK_1 

AND NOT LOCK_2 AND NOT LOCK_3 THEN

Equipment_Run:=1;

ELSIF Fault OR i_Stop OR Equipment_EStop OR LDP(TRUE,Mode) OR ldp(TRUE,NOT Mode) 

OR LOCK_1 OR LOCK_2 OR LOCK_3 THEN

  Equipment_Run:=0;

END_IF;