HongHuDETM.cs 36 KB

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