60 REGION Edge detection and overload monitoring
61 #instStartEdge(CLK := #bStart);
62 #instResetEdge(CLK := #bReset);
63
64
65 #instOverloadTimer(IN := (#rMotorCurrent > #rCurrentLimit) AND #bMotorRun,
66 PT := #tOverloadDelay);
67
68 #tempOverloadTrip := #instOverloadTimer.Q OR NOT #bMotorOverloadOk;
69 #tempSafetyOk := #bEmergencyStopOk AND NOT #tempOverloadTrip;
70 END_REGION
71
72 REGION State machine
73 CASE #statState OF
74 #STATE_IDLE:
75 IF NOT #tempSafetyOk THEN
76 #statState := #STATE_FAULT;
77 ELSIF #instStartEdge.Q AND #bStop THEN
78 #statState := #STATE_RUN;
79 END_IF;
80
81 #STATE_RUN:
82 IF NOT #tempSafetyOk THEN
83 #statState := #STATE_FAULT;
84 ELSIF NOT #bStop THEN
85 #statState := #STATE_IDLE;
86 END_IF;
87
88 #STATE_FAULT:
89
90 IF #tempSafetyOk AND #instResetEdge.Q AND NOT #bStart THEN
91 #statState := #STATE_IDLE;
92 END_IF;
93
94 ELSE
95 #statState := #STATE_FAULT;
96 END_CASE;
97 END_REGION
98
99 REGION Latch fault causes
100 IF NOT #bEmergencyStopOk THEN
101 #bEmergencyStopFault := TRUE;
102 ELSIF #instResetEdge.Q THEN
103 #bEmergencyStopFault := FALSE;