HongHuDETM.cs 30 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706
  1. using Aitex.Core.Common.DeviceData;
  2. using Aitex.Core.RT.DataCenter;
  3. using Aitex.Core.RT.Device;
  4. using Aitex.Core.RT.Device.Unit;
  5. using Aitex.Core.RT.Log;
  6. using Aitex.Core.RT.OperationCenter;
  7. using Aitex.Core.RT.SCCore;
  8. using Aitex.Core.Util;
  9. using MECF.Framework.Common.Device.Bases;
  10. using MECF.Framework.Common.Equipment;
  11. using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.TMs;
  12. using System;
  13. using IoMfc = Venus_RT.Devices.IODevices.IoMfc;
  14. using IoPressureMeter = Venus_RT.Devices.IODevices.IoPressureMeter;
  15. using Venus_Core;
  16. using Venus_RT.Modules;
  17. namespace Venus_RT.Devices.TM
  18. {
  19. public class HongHuDETM : TMBase
  20. {
  21. /// <summary>
  22. /// 针对VenusDE六边形设计
  23. /// </summary>
  24. #region io 信号抽象
  25. //控制阀信号
  26. private readonly IoValve _TMFastPumpValve;
  27. private readonly IoValve _TMSoftPumpValve;
  28. private readonly IoValve _VCEASoftPumpValve;
  29. private readonly IoValve _VCEAFastPumpValve;
  30. private readonly IoValve _VCEBSoftPumpValve;
  31. private readonly IoValve _VCEBFastPumpValve;
  32. private readonly IoValve _TMFastVentValve;
  33. private readonly IoValve _TMSoftVentValve;
  34. private readonly IoValve _VCEASoftVentValve;
  35. private readonly IoValve _VCEAFastVentValve;
  36. private readonly IoValve _VCEBSoftVentValve;
  37. private readonly IoValve _VCEBFastVentValve;
  38. //判断信号
  39. private readonly IoSensor _VCEASlitDoorOpenEnable;
  40. private readonly IoSensor _VCEBSlitDoorOpenEnable;
  41. private readonly IoSensor _PMASlitDoorOpenEnable;
  42. private readonly IoSensor _PMBSlitDoorOpenEnable;
  43. private readonly IoSensor _PMCSlitDoorOpenEnable;
  44. private readonly IoSensor _PMDSlitDoorOpenEnable;
  45. private readonly IoSensor _VCEASlitDoorCloseEnable;
  46. private readonly IoSensor _VCEBSlitDoorCloseEnable;
  47. private readonly IoSensor _PMASlitDoorCloseEnable;
  48. private readonly IoSensor _PMBSlitDoorCloseEnable;
  49. private readonly IoSensor _PMCSlitDoorCloseEnable;
  50. private readonly IoSensor _PMDSlitDoorCloseEnable;
  51. private readonly IoSensor _TMExtendVCEAEnable;
  52. private readonly IoSensor _TMExtendVCEBEnable;
  53. private readonly IoSensor _TMExtendPMAEnable;
  54. private readonly IoSensor _TMExtendPMBEnable;
  55. private readonly IoSensor _TMExtendPMCEnable;
  56. private readonly IoSensor _TMExtendPMDEnable;
  57. private readonly IoSensor _VCEAATMSensor;
  58. private readonly IoSensor _VCEBATMSensor;
  59. private readonly IoSensor _TMATMSensor;
  60. //控制门信号
  61. private readonly IoCylinder _VCEASlitDoor;
  62. private readonly IoCylinder _VCEBSlitDoor;
  63. private readonly IoCylinder _PMASlitDoor;
  64. private readonly IoCylinder _PMBSlitDoor;
  65. private readonly IoCylinder _PMCSlitDoor;
  66. private readonly IoCylinder _PMDSlitDoor;
  67. private readonly IoMfc _TMMfc;
  68. private readonly IoPressureMeter _TMPressure;
  69. //private readonly IoPressureMeter _TMPiplinePressure;
  70. private readonly IoPressureMeter _VCEAPressure;
  71. private readonly IoPressureMeter _VCEBPressure;
  72. //private readonly IoPressureMeter _VCEPiplinePressure;
  73. private readonly PumpBase _TMPump;
  74. private readonly PumpBase _VCEPump;
  75. //控压
  76. //安装的module
  77. private string _allInstalledModules { get { return SC.GetStringValue("System.InstalledModules").ToString(); } }
  78. private double TMATMTargetPressure;
  79. private double TMVACTargetPressure;
  80. private double VCEATMTargetPressure;
  81. private double VCEVACTargetPressure;
  82. #endregion
  83. #region 暴露变量
  84. //ATM VAC信号
  85. public override bool IsTMATM => _TMATMSensor.Value && _TMPressure.Value >= TMATMTargetPressure;
  86. public override bool IsVCEAATM => _VCEAATMSensor.Value && _VCEAPressure.Value >= VCEATMTargetPressure;
  87. public override bool IsVCEBATM => _VCEBATMSensor.Value && _VCEBPressure.Value >= VCEATMTargetPressure;
  88. public override bool IsTMVAC => _TMPressure.Value <= TMVACTargetPressure;
  89. public override bool IsVCEAVAC => _VCEAPressure.Value <= VCEVACTargetPressure;
  90. public override bool IsVCEBVAC => _VCEBPressure.Value <= VCEVACTargetPressure;
  91. public bool? IsTMPumpRunning => _TMPump?.IsRunning;
  92. //valve开关状态
  93. public override bool IsTMFastPumpOpen => _TMFastPumpValve.Status;
  94. public override bool IsTMSoftPumpOpen => _TMSoftPumpValve.Status;
  95. public override bool IsTMFastVentOpen => _TMFastVentValve.Status;
  96. public override bool IsTMSoftVentOpen => _TMSoftVentValve.Status;
  97. public override bool IsVCEAFastPumpOpen => _VCEAFastPumpValve.Status;
  98. public override bool IsVCEBFastPumpOpen => _VCEBFastPumpValve.Status;
  99. public override bool IsVCEASoftPumpOpen => _VCEASoftPumpValve.Status;
  100. public override bool IsVCEBSoftPumpOpen => _VCEBSoftPumpValve.Status;
  101. public override bool IsVCEAFastVentOpen => _VCEAFastVentValve.Status;
  102. public override bool IsVCEBFastVentOpen => _VCEBFastVentValve.Status;
  103. public override bool IsVCEASoftVentOpen => _VCEASoftVentValve.Status;
  104. public override bool IsVCEBSoftVentOpen => _VCEBSoftVentValve.Status;
  105. public override bool IsTMVentValveOpen => IsTMFastVentOpen && IsTMSoftVentOpen;
  106. public override bool IsVCEAVentValveOpen => IsVCEAFastVentOpen && IsVCEASoftVentOpen;
  107. public override bool IsVCEBVentValveOpen => IsVCEBFastVentOpen && IsVCEBSoftVentOpen;
  108. //SlitDoor
  109. public override bool VCEASlitDoorClosed => _VCEASlitDoor.State == CylinderState.Close;
  110. public override bool VCEBSlitDoorClosed => _VCEBSlitDoor.State == CylinderState.Close;
  111. public override bool PMASlitDoorClosed
  112. {
  113. get
  114. {
  115. if (_allInstalledModules.Contains("PMA"))
  116. return _PMASlitDoor.State == CylinderState.Close;
  117. else
  118. return false;
  119. }
  120. }
  121. public override bool PMBSlitDoorClosed
  122. {
  123. get
  124. {
  125. if (_allInstalledModules.Contains("PMB"))
  126. return _PMBSlitDoor.State == CylinderState.Close;
  127. else
  128. return false;
  129. }
  130. }
  131. public override bool PMCSlitDoorClosed
  132. {
  133. get
  134. {
  135. if (_allInstalledModules.Contains("PMC"))
  136. return _PMCSlitDoor.State == CylinderState.Close;
  137. else
  138. return false;
  139. }
  140. }
  141. public override bool PMDSlitDoorClosed
  142. {
  143. get
  144. {
  145. if (_allInstalledModules.Contains("PMD"))
  146. return _PMDSlitDoor.State == CylinderState.Close;
  147. else
  148. return false;
  149. }
  150. }
  151. public bool VCEASlitDoorOpen => _VCEASlitDoor.State == CylinderState.Open;
  152. public bool VCEBSlitDoorOpen => _VCEBSlitDoor.State == CylinderState.Open;
  153. public bool PMASlitDoorOpen
  154. {
  155. get
  156. {
  157. if (_allInstalledModules.Contains("PMA"))
  158. return _PMASlitDoor.State == CylinderState.Open;
  159. else
  160. return false;
  161. }
  162. }
  163. public bool PMBSlitDoorOpen
  164. {
  165. get
  166. {
  167. if (_allInstalledModules.Contains("PMB"))
  168. return _PMBSlitDoor.State == CylinderState.Open;
  169. else
  170. return false;
  171. }
  172. }
  173. public bool PMCSlitDoorOpen
  174. {
  175. get
  176. {
  177. if (_allInstalledModules.Contains("PMC"))
  178. return _PMCSlitDoor.State == CylinderState.Open;
  179. else
  180. return false;
  181. }
  182. }
  183. public bool PMDSlitDoorOpen
  184. {
  185. get
  186. {
  187. if (_allInstalledModules.Contains("PMD"))
  188. return _PMDSlitDoor.State == CylinderState.Open;
  189. else
  190. return false;
  191. }
  192. }
  193. public override bool AllPMSlitDoorClosed
  194. {
  195. get
  196. {
  197. bool PMAFlag = true;
  198. bool PMBFlag = true;
  199. bool PMCFlag = true;
  200. bool PMDFlag = true;
  201. if (_allInstalledModules.Contains("PMA"))
  202. PMAFlag = PMASlitDoorClosed;
  203. if (_allInstalledModules.Contains("PMB"))
  204. PMBFlag = PMBSlitDoorClosed;
  205. if (_allInstalledModules.Contains("PMC"))
  206. PMCFlag = PMCSlitDoorClosed;
  207. if (_allInstalledModules.Contains("PMD"))
  208. PMDFlag = PMDSlitDoorClosed;
  209. if (PMAFlag && PMBFlag && PMCFlag&&PMDFlag)
  210. return true;
  211. else
  212. return false;
  213. }
  214. }
  215. public bool VCEASlitDoorOpenEnable => _VCEASlitDoorOpenEnable.Value;
  216. public bool VCEBSlitDoorOpenEnable => _VCEBSlitDoorOpenEnable.Value;
  217. public bool PMASlitDoorOpenEnable => _PMASlitDoorOpenEnable.Value;
  218. public bool PMBSlitDoorOpenEnable => _PMBSlitDoorOpenEnable.Value;
  219. public bool PMCSlitDoorOpenEnable => _PMCSlitDoorOpenEnable.Value;
  220. public bool PMDSlitDoorOpenEnable => _PMDSlitDoorOpenEnable.Value;
  221. public bool VCEASlitDoorCloseEnable => _VCEASlitDoorCloseEnable.Value;
  222. public bool VCEBSlitDoorCloseEnable => _VCEBSlitDoorCloseEnable.Value;
  223. public bool PMASlitDoorCloseEnable => _PMASlitDoorCloseEnable.Value;
  224. public bool PMBSlitDoorCloseEnable => _PMBSlitDoorCloseEnable.Value;
  225. public bool PMCSlitDoorCloseEnable => _PMCSlitDoorCloseEnable.Value;
  226. public bool PMDSlitDoorCloseEnable => _PMDSlitDoorCloseEnable.Value;
  227. //Robot动作
  228. //public bool TMExtendVCEEnable => _TMExtendVCEEnable.Value;
  229. public bool TMExtendPMAEnable => _TMExtendPMAEnable.Value;
  230. public bool TMExtendPMBEnable => _TMExtendPMBEnable.Value;
  231. public bool TMExtendPMCEnable => _TMExtendPMCEnable.Value;
  232. public bool TMExtendPMDEnable => _TMExtendPMDEnable.Value;
  233. public override double TMPressure => _TMPressure.Value;
  234. public override double VCEAPressure => _VCEAPressure.Value;
  235. public override double VCEBPressure => _VCEBPressure.Value;
  236. public override PumpState PumpingState => _PumpingState;
  237. PumpState _PumpingState = PumpState.Idle;
  238. #endregion
  239. public HongHuDETM() : base(ModuleName.DETM.ToString())
  240. {
  241. TMATMTargetPressure = SC.GetValue<double>($"DETM.ATMTargetPressure");
  242. TMVACTargetPressure = SC.GetValue<double>($"DETM.VACTargetPressure");
  243. VCEATMTargetPressure = SC.GetValue<double>($"VCE1.ATMTargetPressure");
  244. VCEVACTargetPressure = SC.GetValue<double>($"VCE1.VACTargetPressure");
  245. Module = ModuleName.DETM.ToString();
  246. _TMFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMFastPumpValve}");
  247. _TMSoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMSoftPumpValve}");
  248. _VCEASoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEASoftPumpValve}");
  249. _VCEBSoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBSoftPumpValve}");
  250. _VCEAFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEAFastPumpValve}");
  251. _VCEBFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBFastPumpValve}");
  252. _TMFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMFastVentValve}");
  253. _TMSoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMSoftVentValve}");
  254. _VCEASoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEASoftVentValve}");
  255. _VCEBSoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBSoftVentValve}");
  256. _VCEAFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEAFastVentValve}");
  257. _VCEBFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBFastVentValve}");
  258. _VCEASlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEASlitDoorOpenEnable}");
  259. _VCEBSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEBSlitDoorOpenEnable}");
  260. _PMASlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMASlitDoorOpenEnable}");
  261. _PMBSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMBSlitDoorOpenEnable}");
  262. _PMCSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorOpenEnable}");
  263. _PMDSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMDSlitDoorOpenEnable}");
  264. _VCEASlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEASlitDoorCloseEnable}");
  265. _VCEBSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEBSlitDoorCloseEnable}");
  266. _PMASlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMASlitDoorCloseEnable}");
  267. _PMBSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMBSlitDoorCloseEnable}");
  268. _TMATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.TMATMSensor}");
  269. _VCEAATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEAATMSensor}");
  270. _VCEBATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEBATMSensor}");
  271. _VCEASlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.VCEASlitDoor}");
  272. _VCEBSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.VCEBSlitDoor}");
  273. _PMASlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMASlitDoor}");
  274. _PMBSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMBSlitDoor}");
  275. if (_allInstalledModules.Contains("PMC"))
  276. {
  277. _PMCSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorOpenEnable}");
  278. _PMCSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMCSlitDoor}");
  279. _PMCSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorCloseEnable}");
  280. }
  281. if (_allInstalledModules.Contains("PMD"))
  282. {
  283. _PMDSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMDSlitDoorOpenEnable}");
  284. _PMDSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMDSlitDoor}");
  285. _PMDSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMDSlitDoorCloseEnable}");
  286. }
  287. _TMMfc = DEVICE.GetDevice<IoMfc>($"{Module}.TM_MFC1");
  288. _TMPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.TMPressure");
  289. //_TMPiplinePressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.TMPipelinePressure");
  290. _VCEAPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.VCEAPressure");
  291. _VCEBPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.VCEBPressure");
  292. if (SC.GetValue<int>($"{Module}.DryPump.CommunicationType") == (int)CommunicationType.RS232)
  293. {
  294. if (SC.GetValue<int>($"{Module}.DryPump.MFG") == (int)DryPumpMFG.SKY)
  295. {
  296. _TMPump = DEVICE.GetDevice<SkyPump>($"{Module}.{VenusDevice.MainPump}");
  297. }
  298. else if (SC.GetValue<int>($"{Module}.DryPump.MFG") == (int)DryPumpMFG.Edwards)
  299. {
  300. _TMPump = DEVICE.GetDevice<EdwardsPump>($"{Module}.{VenusDevice.MainPump}");
  301. }
  302. }
  303. if (SC.GetValue<int>($"{Module}.VCE.DryPump.CommunicationType") == (int)CommunicationType.RS232)
  304. {
  305. if (SC.GetValue<int>($"{Module}.VCE.DryPump.MFG") == (int)DryPumpMFG.SKY)
  306. {
  307. _VCEPump = DEVICE.GetDevice<SkyPump>($"VCEA.{VenusDevice.MainPump}");
  308. }
  309. else if (SC.GetValue<int>($"{Module}.VCE.DryPump.MFG") == (int)DryPumpMFG.Edwards)
  310. {
  311. _VCEPump = DEVICE.GetDevice<EdwardsPump>($"VCEA.{VenusDevice.MainPump}");
  312. }
  313. }
  314. DATA.Subscribe($"{Module}.VCEASlitDoorClosed", () => VCEASlitDoorClosed);
  315. DATA.Subscribe($"{Module}.VCEBSlitDoorClosed", () => VCEBSlitDoorClosed);
  316. DATA.Subscribe($"{Module}.PMASlitDoorClosed", () => PMASlitDoorClosed);
  317. DATA.Subscribe($"{Module}.PMBSlitDoorClosed", () => PMBSlitDoorClosed);
  318. DATA.Subscribe($"{Module}.PMCSlitDoorClosed", () => PMCSlitDoorClosed);
  319. DATA.Subscribe($"{Module}.PMDSlitDoorClosed", () => PMDSlitDoorClosed);
  320. DATA.Subscribe($"{Module}.PumpIsRunning", () => IsTMPumpRunning, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  321. DATA.Subscribe($"{Module}.TMIsATM", () => IsTMATM);
  322. DATA.Subscribe($"{Module}.VCEAIsATM", () => IsVCEAATM);
  323. DATA.Subscribe($"{Module}.VCEBIsATM", () => IsVCEBATM);
  324. OP.Subscribe($"{Module}.ControlPump", (cmd, args) =>
  325. {
  326. _TMPump.SetPumpOnOff((bool)args[0]);
  327. return true;
  328. });
  329. OP.Subscribe($"{Module}.SetSlitDoor", (cmd, args) =>
  330. {
  331. var module = (ModuleName)Enum.Parse(typeof(ModuleName), args[0].ToString());
  332. return TurnSlitDoor(module, (bool)args[1]);
  333. });
  334. }
  335. #region IO控制方法
  336. //slitdoor
  337. //2023/11/1 增加两边压差比较
  338. public override bool TurnSlitDoor(ModuleName mod, bool bOn)
  339. {
  340. double MaxPressureDifference = SC.GetValue<double>("System.PMTMMaxPressureDifference");
  341. switch (mod)
  342. {
  343. case ModuleName.VCEA:
  344. if (bOn && IsVCEAATM && IsTMATM)
  345. {
  346. LOG.Write(eEvent.INFO_TM, ModuleName.DETM, $"open door without Pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEAPressure.Value}");
  347. return _VCEASlitDoor.SetCylinder(bOn, out _);
  348. }
  349. if (bOn && Math.Abs(_TMPressure.Value - _VCEAPressure.Value) > MaxPressureDifference)
  350. {
  351. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEAPressure.Value}");
  352. return false;
  353. }
  354. return _VCEASlitDoor.SetCylinder(bOn, out _);
  355. case ModuleName.VCEB:
  356. if (bOn && IsVCEBATM && IsTMATM)
  357. {
  358. LOG.Write(eEvent.INFO_TM, ModuleName.DETM, $"open door without Pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEBPressure.Value}");
  359. return _VCEBSlitDoor.SetCylinder(bOn, out _);
  360. }
  361. if (bOn && Math.Abs(_TMPressure.Value - _VCEBPressure.Value) > MaxPressureDifference)
  362. {
  363. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEBPressure.Value}");
  364. return false;
  365. }
  366. return _VCEBSlitDoor.SetCylinder(bOn, out _);
  367. case ModuleName.PMA:
  368. if (bOn && Singleton<RouteManager>.Instance.PMA.IsAtm && IsTMATM)
  369. return _PMASlitDoor.SetCylinder(bOn, out _);
  370. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  371. return false;
  372. return _PMASlitDoor.SetCylinder(bOn, out _);
  373. case ModuleName.PMB:
  374. if (bOn && Singleton<RouteManager>.Instance.PMB.IsAtm && IsTMATM)
  375. return _PMBSlitDoor.SetCylinder(bOn, out _);
  376. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  377. return false;
  378. return _PMBSlitDoor.SetCylinder(bOn, out _);
  379. case ModuleName.PMC:
  380. if (bOn && Singleton<RouteManager>.Instance.PMC.IsAtm && IsTMATM)
  381. return _PMCSlitDoor.SetCylinder(bOn, out _);
  382. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  383. return false;
  384. return _PMCSlitDoor.SetCylinder(bOn, out _);
  385. case ModuleName.PMD:
  386. if (bOn && Singleton<RouteManager>.Instance.PMD.IsAtm && IsTMATM)
  387. return _PMDSlitDoor.SetCylinder(bOn, out _);
  388. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  389. return false;
  390. return _PMDSlitDoor.SetCylinder(bOn, out _);
  391. }
  392. return false;
  393. }
  394. //valve
  395. public override void TurnFastPumpValve(ModuleName mod, bool bOn)
  396. {
  397. switch (mod)
  398. {
  399. case ModuleName.DETM:
  400. _TMFastPumpValve.TurnValve(bOn, out string _);
  401. break;
  402. case ModuleName.VCEA:
  403. _VCEAFastPumpValve.TurnValve(bOn, out string _);
  404. break;
  405. case ModuleName.VCEB:
  406. _VCEBFastPumpValve.TurnValve(bOn, out string _);
  407. break;
  408. }
  409. }
  410. public override void TurnSoftPumpValve(ModuleName mod, bool bOn)
  411. {
  412. switch (mod)
  413. {
  414. case ModuleName.DETM:
  415. _TMSoftPumpValve.TurnValve(bOn, out string _);
  416. break;
  417. case ModuleName.VCEA:
  418. _VCEASoftPumpValve.TurnValve(bOn, out string _);
  419. break;
  420. case ModuleName.VCEB:
  421. _VCEBSoftPumpValve.TurnValve(bOn, out string _);
  422. break;
  423. }
  424. }
  425. public override void TurnFastVentValve(ModuleName mod, bool bOn)
  426. {
  427. switch (mod)
  428. {
  429. case ModuleName.DETM:
  430. _TMFastVentValve.TurnValve(bOn, out string _);
  431. break;
  432. case ModuleName.VCEA:
  433. _VCEAFastVentValve.TurnValve(bOn, out string _);
  434. break;
  435. case ModuleName.VCEB:
  436. _VCEBFastVentValve.TurnValve(bOn, out string _);
  437. break;
  438. }
  439. }
  440. public override void TurnSoftVentValve(ModuleName mod, bool bOn)
  441. {
  442. switch (mod)
  443. {
  444. case ModuleName.DETM:
  445. _TMSoftVentValve.TurnValve(bOn, out string _);
  446. break;
  447. case ModuleName.VCEA:
  448. _VCEASoftVentValve.TurnValve(bOn, out string _);
  449. break;
  450. case ModuleName.VCEB:
  451. _VCEBSoftVentValve.TurnValve(bOn, out string _);
  452. break;
  453. }
  454. }
  455. public override bool CloseAllSlitDoor()
  456. {
  457. TurnSlitDoor(ModuleName.VCEA, false);
  458. TurnSlitDoor(ModuleName.VCEB, false);
  459. if (_allInstalledModules.Contains("PMA"))
  460. TurnSlitDoor(ModuleName.PMA, false);
  461. if (_allInstalledModules.Contains("PMB"))
  462. TurnSlitDoor(ModuleName.PMB, false);
  463. if (_allInstalledModules.Contains("PMC"))
  464. TurnSlitDoor(ModuleName.PMC, false);
  465. if (_allInstalledModules.Contains("PMD"))
  466. TurnSlitDoor(ModuleName.PMD, false);
  467. return true;
  468. }
  469. public override void HomeVceSlitDoor()
  470. {
  471. //由SlitDoor的状态对其下发同样的指令
  472. if (VCEASlitDoorClosed == true)
  473. TurnSlitDoor(ModuleName.VCEA, false);
  474. else
  475. TurnSlitDoor(ModuleName.VCEA, true);
  476. if (VCEBSlitDoorClosed == true)
  477. TurnSlitDoor(ModuleName.VCEB, false);
  478. else
  479. TurnSlitDoor(ModuleName.VCEB, true);
  480. }
  481. public override void CloseVentValve()
  482. {
  483. _TMSoftVentValve.TurnValve(false, out _);
  484. _TMFastVentValve.TurnValve(false, out _);
  485. _VCEASoftVentValve.TurnValve(false, out _);
  486. _VCEBSoftVentValve.TurnValve(false, out _);
  487. _VCEAFastVentValve.TurnValve(false, out _);
  488. _VCEBFastVentValve.TurnValve(false, out _);
  489. }
  490. public override bool CheckSlitValveOpen(ModuleName mod)
  491. {
  492. switch (mod)
  493. {
  494. case ModuleName.VCEA:
  495. return VCEASlitDoorOpen;
  496. case ModuleName.VCEB:
  497. return VCEBSlitDoorOpen;
  498. case ModuleName.PMA:
  499. return PMASlitDoorOpen;
  500. case ModuleName.PMB:
  501. return PMBSlitDoorOpen;
  502. case ModuleName.PMC:
  503. return PMCSlitDoorOpen;
  504. case ModuleName.PMD:
  505. return PMDSlitDoorOpen;
  506. }
  507. return false;
  508. }
  509. public override bool CheckSlitValveClose(ModuleName mod)
  510. {
  511. switch (mod)
  512. {
  513. case ModuleName.VCEA:
  514. return VCEASlitDoorClosed;
  515. case ModuleName.VCEB:
  516. return VCEBSlitDoorClosed;
  517. case ModuleName.PMA:
  518. return PMASlitDoorClosed;
  519. case ModuleName.PMB:
  520. return PMBSlitDoorClosed;
  521. case ModuleName.PMC:
  522. return PMCSlitDoorClosed;
  523. case ModuleName.PMD:
  524. return PMDSlitDoorClosed;
  525. }
  526. return false;
  527. }
  528. public override bool CheckPumpValveClosed(ModuleName mod)
  529. {
  530. switch (mod)
  531. {
  532. case ModuleName.DETM:
  533. return !IsTMFastPumpOpen && !IsTMSoftPumpOpen;
  534. case ModuleName.VCEA:
  535. return !IsVCEAFastPumpOpen && !IsVCEASoftPumpOpen;
  536. case ModuleName.VCEB:
  537. return !IsVCEBFastPumpOpen && !IsVCEBSoftPumpOpen;
  538. }
  539. return true;
  540. }
  541. public override bool CheckVentValveClosed(ModuleName mod)
  542. {
  543. switch (mod)
  544. {
  545. case ModuleName.DETM:
  546. if (IsTMVentValveOpen)
  547. {
  548. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, "TM Vent Valve not closed");
  549. return false;
  550. }
  551. break;
  552. case ModuleName.VCEA:
  553. if (IsVCEAVentValveOpen)
  554. {
  555. LOG.Write(eEvent.ERR_TM, ModuleName.VCEA, "VCEA Vent Valve not closed");
  556. return false;
  557. }
  558. break;
  559. case ModuleName.VCEB:
  560. if (IsVCEBVentValveOpen)
  561. {
  562. LOG.Write(eEvent.ERR_TM, ModuleName.VCEB, "VCEB Vent Valve not closed");
  563. return false;
  564. }
  565. break;
  566. }
  567. return true;
  568. }
  569. public override void SetTMFlow(int flowValue)
  570. {
  571. _TMMfc.SetPoint = (flowValue);
  572. }
  573. public override double GetModulePressure(ModuleName mod)
  574. {
  575. switch (mod)
  576. {
  577. case ModuleName.DETM:
  578. return TMPressure;
  579. case ModuleName.VCEA:
  580. return VCEAPressure;
  581. case ModuleName.VCEB:
  582. return VCEBPressure;
  583. }
  584. return 0.0;
  585. }
  586. public override bool TryGetPump(ModuleName mod)
  587. {
  588. if (mod == ModuleName.DETM)
  589. return true;
  590. //Self
  591. if ((mod == ModuleName.VCEA && _PumpingState == PumpState.VCEAUsing) || (mod == ModuleName.VCEB && _PumpingState == PumpState.VCEBUsing))
  592. return true;
  593. //Idle
  594. if (mod == ModuleName.VCEA && !IsVCEAFastPumpOpen && !IsVCEASoftPumpOpen && _PumpingState == PumpState.Idle)
  595. {
  596. _PumpingState = PumpState.VCEAUsing;
  597. return true;
  598. }
  599. if (mod == ModuleName.VCEB && !IsVCEBFastPumpOpen && !IsVCEBSoftPumpOpen && _PumpingState == PumpState.Idle)
  600. {
  601. _PumpingState = PumpState.VCEBUsing;
  602. return true;
  603. }
  604. LOG.Write(eEvent.WARN_DEFAULT_WARN, mod, "无法打开,另一个泵正在用!");
  605. //locked
  606. return false;
  607. }
  608. public override void ReleasePump(ModuleName Module)
  609. {
  610. //release pump (must do it by user)
  611. if ((Module == ModuleName.VCEA && _PumpingState == PumpState.VCEAUsing)|| (Module == ModuleName.VCEB && _PumpingState == PumpState.VCEBUsing))
  612. _PumpingState = PumpState.Idle;
  613. }
  614. #endregion
  615. #region 工具方法
  616. private bool CanOpenSlitDoor(ModuleName mod, double MaxPressureDifference)
  617. {
  618. if (Singleton<RouteManager>.Instance.GetPM(mod) == null || RouteManager.IsATMMode)
  619. return true;
  620. else
  621. {
  622. double PMPressure = Singleton<RouteManager>.Instance.GetPM(mod).ChamberPressure;
  623. if (Math.Abs(_TMPressure.Value - PMPressure) <= MaxPressureDifference || (Singleton<RouteManager>.Instance.GetPM(mod).IsAtm && IsTMATM))
  624. {
  625. return true;
  626. }
  627. else
  628. {
  629. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and {mod} pressure:{PMPressure}");
  630. return false;
  631. }
  632. }
  633. }
  634. private double mbar2mtorrConvert(double mbar) => mbar * 0.75 * 1000;
  635. #endregion
  636. }
  637. }