HongHuDETM.cs 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720
  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 VCESlitDoorClosed(ModuleName vcename)
  194. {
  195. switch (vcename)
  196. {
  197. case ModuleName.VCEA:
  198. return _VCEASlitDoor.State == CylinderState.Close;
  199. case ModuleName.VCEB:
  200. return _VCEBSlitDoor.State == CylinderState.Close;
  201. default:
  202. return false;
  203. }
  204. }
  205. public override bool AllPMSlitDoorClosed
  206. {
  207. get
  208. {
  209. bool PMAFlag = true;
  210. bool PMBFlag = true;
  211. bool PMCFlag = true;
  212. bool PMDFlag = true;
  213. if (_allInstalledModules.Contains("PMA"))
  214. PMAFlag = PMASlitDoorClosed;
  215. if (_allInstalledModules.Contains("PMB"))
  216. PMBFlag = PMBSlitDoorClosed;
  217. if (_allInstalledModules.Contains("PMC"))
  218. PMCFlag = PMCSlitDoorClosed;
  219. if (_allInstalledModules.Contains("PMD"))
  220. PMDFlag = PMDSlitDoorClosed;
  221. if (PMAFlag && PMBFlag && PMCFlag&&PMDFlag)
  222. return true;
  223. else
  224. return false;
  225. }
  226. }
  227. //public bool VCEASlitDoorOpenEnable => _VCEASlitDoorOpenEnable.Value;
  228. //public bool VCEBSlitDoorOpenEnable => _VCEBSlitDoorOpenEnable.Value;
  229. //public bool PMASlitDoorOpenEnable => _PMASlitDoorOpenEnable.Value;
  230. //public bool PMBSlitDoorOpenEnable => _PMBSlitDoorOpenEnable.Value;
  231. //public bool PMCSlitDoorOpenEnable => _PMCSlitDoorOpenEnable.Value;
  232. //public bool PMDSlitDoorOpenEnable => _PMDSlitDoorOpenEnable.Value;
  233. //public bool VCEASlitDoorCloseEnable => _VCEASlitDoorCloseEnable.Value;
  234. //public bool VCEBSlitDoorCloseEnable => _VCEBSlitDoorCloseEnable.Value;
  235. //public bool PMASlitDoorCloseEnable => _PMASlitDoorCloseEnable.Value;
  236. //public bool PMBSlitDoorCloseEnable => _PMBSlitDoorCloseEnable.Value;
  237. //public bool PMCSlitDoorCloseEnable => _PMCSlitDoorCloseEnable.Value;
  238. //public bool PMDSlitDoorCloseEnable => _PMDSlitDoorCloseEnable.Value;
  239. //Robot动作
  240. //public bool TMExtendVCEEnable => _TMExtendVCEEnable.Value;
  241. public bool TMExtendPMAEnable => _TMExtendPMAEnable.Value;
  242. public bool TMExtendPMBEnable => _TMExtendPMBEnable.Value;
  243. public bool TMExtendPMCEnable => _TMExtendPMCEnable.Value;
  244. public bool TMExtendPMDEnable => _TMExtendPMDEnable.Value;
  245. public override double TMPressure => _TMPressure.Value;
  246. public override double VCEAPressure => _VCEAPressure.Value;
  247. public override double VCEBPressure => _VCEBPressure.Value;
  248. public override PumpState PumpingState => _PumpingState;
  249. PumpState _PumpingState = PumpState.Idle;
  250. #endregion
  251. public HongHuDETM() : base(ModuleName.DETM.ToString())
  252. {
  253. Module = ModuleName.DETM.ToString();
  254. TMATMTargetPressure = SC.GetValue<double>($"{Module}.ATMTargetPressure");
  255. TMVACTargetPressure = SC.GetValue<double>($"{Module}.VACTargetPressure");
  256. VCEATMTargetPressure = SC.GetValue<double>($"VCE1.ATMTargetPressure");
  257. VCEVACTargetPressure = SC.GetValue<double>($"VCE1.VACTargetPressure");
  258. _TMFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMFastPumpValve}");
  259. _TMSoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMSoftPumpValve}");
  260. _VCEASoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEASoftPumpValve}");
  261. _VCEBSoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBSoftPumpValve}");
  262. _VCEAFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEAFastPumpValve}");
  263. _VCEBFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBFastPumpValve}");
  264. _TMFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMFastVentValve}");
  265. _TMSoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMSoftVentValve}");
  266. _VCEASoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEASoftVentValve}");
  267. _VCEBSoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBSoftVentValve}");
  268. _VCEAFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEAFastVentValve}");
  269. _VCEBFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEBFastVentValve}");
  270. //_VCEASlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEASlitDoorOpenEnable}");
  271. //_VCEBSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEBSlitDoorOpenEnable}");
  272. //_PMASlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMASlitDoorOpenEnable}");
  273. //_PMBSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMBSlitDoorOpenEnable}");
  274. //_PMCSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorOpenEnable}");
  275. //_PMDSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMDSlitDoorOpenEnable}");
  276. //
  277. //_VCEASlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEASlitDoorCloseEnable}");
  278. //_VCEBSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEBSlitDoorCloseEnable}");
  279. //_PMASlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMASlitDoorCloseEnable}");
  280. //_PMBSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMBSlitDoorCloseEnable}");
  281. _TMATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.TMATMSensor}");
  282. _VCEAATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEAATMSensor}");
  283. _VCEBATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEBATMSensor}");
  284. _VCEASlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.VCEASlitDoor}");
  285. _VCEBSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.VCEBSlitDoor}");
  286. _PMASlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMASlitDoor}");
  287. _PMBSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMBSlitDoor}");
  288. if (_allInstalledModules.Contains("PMC"))
  289. {
  290. //_PMCSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorOpenEnable}");
  291. _PMCSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMCSlitDoor}");
  292. //_PMCSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorCloseEnable}");
  293. }
  294. if (_allInstalledModules.Contains("PMD"))
  295. {
  296. //_PMDSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMDSlitDoorOpenEnable}");
  297. _PMDSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMDSlitDoor}");
  298. //_PMDSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMDSlitDoorCloseEnable}");
  299. }
  300. _TMMfc = DEVICE.GetDevice<IoMfc>($"{Module}.TM_MFC1");
  301. _TMPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.TMPressure");
  302. //_TMPiplinePressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.TMPipelinePressure");
  303. _VCEAPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.VCEAPressure");
  304. _VCEBPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.VCEBPressure");
  305. if (SC.GetValue<int>($"{Module}.DryPump.CommunicationType") == (int)CommunicationType.RS232)
  306. {
  307. if (SC.GetValue<int>($"{Module}.DryPump.MFG") == (int)DryPumpMFG.SKY)
  308. {
  309. _TMPump = DEVICE.GetDevice<SkyPump>($"{Module}.{VenusDevice.MainPump}");
  310. }
  311. else if (SC.GetValue<int>($"{Module}.DryPump.MFG") == (int)DryPumpMFG.Edwards)
  312. {
  313. _TMPump = DEVICE.GetDevice<EdwardsPump>($"{Module}.{VenusDevice.MainPump}");
  314. }
  315. }
  316. if (SC.GetValue<int>($"VCEA.DryPump.CommunicationType") == (int)CommunicationType.RS232)
  317. {
  318. if (SC.GetValue<int>($"VCEA.DryPump.MFG") == (int)DryPumpMFG.SKY)
  319. {
  320. _VCEPump = DEVICE.GetDevice<SkyPump>($"VCEA.{VenusDevice.MainPump}");
  321. }
  322. else if (SC.GetValue<int>($"VCEA.DryPump.MFG") == (int)DryPumpMFG.Edwards)
  323. {
  324. _VCEPump = DEVICE.GetDevice<EdwardsPump>($"VCEA.{VenusDevice.MainPump}");
  325. }
  326. }
  327. DATA.Subscribe($"{Module}.VCEASlitDoorClosed", () => VCEASlitDoorClosed);
  328. DATA.Subscribe($"{Module}.VCEBSlitDoorClosed", () => VCEBSlitDoorClosed);
  329. DATA.Subscribe($"{Module}.PMASlitDoorClosed", () => PMASlitDoorClosed);
  330. DATA.Subscribe($"{Module}.PMBSlitDoorClosed", () => PMBSlitDoorClosed);
  331. DATA.Subscribe($"{Module}.PMCSlitDoorClosed", () => PMCSlitDoorClosed);
  332. DATA.Subscribe($"{Module}.PMDSlitDoorClosed", () => PMDSlitDoorClosed);
  333. DATA.Subscribe($"{Module}.PumpIsRunning", () => IsTMPumpRunning, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  334. DATA.Subscribe($"{Module}.TMIsATM", () => IsTMATM);
  335. DATA.Subscribe($"{Module}.VCEAIsATM", () => IsVCEAATM);
  336. DATA.Subscribe($"{Module}.VCEBIsATM", () => IsVCEBATM);
  337. OP.Subscribe($"{Module}.ControlPump", (cmd, args) =>
  338. {
  339. _TMPump.SetPumpOnOff((bool)args[0]);
  340. return true;
  341. });
  342. OP.Subscribe($"{Module}.SetSlitDoor", (cmd, args) =>
  343. {
  344. var module = (ModuleName)Enum.Parse(typeof(ModuleName), args[0].ToString());
  345. return TurnSlitDoor(module, (bool)args[1]);
  346. });
  347. }
  348. #region IO控制方法
  349. //slitdoor
  350. //2023/11/1 增加两边压差比较
  351. public override bool TurnSlitDoor(ModuleName mod, bool bOn)
  352. {
  353. double MaxPressureDifference = SC.GetValue<double>("System.PMTMMaxPressureDifference");
  354. switch (mod)
  355. {
  356. case ModuleName.VCEA:
  357. if (bOn && IsVCEAATM && IsTMATM)
  358. {
  359. LOG.Write(eEvent.INFO_TM, ModuleName.DETM, $"open door without Pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEAPressure.Value}");
  360. return _VCEASlitDoor.SetCylinder(bOn, out _);
  361. }
  362. if (bOn && Math.Abs(_TMPressure.Value - _VCEAPressure.Value) > MaxPressureDifference)
  363. {
  364. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEAPressure.Value}");
  365. return false;
  366. }
  367. return _VCEASlitDoor.SetCylinder(bOn, out _);
  368. case ModuleName.VCEB:
  369. if (bOn && IsVCEBATM && IsTMATM)
  370. {
  371. LOG.Write(eEvent.INFO_TM, ModuleName.DETM, $"open door without Pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEBPressure.Value}");
  372. return _VCEBSlitDoor.SetCylinder(bOn, out _);
  373. }
  374. if (bOn && Math.Abs(_TMPressure.Value - _VCEBPressure.Value) > MaxPressureDifference)
  375. {
  376. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEBPressure.Value}");
  377. return false;
  378. }
  379. return _VCEBSlitDoor.SetCylinder(bOn, out _);
  380. case ModuleName.PMA:
  381. if (bOn && Singleton<RouteManager>.Instance.PMA.IsAtm && IsTMATM)
  382. return _PMASlitDoor.SetCylinder(bOn, out _);
  383. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  384. return false;
  385. return _PMASlitDoor.SetCylinder(bOn, out _);
  386. case ModuleName.PMB:
  387. if (bOn && Singleton<RouteManager>.Instance.PMB.IsAtm && IsTMATM)
  388. return _PMBSlitDoor.SetCylinder(bOn, out _);
  389. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  390. return false;
  391. return _PMBSlitDoor.SetCylinder(bOn, out _);
  392. case ModuleName.PMC:
  393. if (bOn && Singleton<RouteManager>.Instance.PMC.IsAtm && IsTMATM)
  394. return _PMCSlitDoor.SetCylinder(bOn, out _);
  395. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  396. return false;
  397. return _PMCSlitDoor.SetCylinder(bOn, out _);
  398. case ModuleName.PMD:
  399. if (bOn && Singleton<RouteManager>.Instance.PMD.IsAtm && IsTMATM)
  400. return _PMDSlitDoor.SetCylinder(bOn, out _);
  401. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  402. return false;
  403. return _PMDSlitDoor.SetCylinder(bOn, out _);
  404. }
  405. return false;
  406. }
  407. //valve
  408. public override void TurnFastPumpValve(ModuleName mod, bool bOn)
  409. {
  410. switch (mod)
  411. {
  412. case ModuleName.DETM:
  413. _TMFastPumpValve.TurnValve(bOn, out string _);
  414. break;
  415. case ModuleName.VCEA:
  416. _VCEAFastPumpValve.TurnValve(bOn, out string _);
  417. break;
  418. case ModuleName.VCEB:
  419. _VCEBFastPumpValve.TurnValve(bOn, out string _);
  420. break;
  421. }
  422. }
  423. public override void TurnSoftPumpValve(ModuleName mod, bool bOn)
  424. {
  425. switch (mod)
  426. {
  427. case ModuleName.DETM:
  428. _TMSoftPumpValve.TurnValve(bOn, out string _);
  429. break;
  430. case ModuleName.VCEA:
  431. _VCEASoftPumpValve.TurnValve(bOn, out string _);
  432. break;
  433. case ModuleName.VCEB:
  434. _VCEBSoftPumpValve.TurnValve(bOn, out string _);
  435. break;
  436. }
  437. }
  438. public override void TurnFastVentValve(ModuleName mod, bool bOn)
  439. {
  440. switch (mod)
  441. {
  442. case ModuleName.DETM:
  443. _TMFastVentValve.TurnValve(bOn, out string _);
  444. break;
  445. case ModuleName.VCEA:
  446. _VCEAFastVentValve.TurnValve(bOn, out string _);
  447. break;
  448. case ModuleName.VCEB:
  449. _VCEBFastVentValve.TurnValve(bOn, out string _);
  450. break;
  451. }
  452. }
  453. public override void TurnSoftVentValve(ModuleName mod, bool bOn)
  454. {
  455. switch (mod)
  456. {
  457. case ModuleName.DETM:
  458. _TMSoftVentValve.TurnValve(bOn, out string _);
  459. break;
  460. case ModuleName.VCEA:
  461. _VCEASoftVentValve.TurnValve(bOn, out string _);
  462. break;
  463. case ModuleName.VCEB:
  464. _VCEBSoftVentValve.TurnValve(bOn, out string _);
  465. break;
  466. }
  467. }
  468. public override bool CloseAllSlitDoor()
  469. {
  470. TurnSlitDoor(ModuleName.VCEA, false);
  471. TurnSlitDoor(ModuleName.VCEB, false);
  472. if (_allInstalledModules.Contains("PMA"))
  473. TurnSlitDoor(ModuleName.PMA, false);
  474. if (_allInstalledModules.Contains("PMB"))
  475. TurnSlitDoor(ModuleName.PMB, false);
  476. if (_allInstalledModules.Contains("PMC"))
  477. TurnSlitDoor(ModuleName.PMC, false);
  478. if (_allInstalledModules.Contains("PMD"))
  479. TurnSlitDoor(ModuleName.PMD, false);
  480. return true;
  481. }
  482. public override void HomeVceSlitDoor()
  483. {
  484. //由SlitDoor的状态对其下发同样的指令
  485. if (VCEASlitDoorClosed == true)
  486. TurnSlitDoor(ModuleName.VCEA, false);
  487. else
  488. TurnSlitDoor(ModuleName.VCEA, true);
  489. if (VCEBSlitDoorClosed == true)
  490. TurnSlitDoor(ModuleName.VCEB, false);
  491. else
  492. TurnSlitDoor(ModuleName.VCEB, true);
  493. }
  494. public override void CloseVentValve()
  495. {
  496. _TMSoftVentValve.TurnValve(false, out _);
  497. _TMFastVentValve.TurnValve(false, out _);
  498. _VCEASoftVentValve.TurnValve(false, out _);
  499. _VCEBSoftVentValve.TurnValve(false, out _);
  500. _VCEAFastVentValve.TurnValve(false, out _);
  501. _VCEBFastVentValve.TurnValve(false, out _);
  502. }
  503. public override bool CheckSlitValveOpen(ModuleName mod)
  504. {
  505. switch (mod)
  506. {
  507. case ModuleName.VCEA:
  508. return VCEASlitDoorOpen;
  509. case ModuleName.VCEB:
  510. return VCEBSlitDoorOpen;
  511. case ModuleName.PMA:
  512. return PMASlitDoorOpen;
  513. case ModuleName.PMB:
  514. return PMBSlitDoorOpen;
  515. case ModuleName.PMC:
  516. return PMCSlitDoorOpen;
  517. case ModuleName.PMD:
  518. return PMDSlitDoorOpen;
  519. }
  520. return false;
  521. }
  522. public override bool CheckSlitValveClose(ModuleName mod)
  523. {
  524. switch (mod)
  525. {
  526. case ModuleName.VCEA:
  527. return VCEASlitDoorClosed;
  528. case ModuleName.VCEB:
  529. return VCEBSlitDoorClosed;
  530. case ModuleName.PMA:
  531. return PMASlitDoorClosed;
  532. case ModuleName.PMB:
  533. return PMBSlitDoorClosed;
  534. case ModuleName.PMC:
  535. return PMCSlitDoorClosed;
  536. case ModuleName.PMD:
  537. return PMDSlitDoorClosed;
  538. }
  539. return false;
  540. }
  541. public override bool CheckPumpValveClosed(ModuleName mod)
  542. {
  543. switch (mod)
  544. {
  545. case ModuleName.DETM:
  546. return !IsTMFastPumpOpen && !IsTMSoftPumpOpen;
  547. case ModuleName.VCEA:
  548. return !IsVCEAFastPumpOpen && !IsVCEASoftPumpOpen;
  549. case ModuleName.VCEB:
  550. return !IsVCEBFastPumpOpen && !IsVCEBSoftPumpOpen;
  551. }
  552. return true;
  553. }
  554. public override bool CheckVentValveClosed(ModuleName mod)
  555. {
  556. switch (mod)
  557. {
  558. case ModuleName.DETM:
  559. if (IsTMVentValveOpen)
  560. {
  561. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, "TM Vent Valve not closed");
  562. return false;
  563. }
  564. break;
  565. case ModuleName.VCEA:
  566. if (IsVCEAVentValveOpen)
  567. {
  568. LOG.Write(eEvent.ERR_TM, ModuleName.VCEA, "VCEA Vent Valve not closed");
  569. return false;
  570. }
  571. break;
  572. case ModuleName.VCEB:
  573. if (IsVCEBVentValveOpen)
  574. {
  575. LOG.Write(eEvent.ERR_TM, ModuleName.VCEB, "VCEB Vent Valve not closed");
  576. return false;
  577. }
  578. break;
  579. }
  580. return true;
  581. }
  582. public override void SetTMFlow(int flowValue)
  583. {
  584. _TMMfc.SetPoint = (flowValue);
  585. }
  586. public override double GetModulePressure(ModuleName mod)
  587. {
  588. switch (mod)
  589. {
  590. case ModuleName.DETM:
  591. return TMPressure;
  592. case ModuleName.VCEA:
  593. return VCEAPressure;
  594. case ModuleName.VCEB:
  595. return VCEBPressure;
  596. }
  597. return 0.0;
  598. }
  599. public override bool TryGetPump(ModuleName mod)
  600. {
  601. if (mod == ModuleName.DETM)
  602. return true;
  603. //Self
  604. if ((mod == ModuleName.VCEA && _PumpingState == PumpState.VCEAUsing) || (mod == ModuleName.VCEB && _PumpingState == PumpState.VCEBUsing))
  605. return true;
  606. //Idle
  607. if (mod == ModuleName.VCEA && !IsVCEAFastPumpOpen && !IsVCEASoftPumpOpen && _PumpingState == PumpState.Idle)
  608. {
  609. _PumpingState = PumpState.VCEAUsing;
  610. return true;
  611. }
  612. if (mod == ModuleName.VCEB && !IsVCEBFastPumpOpen && !IsVCEBSoftPumpOpen && _PumpingState == PumpState.Idle)
  613. {
  614. _PumpingState = PumpState.VCEBUsing;
  615. return true;
  616. }
  617. LOG.Write(eEvent.WARN_DEFAULT_WARN, mod, "无法打开,另一个泵正在用!");
  618. //locked
  619. return false;
  620. }
  621. public override void ReleasePump(ModuleName Module)
  622. {
  623. //release pump (must do it by user)
  624. if ((Module == ModuleName.VCEA && _PumpingState == PumpState.VCEAUsing)|| (Module == ModuleName.VCEB && _PumpingState == PumpState.VCEBUsing))
  625. _PumpingState = PumpState.Idle;
  626. }
  627. #endregion
  628. #region 工具方法
  629. private bool CanOpenSlitDoor(ModuleName mod, double MaxPressureDifference)
  630. {
  631. if (Singleton<RouteManager>.Instance.GetPM(mod) == null || RouteManager.IsATMMode)
  632. return true;
  633. else
  634. {
  635. double PMPressure = Singleton<RouteManager>.Instance.GetPM(mod).ChamberPressure;
  636. if (Math.Abs(_TMPressure.Value - PMPressure) <= MaxPressureDifference || (Singleton<RouteManager>.Instance.GetPM(mod).IsAtm && IsTMATM))
  637. {
  638. return true;
  639. }
  640. else
  641. {
  642. LOG.Write(eEvent.ERR_TM, ModuleName.DETM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and {mod} pressure:{PMPressure}");
  643. return false;
  644. }
  645. }
  646. }
  647. private double mbar2mtorrConvert(double mbar) => mbar * 0.75 * 1000;
  648. #endregion
  649. }
  650. }