SunWayDETM.cs 35 KB

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