LoadWithSMIFRoutine.cs 6.4 KB

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