LoadWithSMIFRoutine.cs 5.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183
  1. using Aitex.Core.RT.Device;
  2. using Aitex.Core.RT.Log;
  3. using Aitex.Core.RT.Routine;
  4. using Aitex.Core.RT.SCCore;
  5. using Aitex.Core.Util;
  6. using MECF.Framework.Common.Equipment;
  7. using MECF.Framework.RT.ModuleLibrary.VceModules;
  8. using System;
  9. using System.Collections.Generic;
  10. using System.Linq;
  11. using System.Text;
  12. using System.Threading.Tasks;
  13. using Venus_Core;
  14. using Venus_RT.Devices;
  15. using Venus_RT.Devices.SMIF;
  16. using Venus_RT.Modules.TM;
  17. using Venus_RT.Modules.TM.VenusEntity;
  18. using static Venus_RT.Modules.VCE.LoadRoutine;
  19. namespace Venus_RT.Modules.VCE
  20. {
  21. public class LoadWithSMIFRoutine : ModuleRoutineBase, IRoutine
  22. {
  23. private enum LoadWithSMIFStep
  24. {
  25. VceGotoLP,
  26. VceOuterDoorOpen,
  27. SMIFLoad,
  28. CloseOutDoor,
  29. Mapping,
  30. ReadMap,
  31. VcePumpDown,
  32. OpenInnerDoor,
  33. NotifyOver
  34. }
  35. private HongHuTM _tm;
  36. private VceModuleBase _vce;
  37. private ISMIF _smif;
  38. private int _VceMotionTimeout;
  39. private int _SMIFMotionTimeout;
  40. private SEMFPumpRoutine pumpRoutine;
  41. public LoadWithSMIFRoutine(ModuleName module, VceModuleBase vce, ISMIF smif) : base(module)
  42. {
  43. _vce = vce;
  44. _smif = smif;
  45. _tm = DEVICE.GetDevice<HongHuTM>("SETM");
  46. pumpRoutine = new SEMFPumpRoutine(_tm, module);
  47. }
  48. public RState Start(params object[] objs)
  49. {
  50. _VceMotionTimeout = SC.GetValue<int>($"{Module}.MotionTimeout") * 1000;
  51. _SMIFMotionTimeout = SC.GetValue<int>($"{Module}.SMIF.MotionTimeout") * 1000;
  52. //如果不是ATM 不允许执行
  53. if (!Singleton<RouteManager>.Instance.seTM.VCEIsATM)
  54. {
  55. LOG.Write(eEvent.ERR_VCE_COMMON_Failed, Module, $"VCE is not atm cannot load prepare! Please Vent it First!");
  56. return RState.Failed;
  57. }
  58. if (!Singleton<RouteManager>.Instance.seTM.IsVCESlitDoorClosed)
  59. {
  60. LOG.Write(eEvent.ERR_VCE_COMMON_Failed, Module, $"VCE Inner Door is open! Please close it First!");
  61. return RState.Failed;
  62. }
  63. Reset();
  64. return Runner.Start(Module,"Start Load with smif");
  65. }
  66. public RState Monitor()
  67. {
  68. Runner
  69. .Run(LoadWithSMIFStep.VceGotoLP, VceGotoLP, CheckVceStageDownDone, _VceMotionTimeout)
  70. .Run(LoadWithSMIFStep.VceOuterDoorOpen, VceOuterDoorOpen, CheckVceOuterDoorOpenDone, _VceMotionTimeout)
  71. .Run(LoadWithSMIFStep.SMIFLoad, SMIFLoad, CheckSMIFLoadDone, _SMIFMotionTimeout)
  72. .Run(LoadWithSMIFStep.CloseOutDoor, CloseOutDoor, CheckVceIdle, _VceMotionTimeout)
  73. .Run(LoadWithSMIFStep.Mapping, Mapping, CheckVceIdle, _VceMotionTimeout)
  74. .Run(LoadWithSMIFStep.ReadMap, ReadMap, CheckVceIdle, _VceMotionTimeout)
  75. .Run(LoadWithSMIFStep.VcePumpDown, PumpDown, CheckPumpOver, 2*60*1000)
  76. .Run(LoadWithSMIFStep.OpenInnerDoor, OpenInnerDoor, CheckInnerDoorOpen, _VceMotionTimeout)
  77. .End(LoadWithSMIFStep.NotifyOver, NullFun, 100);
  78. return Runner.Status;
  79. }
  80. private bool SMIFLoad()
  81. {
  82. //_smif.Load();
  83. return true;
  84. }
  85. private bool CheckSMIFLoadDone()
  86. {
  87. return true;
  88. }
  89. private bool VceGotoLP()
  90. {
  91. return _vce.GotoLP();
  92. }
  93. private bool VceOuterDoorOpen()
  94. {
  95. return _vce.OpenDoor();
  96. }
  97. private bool CheckVceStageDownDone()
  98. {
  99. if (_vce.Status == RState.Timeout || _vce.Status == RState.Failed)
  100. {
  101. LOG.Write(eEvent.ERR_VCE_COMMON_Failed, Module, $"VCE Stage Down failed");
  102. }
  103. return _vce.Status == RState.End;
  104. }
  105. private bool CheckVceOuterDoorOpenDone()
  106. {
  107. if (_vce.Status == RState.Timeout || _vce.Status == RState.Failed)
  108. {
  109. LOG.Write(eEvent.ERR_VCE_COMMON_Failed, Module, $"VCE OuterDoor Open failed");
  110. }
  111. return _vce.Status == RState.End;
  112. }
  113. private bool CheckInnerDoorOpen()
  114. {
  115. return !_tm.VCESlitDoorClosed;
  116. }
  117. private bool OpenInnerDoor()
  118. {
  119. return _tm.TurnSlitDoor(Module, true);
  120. }
  121. //
  122. private bool CheckPumpOver()
  123. {
  124. RState ret = pumpRoutine.Monitor();
  125. if (ret == RState.Failed || ret == RState.Timeout)
  126. {
  127. Singleton<RouteManager>.Instance.VCE.PostMsg(VceMSG.Error);
  128. }
  129. return ret == RState.End;
  130. }
  131. private bool CheckVceIdle()
  132. {
  133. if (_vce.Status == RState.Failed || _vce.Status == RState.Timeout)
  134. {
  135. Singleton<RouteManager>.Instance.GetVCE(Module).PostMsg(VceMSG.Error);
  136. return false;
  137. }
  138. return _vce.Status == RState.End;
  139. }
  140. private bool PumpDown()
  141. {
  142. return pumpRoutine.Start() == RState.Running;
  143. }
  144. private bool ReadMap()
  145. {
  146. return _vce.ReadMap();
  147. }
  148. private bool Mapping()
  149. {
  150. return _vce.Map();
  151. }
  152. private bool CloseOutDoor()
  153. {
  154. return _vce.CloseDoor();
  155. }
  156. public void Abort()
  157. {
  158. }
  159. }
  160. }