HongHuDETM.cs 33 KB

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