Browse Source

revise vpw home routine

chenzk 3 days ago
parent
commit
18d5d1933c
1 changed files with 21 additions and 1 deletions
  1. 21 1
      PunkHPX8_RT/Modules/VpwMain/VPWHomeRoutine.cs

+ 21 - 1
PunkHPX8_RT/Modules/VpwMain/VPWHomeRoutine.cs

@@ -37,10 +37,10 @@ namespace PunkHPX8_RT.Modules.VpwMain
             CheckPumpEnable,
             FlowDelay,
             CheckFlow,
-            CheckTotalFlowOk,
             CheckCellFlow,
             StopRotation,
             CheckStopStatus,
+            CheckTotalFlowOk,
             LastHomeRotation,
             CheckLastHomeRotation,
             CheckFlowOk,
@@ -158,6 +158,7 @@ namespace PunkHPX8_RT.Modules.VpwMain
                 .Run(HomeStep.CheckCellFlow,CheckCellFlow,_delay_1ms)
                 .Run(HomeStep.StopRotation,StopRotationAxis,_delay_1ms)
                 .WaitWithStopCondition(HomeStep.CheckRotationStatus,CheckStopPostionEndStatus,CheckStopPostionStopStatus)
+                .RunIf(HomeStep.CheckTotalFlowOk, !_totalFlowOk, CheckTotalFlowFailedAction, _delay_1ms)
                 .Run(HomeStep.LastHomeRotation,HomeAllRotation,_delay_1ms)
                 .WaitWithStopCondition(HomeStep.CheckLastHomeRotation, CheckAllRotationHomeStatus, CheckAllRotationHomeStopStatus)
                 .Run(HomeStep.CheckFlowOk,CheckFlowOk,_delay_1ms)
@@ -170,6 +171,25 @@ namespace PunkHPX8_RT.Modules.VpwMain
             return Runner.Status;
         }
         /// <summary>
+        /// 关闭所有的泵和阀 并返回false
+        /// </summary>
+        /// <returns></returns>
+        private bool CheckTotalFlowFailedAction()
+        {
+           
+            _mainDevice.BoosterPumpDisable() ;
+            _mainDevice.DiwDisable() ;
+            _mainDevice.DiwProcessOff() ;
+            _mainDevice.DiwDegasValveOff();
+            foreach (var item in _cellLst)
+            {
+                 item.FlowDripOff();
+                 item.FlowSmallOff() ;
+                 item.FlowLargeOff();
+            }
+            return false;
+        }
+        /// <summary>
         /// 检验Chamber关闭
         /// </summary>
         /// <returns></returns>