Do drin fail3 and emergency stop

inc/remove_cup_step.inc

@@ -4,6 +4,11 @@ DEBUGVAR TimeoutForProtectButtonHideLongTime
 DEBUGVAR TiemoutForDoorCupOpenLongTime
 
 
+If TimeoutInstance0 = 3 Then
+    SAVELOG "remove cup step version 1.1"
+EndIf
+
+
 If buttonRemoveCup = "Enable" Then
 
 Else
@@ -28,10 +33,25 @@ If TiemoutForDoorCupOpenLongTime > 60 Then
         Var TiemoutForDoorCupOpenLongTime = 0
     Else
         Machine DoorClose
+        Var DoorCloseFromTimeout = "set"
     EndIf
 EndIf
 
 
+
+If PreviseDoorCupPosition = DoorCupPosition Then
+
+Else
+    DEBUGVAR PreviseDoorCupPosition
+    DEBUGVAR DoorCupPosition
+    
+    If DoorCupPosition = "bottom" Then
+         Machine CheckCupCurrentProcess
+    EndIf
+    
+    Var PreviseDoorCupPosition = DoorCupPosition
+EndIf
+
 If show_eng = "true" Then 
 
 Else
@@ -72,6 +92,7 @@ Var Timeout = Timeout + 1
 
 Var TimeoutInstance0 = TimeoutInstance0 + 1
 
+
 If TimeoutInstance0 > 360 Then
     Var TimeoutInstance0 = 0
     SAVELOG "Check Cup all"