LoadWithSMIFRoutine.cs 6.5 KB

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