HongHuTM.cs 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633
  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 System;
  12. using IoMfc = Venus_RT.Devices.IODevices.IoMfc;
  13. using IoPressureMeter = Venus_RT.Devices.IODevices.IoPressureMeter;
  14. using Venus_Core;
  15. using Venus_RT.Modules;
  16. using Venus_RT.Devices.TM;
  17. using Venus_RT.Devices.IODevices;
  18. namespace Venus_RT.Devices
  19. {
  20. public class HongHuTM : TMBase
  21. {
  22. /// <summary>
  23. /// 针对VenusSE设计
  24. /// </summary>
  25. #region io 信号抽象
  26. //控制阀信号
  27. private readonly IoValve _TMFastPumpValve;
  28. private readonly IoValve _TMSoftPumpValve;
  29. private readonly IoValve _VCESoftPumpValve;
  30. private readonly IoValve _VCEFastPumpValve;
  31. private readonly IoValve _TMFastVentValve;
  32. private readonly IoValve _TMSoftVentValve;
  33. private readonly IoValve _VCESoftVentValve;
  34. private readonly IoValve _VCEFastVentValve;
  35. //判断信号
  36. private readonly IoSensor _VCESlitDoorOpenEnable;
  37. private readonly IoSensor _PMASlitDoorOpenEnable;
  38. private readonly IoSensor _PMBSlitDoorOpenEnable;
  39. private readonly IoSensor _PMCSlitDoorOpenEnable;
  40. private readonly IoSensor _VCESlitDoorCloseEnable;
  41. private readonly IoSensor _PMASlitDoorCloseEnable;
  42. private readonly IoSensor _PMBSlitDoorCloseEnable;
  43. private readonly IoSensor _PMCSlitDoorCloseEnable;
  44. private readonly IoSensor _TMExtendVCEEnable;
  45. private readonly IoSensor _TMExtendPMAEnable;
  46. private readonly IoSensor _TMExtendPMBEnable;
  47. private readonly IoSensor _TMExtendPMCEnable;
  48. private readonly IoSensor _TMVACSensor;
  49. private readonly IoSensor _VCEVACSensor;
  50. private readonly IoSensor _VCEATMSensor;
  51. private readonly IoSensor _TMATMSensor;
  52. private readonly IoSensor _ROBOTNotExtendVCE;
  53. //控制门信号
  54. private readonly IoCylinder _VCESlitDoor;
  55. private readonly IoCylinder _PMASlitDoor;
  56. private readonly IoCylinder _PMBSlitDoor;
  57. private readonly IoCylinder _PMCSlitDoor;
  58. private readonly IoMfc _TMMfc;
  59. private readonly IoPressureMeter _TMPressure;
  60. //private readonly IoPressureMeter _TMPiplinePressure;
  61. private readonly IoPressureMeter _VCEPressure;
  62. //private readonly IoPressureMeter _VCEPiplinePressure;
  63. private readonly PumpBase _TMPump;
  64. private readonly IoHongHuControl _PressureControl;
  65. //控压
  66. //安装的module
  67. private string _allInstalledModules { get { return SC.GetStringValue("System.InstalledModules").ToString(); } }
  68. private double TMATMTargetPressure;
  69. private double TMVACTargetPressure;
  70. private double VCEATMTargetPressure;
  71. private double VCEVACTargetPressure;
  72. private VentStatus _ventStatus = VentStatus.Idle;
  73. #endregion
  74. #region 暴露变量
  75. public override bool IsPressureControl
  76. {
  77. get
  78. {
  79. if (_PressureControl != null)
  80. return _PressureControl.IsProcessControl;
  81. return false;
  82. }
  83. }
  84. //ATM VAC信号
  85. public override bool IsTMATM => _TMATMSensor.Value && _TMPressure.Value >= TMATMTargetPressure;
  86. public override bool IsVCEATM => _VCEATMSensor.Value &&_VCEPressure.Value >= VCEATMTargetPressure;
  87. public override bool IsTMVAC => _TMVACSensor.Value || _TMPressure.Value <= TMVACTargetPressure;
  88. public override bool IsVCEVAC => _VCEVACSensor.Value || _VCEPressure.Value <= VCEVACTargetPressure;
  89. public bool? IsTMPumpRunning => _TMPump?.IsRunning;
  90. //valve开关状态
  91. public override bool IsTMFastPumpOpen => _TMFastPumpValve.Status;
  92. public override bool IsTMSoftPumpOpen => _TMSoftPumpValve.Status;
  93. public override bool IsTMFastVentOpen => _TMFastVentValve.Status;
  94. public override bool IsTMSoftVentOpen => _TMSoftVentValve.Status;
  95. public bool IsVCEFastPumpOpen => _VCEFastPumpValve.Status;
  96. public bool IsVCESoftPumpOpen => _VCESoftPumpValve.Status;
  97. public bool IsVCEFastVentOpen => _VCEFastVentValve.Status;
  98. public bool IsVCESoftVentOpen => _VCESoftVentValve.Status;
  99. public override bool IsTMVentValveOpen => IsTMFastVentOpen && IsTMSoftVentOpen;
  100. public bool IsVCEVentValveOpen => IsVCEFastVentOpen && IsVCESoftVentOpen;
  101. //SlitDoor
  102. public override bool VCESlitDoorClosed(ModuleName vcename) => _VCESlitDoor.State == CylinderState.Close;
  103. public override bool PMASlitDoorClosed
  104. {
  105. get
  106. {
  107. if (_allInstalledModules.Contains("PMA"))
  108. return _PMASlitDoor.State == CylinderState.Close;
  109. else
  110. return false;
  111. }
  112. }
  113. public override bool PMBSlitDoorClosed
  114. {
  115. get
  116. {
  117. if (_allInstalledModules.Contains("PMB"))
  118. return _PMBSlitDoor.State == CylinderState.Close;
  119. else
  120. return false;
  121. }
  122. }
  123. public override bool PMCSlitDoorClosed
  124. {
  125. get
  126. {
  127. if (_allInstalledModules.Contains("PMC"))
  128. return _PMCSlitDoor.State == CylinderState.Close;
  129. else
  130. return false;
  131. }
  132. }
  133. public bool VCESlitDoorOpen => _VCESlitDoor.State == CylinderState.Open;
  134. public bool PMASlitDoorOpen
  135. {
  136. get
  137. {
  138. if (_allInstalledModules.Contains("PMA"))
  139. return (_PMASlitDoor.State == CylinderState.Open);
  140. else
  141. return false;
  142. }
  143. }
  144. public bool PMBSlitDoorOpen
  145. {
  146. get
  147. {
  148. if (_allInstalledModules.Contains("PMB"))
  149. return (_PMBSlitDoor.State == CylinderState.Open);
  150. else
  151. return false;
  152. }
  153. }
  154. public bool PMCSlitDoorOpen
  155. {
  156. get
  157. {
  158. if (_allInstalledModules.Contains("PMC"))
  159. return (_PMCSlitDoor.State == CylinderState.Open);
  160. else
  161. return false;
  162. }
  163. }
  164. public override bool AllPMSlitDoorClosed
  165. {
  166. get
  167. {
  168. bool PMAFlag = true;
  169. bool PMBFlag = true;
  170. bool PMCFlag = true;
  171. if (_allInstalledModules.Contains("PMA"))
  172. PMAFlag = PMASlitDoorClosed;
  173. if (_allInstalledModules.Contains("PMB"))
  174. PMBFlag = PMBSlitDoorClosed;
  175. if (_allInstalledModules.Contains("PMC"))
  176. PMCFlag = PMCSlitDoorClosed;
  177. if (PMAFlag && PMBFlag && PMCFlag)
  178. return true;
  179. else
  180. return false;
  181. }
  182. }
  183. public bool VCESlitDoorOpenEnable => _VCESlitDoorOpenEnable.Value;
  184. public bool PMASlitDoorOpenEnable => _PMASlitDoorOpenEnable.Value;
  185. public bool PMBSlitDoorOpenEnable => _PMBSlitDoorOpenEnable.Value;
  186. public bool PMCSlitDoorOpenEnable => _PMCSlitDoorOpenEnable.Value;
  187. public bool VCESlitDoorCloseEnable => _VCESlitDoorCloseEnable.Value;
  188. public bool PMASlitDoorCloseEnable => _PMASlitDoorCloseEnable.Value;
  189. public bool PMBSlitDoorCloseEnable => _PMBSlitDoorCloseEnable.Value;
  190. public bool PMCSlitDoorCloseEnable => _PMCSlitDoorCloseEnable.Value;
  191. //Robot动作
  192. public bool TMExtendVCEEnable => _TMExtendVCEEnable.Value;
  193. public bool TMExtendPMAEnable => _TMExtendPMAEnable.Value;
  194. public bool TMExtendPMBEnable => _TMExtendPMBEnable.Value;
  195. public bool TMExtendPMCEnable => _TMExtendPMCEnable.Value;
  196. public override bool RobotNotExtendVCE => _ROBOTNotExtendVCE.Value;
  197. public override double TMPressure => _TMPressure.Value;
  198. public override double VCEPressure => _VCEPressure.Value;
  199. public override PumpState PumpingState => _PumpingState;
  200. PumpState _PumpingState = PumpState.Idle;
  201. #endregion
  202. public HongHuTM() : base(ModuleName.TM.ToString())
  203. {
  204. TMATMTargetPressure = SC.GetValue<double>($"TM.ATMTargetPressure");
  205. TMVACTargetPressure = SC.GetValue<double>($"TM.VACTargetPressure");
  206. VCEATMTargetPressure = SC.GetValue<double>($"VCE1.ATMTargetPressure");
  207. VCEVACTargetPressure = SC.GetValue<double>($"VCE1.VACTargetPressure");
  208. Module = ModuleName.TM.ToString();
  209. _TMFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMFastPumpValve}");
  210. _TMSoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMSoftPumpValve}");
  211. _VCESoftPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCESoftPumpValve}");
  212. _VCEFastPumpValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEFastPumpValve}");
  213. _TMFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMFastVentValve}");
  214. _TMSoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.TMSoftVentValve}");
  215. _VCESoftVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCESoftVentValve}");
  216. _VCEFastVentValve = DEVICE.GetDevice<IoValve>($"{Module}.{VenusDevice.VCEFastVentValve}");
  217. _VCESlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCESlitDoorOpenEnable}");
  218. _PMASlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMASlitDoorOpenEnable}");
  219. _PMBSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMBSlitDoorOpenEnable}");
  220. _VCESlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCESlitDoorCloseEnable}");
  221. _PMASlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMASlitDoorCloseEnable}");
  222. _PMBSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMBSlitDoorCloseEnable}");
  223. _ROBOTNotExtendVCE = DEVICE.GetDevice<IoSensor>($"{Module}.ROBOTNotExtendVCE");
  224. _TMVACSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.TMVACSensor}");
  225. _VCEVACSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEVACSensor}");
  226. _TMATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.TMATMSensor}");
  227. _VCEATMSensor = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.VCEATMSensor}");
  228. _VCESlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.VCESlitDoor}");
  229. _PMASlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMASlitDoor}");
  230. _PMBSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMBSlitDoor}");
  231. if (_allInstalledModules.Contains("PMC"))
  232. {
  233. _PMCSlitDoorOpenEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorOpenEnable}");
  234. _PMCSlitDoor = DEVICE.GetDevice<IoCylinder>($"{Module}.{VenusDevice.PMCSlitDoor}");
  235. _PMCSlitDoorCloseEnable = DEVICE.GetDevice<IoSensor>($"{Module}.{VenusDevice.PMCSlitDoorCloseEnable}");
  236. }
  237. _TMMfc = DEVICE.GetDevice<IoMfc>($"{Module}.TM_MFC1");
  238. _TMPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.TMPressure");
  239. //_TMPiplinePressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.TMPipelinePressure");
  240. _VCEPressure = DEVICE.GetDevice<IoPressureMeter>($"{Module}.VCEPressure");
  241. if (SC.GetValue<int>($"{Module}.DryPump.CommunicationType") == (int)CommunicationType.RS232)
  242. {
  243. if (SC.GetValue<int>($"{Module}.DryPump.MFG") == (int)DryPumpMFG.SKY)
  244. {
  245. _TMPump = DEVICE.GetDevice<SkyPump>($"{Module}.{VenusDevice.MainPump}");
  246. }
  247. else if (SC.GetValue<int>($"{Module}.DryPump.MFG") == (int)DryPumpMFG.Edwards)
  248. {
  249. _TMPump = DEVICE.GetDevice<EdwardsPump>($"{Module}.{VenusDevice.MainPump}");
  250. }
  251. }
  252. _PressureControl = DEVICE.GetDevice<IoHongHuControl>($"{Module}.PressureControl");
  253. DATA.Subscribe($"{Module}.VCESlitDoorClosed", () => VCESlitDoorClosed(ModuleName.VCE1));
  254. DATA.Subscribe($"{Module}.PMASlitDoorClosed", () => PMASlitDoorClosed);
  255. DATA.Subscribe($"{Module}.PMBSlitDoorClosed", () => PMBSlitDoorClosed);
  256. DATA.Subscribe($"{Module}.PMCSlitDoorClosed", () => PMCSlitDoorClosed);
  257. DATA.Subscribe($"{Module}.PumpIsRunning", () => IsTMPumpRunning, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  258. DATA.Subscribe($"{Module}.TMIsATM", ()=> IsTMATM);
  259. DATA.Subscribe($"{Module}.VCEIsATM", ()=> IsVCEATM);
  260. OP.Subscribe($"{Module}.ControlPump", (cmd, args) =>
  261. {
  262. _TMPump.SetPumpOnOff((bool)args[0]);
  263. return true;
  264. });
  265. OP.Subscribe($"{Module}.SetSlitDoor", (cmd, args) =>
  266. {
  267. var module = (ModuleName)Enum.Parse(typeof(ModuleName), args[0].ToString());
  268. return TurnSlitDoor(module, (bool)args[1]);
  269. });
  270. }
  271. #region IO控制方法
  272. //slitdoor
  273. //2023/11/1 增加两边压差比较
  274. public override void PressureControl(bool bCtrl)
  275. {
  276. if (!_PressureControl.IsProcessControl && bCtrl)
  277. {
  278. _PressureControl.SetMode(true);
  279. }
  280. if (_PressureControl.IsProcessControl && !bCtrl)
  281. {
  282. _PressureControl.SetMode(false);
  283. }
  284. }
  285. public override bool TryGetVent(ModuleName mod)
  286. {
  287. //Self
  288. if ((mod == ModuleName.VCE1 && _ventStatus == VentStatus.VCE1Venting) ||
  289. (mod == ModuleName.TM && _ventStatus == VentStatus.TMVenting))
  290. return true;
  291. //Idle
  292. if (mod == ModuleName.VCE1 && _ventStatus == VentStatus.Idle)
  293. {
  294. _ventStatus = VentStatus.VCE1Venting;
  295. return true;
  296. }
  297. if (mod == ModuleName.TM && _ventStatus == VentStatus.Idle)
  298. {
  299. _ventStatus = VentStatus.TMVenting;
  300. return true;
  301. }
  302. LOG.Write(eEvent.WARN_DEFAULT_WARN, mod, $"cannot Vent {mod},as {_ventStatus}!");
  303. //locked
  304. return false;
  305. }
  306. public override void ReleaseVent(ModuleName Module)
  307. {
  308. if ((Module == ModuleName.VCE1 && _ventStatus == VentStatus.VCE1Venting) ||
  309. (Module == ModuleName.TM && _ventStatus == VentStatus.TMVenting))
  310. _ventStatus = VentStatus.Idle;
  311. }
  312. public override bool TurnSlitDoor(ModuleName mod, bool bOn)
  313. {
  314. double MaxPressureDifference = SC.GetValue<double>("System.PMTMMaxPressureDifference");
  315. switch (mod)
  316. {
  317. case ModuleName.VCE1:
  318. if (bOn && IsVCEATM && IsTMATM)
  319. {
  320. LOG.Write(eEvent.INFO_TM, ModuleName.TM, $"open door without Pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEPressure.Value}");
  321. return _VCESlitDoor.SetCylinder(bOn, out _);
  322. }
  323. if (bOn && Math.Abs(_TMPressure.Value - _VCEPressure.Value)> MaxPressureDifference)
  324. {
  325. LOG.Write(eEvent.ERR_TM, ModuleName.TM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and VCE Pressure:{_VCEPressure.Value}");
  326. return false;
  327. }
  328. return _VCESlitDoor.SetCylinder(bOn, out _);
  329. case ModuleName.PMA:
  330. if (bOn && Singleton<RouteManager>.Instance.PMA.IsAtm && IsTMATM)
  331. return _PMASlitDoor.SetCylinder(bOn, out _);
  332. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  333. return false;
  334. return _PMASlitDoor.SetCylinder(bOn, out _);
  335. case ModuleName.PMB:
  336. if (bOn && Singleton<RouteManager>.Instance.PMB.IsAtm && IsTMATM)
  337. return _PMBSlitDoor.SetCylinder(bOn, out _);
  338. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference) )
  339. return false;
  340. return _PMBSlitDoor.SetCylinder(bOn, out _);
  341. case ModuleName.PMC:
  342. if (bOn && Singleton<RouteManager>.Instance.PMC.IsAtm && IsTMATM)
  343. return _PMCSlitDoor.SetCylinder(bOn, out _);
  344. if (bOn && !CanOpenSlitDoor(mod, MaxPressureDifference))
  345. return false;
  346. return _PMCSlitDoor.SetCylinder(bOn, out _);
  347. }
  348. return false;
  349. }
  350. //valve
  351. public override void TurnFastPumpValve(ModuleName mod, bool bOn)
  352. {
  353. switch (mod)
  354. {
  355. case ModuleName.TM:
  356. _TMFastPumpValve.TurnValve(bOn, out string _);
  357. break;
  358. case ModuleName.VCE1:
  359. _VCEFastPumpValve.TurnValve(bOn, out string _);
  360. break;
  361. }
  362. }
  363. public override void CloseModuleAllValves(ModuleName module)
  364. {
  365. TurnFastPumpValve(module, false);
  366. TurnSoftPumpValve(module, false);
  367. TurnFastVentValve(module, false);
  368. TurnSoftVentValve(module, false);
  369. }
  370. public override void TurnSoftPumpValve(ModuleName mod, bool bOn)
  371. {
  372. switch (mod)
  373. {
  374. case ModuleName.TM:
  375. _TMSoftPumpValve.TurnValve(bOn, out string _);
  376. break;
  377. case ModuleName.VCE1:
  378. _VCESoftPumpValve.TurnValve(bOn, out string _);
  379. break;
  380. }
  381. }
  382. public override void TurnFastVentValve(ModuleName mod, bool bOn)
  383. {
  384. switch (mod)
  385. {
  386. case ModuleName.TM:
  387. _TMFastVentValve.TurnValve(bOn, out string _);
  388. break;
  389. case ModuleName.VCE1:
  390. _VCEFastVentValve.TurnValve(bOn, out string _);
  391. break;
  392. }
  393. }
  394. public override void TurnSoftVentValve(ModuleName mod, bool bOn)
  395. {
  396. switch (mod)
  397. {
  398. case ModuleName.TM:
  399. _TMSoftVentValve.TurnValve(bOn, out string _);
  400. break;
  401. case ModuleName.VCE1:
  402. _VCESoftVentValve.TurnValve(bOn, out string _);
  403. break;
  404. }
  405. }
  406. public override bool CloseAllSlitDoor()
  407. {
  408. TurnSlitDoor(ModuleName.VCE1, false);
  409. if (_allInstalledModules.Contains("PMA"))
  410. TurnSlitDoor(ModuleName.PMA,false);
  411. if (_allInstalledModules.Contains("PMB"))
  412. TurnSlitDoor(ModuleName.PMB, false);
  413. if (_allInstalledModules.Contains("PMC"))
  414. TurnSlitDoor(ModuleName.PMC, false);
  415. return true;
  416. }
  417. public override void HomeVceSlitDoor()
  418. {
  419. //由SlitDoor的状态对其下发同样的指令
  420. if (VCESlitDoorClosed(ModuleName.VCE1) == true)
  421. TurnSlitDoor(ModuleName.VCE1, false);
  422. else
  423. TurnSlitDoor(ModuleName.VCE1, true);
  424. }
  425. public override void CloseVentValve()
  426. {
  427. _TMSoftVentValve.TurnValve(false, out _);
  428. _TMFastVentValve.TurnValve(false, out _);
  429. _VCESoftVentValve.TurnValve(false, out _);
  430. _VCEFastVentValve.TurnValve(false, out _);
  431. }
  432. public override bool CheckSlitValveOpen(ModuleName mod)
  433. {
  434. switch (mod)
  435. {
  436. case ModuleName.VCE1:
  437. return VCESlitDoorOpen;
  438. case ModuleName.PMA:
  439. return PMASlitDoorOpen;
  440. case ModuleName.PMB:
  441. return PMBSlitDoorOpen;
  442. case ModuleName.PMC:
  443. return PMCSlitDoorOpen;
  444. }
  445. return false;
  446. }
  447. public override bool CheckSlitValveClose(ModuleName mod)
  448. {
  449. switch (mod)
  450. {
  451. case ModuleName.VCE1:
  452. return VCESlitDoorClosed(ModuleName.VCE1);
  453. case ModuleName.PMA:
  454. return PMASlitDoorClosed;
  455. case ModuleName.PMB:
  456. return PMBSlitDoorClosed;
  457. case ModuleName.PMC:
  458. return PMCSlitDoorClosed;
  459. }
  460. return false;
  461. }
  462. public override bool CheckPumpValveClosed(ModuleName mod)
  463. {
  464. switch (mod)
  465. {
  466. case ModuleName.TM:
  467. return !IsTMFastPumpOpen && !IsTMSoftPumpOpen;
  468. case ModuleName.VCE1:
  469. return !IsVCEFastPumpOpen && !IsVCESoftPumpOpen;
  470. }
  471. return true;
  472. }
  473. public override bool CheckVentValveClosed(ModuleName mod)
  474. {
  475. switch (mod)
  476. {
  477. case ModuleName.TM:
  478. if (IsTMVentValveOpen)
  479. {
  480. LOG.Write(eEvent.ERR_TM, ModuleName.TM, "TM Vent Valve not closed");
  481. return false;
  482. }
  483. break;
  484. case ModuleName.VCE1:
  485. if (IsVCEVentValveOpen)
  486. {
  487. LOG.Write(eEvent.ERR_TM, ModuleName.VCE1, "VCE1 Vent Valve not closed");
  488. return false;
  489. }
  490. break;
  491. }
  492. return true;
  493. }
  494. public override void SetTMFlow(int flowValue)
  495. {
  496. _TMMfc.SetPoint = (flowValue);
  497. }
  498. public override double GetModulePressure(ModuleName mod)
  499. {
  500. switch (mod)
  501. {
  502. case ModuleName.TM:
  503. return TMPressure;
  504. case ModuleName.VCE1:
  505. return VCEPressure;
  506. }
  507. return 0.0;
  508. }
  509. public override bool TryGetPump(ModuleName mod)
  510. {
  511. //Self
  512. if ((mod == ModuleName.VCE1 && _PumpingState == PumpState.VCEUsing) || (mod == ModuleName.TM && _PumpingState == PumpState.TMUsing))
  513. return true;
  514. //Idle
  515. if (mod == ModuleName.TM && !IsTMFastPumpOpen && !IsTMSoftPumpOpen && _PumpingState == PumpState.Idle)
  516. {
  517. _PumpingState = PumpState.TMUsing;
  518. return true;
  519. }
  520. if (mod == ModuleName.VCE1 && !IsVCEFastPumpOpen && !IsVCESoftPumpOpen && _PumpingState == PumpState.Idle)
  521. {
  522. _PumpingState = PumpState.VCEUsing;
  523. return true;
  524. }
  525. LOG.Write(eEvent.WARN_DEFAULT_WARN, mod, "无法打开,另一个泵正在用!");
  526. //locked
  527. return false;
  528. }
  529. public override void ReleasePump(ModuleName Module)
  530. {
  531. //release pump (must do it by user)
  532. if ((Module == ModuleName.TM && _PumpingState == PumpState.TMUsing) || (Module == ModuleName.VCE1 && _PumpingState == PumpState.VCEUsing))
  533. _PumpingState = PumpState.Idle;
  534. }
  535. #endregion
  536. #region 工具方法
  537. private bool CanOpenSlitDoor(ModuleName mod,double MaxPressureDifference)
  538. {
  539. if (Singleton<RouteManager>.Instance.GetPM(mod) == null || RouteManager.IsATMMode)
  540. return true;
  541. else
  542. {
  543. double PMPressure = Singleton<RouteManager>.Instance.GetPM(mod).ChamberPressure;
  544. if (Math.Abs(_TMPressure.Value - PMPressure) <= MaxPressureDifference || (Singleton<RouteManager>.Instance.GetPM(mod).IsAtm && IsTMATM))
  545. {
  546. return true;
  547. }
  548. else
  549. {
  550. LOG.Write(eEvent.ERR_TM, ModuleName.TM, $"cannot open door cause pressure, TM Pressure:{_TMPressure.Value} and {mod} pressure:{PMPressure}");
  551. return false;
  552. }
  553. }
  554. }
  555. private double mbar2mtorrConvert(double mbar) => mbar * 0.75 * 1000;
  556. #endregion
  557. }
  558. }