do cup on arm

This commit is contained in:
wanlop run 2025-06-05 21:43:07 +07:00
parent e83400044a
commit 871145f2b9
14 changed files with 170 additions and 74 deletions

View file

@ -75,7 +75,7 @@ If Seeker = "curr" Then
If show_eng = "true" Then
Else
If Timeout = 14 Then
If TimeoutCupOnArm = 14 Then
If buttonRemoveCupOnArm = "Enable" Then
If CupChecking = "false" Then
If DoorCupPosition = "bottom" Then
@ -99,7 +99,7 @@ If Seeker = "curr" Then
EndIf
EndIf
Var Timeout = Timeout + 1
Var TimeoutCupOnArm = TimeoutCupOnArm + 1
@ -120,6 +120,9 @@ If Seeker = "curr" Then
EndIf
If CoundUpDelayCertainStage = "" Then
Var CoundUpDelayCertainStage = 0
EndIf
If DoorCupPosition = "bottom" Then
If CupOnArm = "true" Then
@ -135,33 +138,46 @@ If Seeker = "curr" Then
EndIf
Else
Var CoundUpDelayCertainStage = 0
EndIf
; zone cup on arm
If buttonRemoveCupOnArm = "Enable" Then
Else
If CupOnArm = "true" Then
If CheckCupStateDoorCupClose = "" Then
Var buttonRemoveCupOnArm = "Enable"
EndIf
If CheckCupStateDoorCupClose = "done" Then
Var buttonRemoveCupOnArm = "Enable"
EndIf
Else
If DoorCupPosition = "top" Then
Var buttonRemoveCupOnArm = "Invisible"
EndIf
Else
If DoorCupPosition = "top" Then
Var buttonRemoveCupOnArm = "Invisible"
Else
If CupOnArm = "true" Then
If CheckCupStateDoorCupClose = "" Then
Var buttonRemoveCupOnArm = "Enable"
EndIf
If CheckCupStateDoorCupClose = "done" Then
Var buttonRemoveCupOnArm = "Enable"
EndIf
Else
EndIf
EndIf
EndIf
Else
DEBUGVAR CH9991_Status
DEBUGVAR CH9992_Status
DEBUGVAR CH9993_Status
DEBUGVAR CH9994_Status
; Next hide away
Var buttonRemoveCupOnArm = "Invisible"