LoadWithSMIFRoutine.cs 6.4 KB

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