VpwMainDevice.cs 42 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068
  1. using Aitex.Core.RT.DataCenter;
  2. using Aitex.Core.RT.Device;
  3. using Aitex.Core.RT.Log;
  4. using Aitex.Core.RT.OperationCenter;
  5. using Aitex.Core.RT.Routine;
  6. using Aitex.Core.RT.SCCore;
  7. using Aitex.Core.Util;
  8. using MECF.Framework.Common.Alarm;
  9. using MECF.Framework.Common.Algorithm;
  10. using MECF.Framework.Common.Beckhoff.ModuleIO;
  11. using MECF.Framework.Common.CommonData.Prewet;
  12. using MECF.Framework.Common.CommonData.Vpw;
  13. using MECF.Framework.Common.Equipment;
  14. using MECF.Framework.Common.IOCore;
  15. using MECF.Framework.Common.Persistent.Prewet;
  16. using MECF.Framework.Common.Persistent.VpwMain;
  17. using MECF.Framework.Common.ToolLayout;
  18. using PunkHPX8_Core;
  19. using PunkHPX8_RT.Devices.VpwCell;
  20. using PunkHPX8_RT.Modules;
  21. using PunkHPX8_RT.Modules.VpwCelMain;
  22. using PunkHPX8_RT.Modules.VpwMain;
  23. using SecsGem.Core.ItemModel;
  24. using System;
  25. using System.Collections.Generic;
  26. using System.Diagnostics;
  27. using System.Linq;
  28. using System.Net.NetworkInformation;
  29. using System.Reflection;
  30. using System.Text;
  31. using System.Threading.Tasks;
  32. using System.Windows.Media.Animation;
  33. namespace PunkHPX8_RT.Devices.VpwMain
  34. {
  35. public class VpwMainDevice : BaseDevice, IDevice
  36. {
  37. #region 常量
  38. private const string COMMON_DATA = "CommonData";
  39. private const string PERSISTENT_VALUE = "PersistentValue";
  40. private const string CHAMBER_CLOSED = "ChamberClosed";
  41. private const string CHAMBER_OPENED = "ChamberOpened";
  42. private const string CHAMBER_CLOSE = "ChamberClose";
  43. private const string LEAK_DETECTED = "LeakDetected";
  44. private const string VACUUM_PUMP_PRESSURE = "VacuumPumpPressure";
  45. private const string VACUUM_PUMP_POWER = "VacuumPumpPower";
  46. private const string VACUUM_PUMP_ENABLE = "VacuumPumpEnable";
  47. private const string VACUUM_PUMP_SPEED_ENABLE = "VacuumPumpSpeedEnable";
  48. private const string VACUUM_PUMP_SPEED = "VacuumPumpSpeed";
  49. private const string BOOSTER_PUMP_SPEED = "BoosterPumpSpeed";
  50. private const string BOOSTER_PUMP_CURRENT = "BoosterPumpCurrent";
  51. private const string BOOSTER_PUMP_ENABLE = "BoosterPumpEnable";
  52. private const string BOOSTER_PUMP_STATUS = "BoosterPumpStatus";
  53. private const string DIW_ENABLE = "DiwEnable";
  54. private const string DIW_PROCESS = "DiwProcess";
  55. private const string DIW_DEGAS = "DiwDegas";
  56. private const string DIW_TOTAL_FLOW = "DiwTotalFlow";
  57. private const string DIW_PRESSURE = "DiwPressure";
  58. private const string DEGAS_ADJUST = "DegasAdjust";
  59. private const string DEGAS_PURGE = "DegasPurge";
  60. private const string DEGAS_PUMP_ENABLE = "DegasPumpEnable";
  61. private const string DEGAS_PUMP_PRESSURE = "DegasPumpPressure";
  62. #endregion
  63. private enum VPWOperation
  64. {
  65. None,
  66. PumpEnable,
  67. PumpDisable,
  68. HomeAllRotation
  69. }
  70. #region 内部变量
  71. /// <summary>
  72. /// 变量是否初始化字典
  73. /// </summary>
  74. private Dictionary<string, bool> _variableInitializeDic = new Dictionary<string, bool>();
  75. /// <summary>
  76. /// 数据
  77. /// </summary>
  78. private VpwMainCommonData _commonData=new VpwMainCommonData();
  79. /// <summary>
  80. /// 持久性数值
  81. /// </summary>
  82. private VpwMainPersistentValue _vpwMainPersistentValue;
  83. /// <summary>
  84. /// Pump Enable routine
  85. /// </summary>
  86. private BoosterPumpEnableRoutine _boosterPumpEnableRoutine;
  87. /// <summary>
  88. /// Pump Disable routine
  89. /// </summary>
  90. private BoosterPumpDisableRoutine _boosterPumpDisableRoutine;
  91. /// <summary>
  92. /// 上一次Booster泵速
  93. /// </summary>
  94. private short _lastBoosterPumpSpeed = 0;
  95. /// <summary>
  96. /// 定时器任务
  97. /// </summary>
  98. private PeriodicJob _periodicJob;
  99. /// <summary>
  100. /// 是否数据完成初台化
  101. /// </summary>
  102. private bool _isDataInitialized;
  103. /// <summary>
  104. /// pdi控制中的p
  105. /// </summary>
  106. private double _pumpKp;
  107. /// <summary>
  108. /// pdi控制中的i
  109. /// </summary>
  110. private double _pumpKi;
  111. /// <summary>
  112. /// pdi控制中的d
  113. /// </summary>
  114. private double _pumpKd;
  115. /// <summary>
  116. /// flow pdi控制中的p
  117. /// </summary>
  118. private double _pumpFlowKp;
  119. /// <summary>
  120. /// flow pdi控制中的i
  121. /// </summary>
  122. private double _pumpFlowKi;
  123. /// <summary>
  124. /// flow pdi控制中的d
  125. /// </summary>
  126. private double _pumpFlowKd;
  127. /// <summary>
  128. /// Boost pump调速的目标类型
  129. /// </summary>
  130. private VPWBoostPumpTarget _boosterBoostPumpTarget;
  131. /// <summary>
  132. /// Boost pump目标流量
  133. /// </summary>
  134. private double _boosterTargetFlow;
  135. /// <summary>
  136. /// Cell Flow数值
  137. /// </summary>
  138. private double _cellFlow;
  139. /// <summary>
  140. /// 操作当前状态
  141. /// </summary>
  142. private RState _status;
  143. /// <summary>
  144. /// 当前操作
  145. /// </summary>
  146. private VPWOperation _currentOperation;
  147. /// <summary>
  148. /// 启动自动调泵速
  149. /// </summary>
  150. private bool _isStartAutoSpeed;
  151. /// <summary>
  152. /// Home 电机
  153. /// </summary>
  154. private VpwSimpleHomeRoutine _simpleHomeRoutine;
  155. /// <summary>
  156. /// 总流量计时器
  157. /// </summary>
  158. private Stopwatch _totalFlowWatch = new Stopwatch();
  159. /// <summary>
  160. /// 总流量上升沿
  161. /// </summary>
  162. private R_TRIG _totalFlowTrig = new R_TRIG();
  163. /// <summary>
  164. /// 检测到total flow 低于设定条件的时间
  165. /// </summary>
  166. private DateTime _totalFlowAbnormalDetectTime;
  167. /// <summary>
  168. /// 检测到cell flow 满足设定条件的时间
  169. /// </summary>
  170. private bool _totalFlowAbnormal;
  171. #endregion
  172. #region 属性
  173. /// <summary>
  174. /// 数据
  175. /// </summary>
  176. public VpwMainCommonData CommonData { get { return _commonData; } }
  177. /// <summary>
  178. /// Boost Pump目标类型
  179. /// </summary>
  180. public VPWBoostPumpTarget VPWBoostPumpTarget { set { _boosterBoostPumpTarget = value; } }
  181. /// <summary>
  182. /// Booster目标流量
  183. /// </summary>
  184. public double BoostTargetFlow { set { _boosterTargetFlow = value; } }
  185. /// <summary>
  186. /// Cell Flow
  187. /// </summary>
  188. public double CellFlow { set { _cellFlow = value; } }
  189. #endregion
  190. /// <summary>
  191. /// 构造函数
  192. /// </summary>
  193. /// <param name="moduleName"></param>
  194. public VpwMainDevice(string moduleName) : base(moduleName, moduleName, moduleName, moduleName)
  195. {
  196. }
  197. #region 初始化
  198. /// <summary>
  199. /// 初始化
  200. /// </summary>
  201. /// <returns></returns>
  202. public bool Initialize()
  203. {
  204. InitializeParameter();
  205. InitializeRoutine();
  206. SubscribeData();
  207. SubscribeValueAction();
  208. InitializeOperation();
  209. return true;
  210. }
  211. /// <summary>
  212. /// 初始化参数
  213. /// </summary>
  214. private void InitializeParameter()
  215. {
  216. _vpwMainPersistentValue = VpwMainPersistentManager.Instance.GetPersistentValue(Module);
  217. if (_vpwMainPersistentValue != null)
  218. {
  219. _lastBoosterPumpSpeed = _vpwMainPersistentValue.Speed;
  220. }
  221. else
  222. {
  223. LOG.WriteLog(eEvent.ERR_PREWET, Module, "Persistent Value Object is not exist");
  224. }
  225. _commonData.BoosterPumpPressureData = new MECF.Framework.Common.CommonData.CommonLimitData();
  226. }
  227. /// <summary>
  228. /// 初始化Routine
  229. /// </summary>
  230. private void InitializeRoutine()
  231. {
  232. _boosterPumpEnableRoutine = new BoosterPumpEnableRoutine(Module, this);
  233. _boosterPumpDisableRoutine = new BoosterPumpDisableRoutine(Module, this);
  234. _simpleHomeRoutine = new VpwSimpleHomeRoutine(Module.ToString());
  235. }
  236. /// <summary>
  237. /// 订阅
  238. /// </summary>
  239. private void SubscribeData()
  240. {
  241. DATA.Subscribe($"{Module}.{PERSISTENT_VALUE}", () => _vpwMainPersistentValue, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  242. DATA.Subscribe($"{Module}.{COMMON_DATA}", () => CommonData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  243. }
  244. /// <summary>
  245. /// 订阅数据
  246. /// </summary>
  247. private void SubscribeValueAction()
  248. {
  249. IoSubscribeUpdateVariable(CHAMBER_CLOSED);
  250. IoSubscribeUpdateVariable(CHAMBER_OPENED);
  251. IoSubscribeUpdateVariable(BOOSTER_PUMP_STATUS);
  252. IoSubscribeUpdateVariable(BOOSTER_PUMP_SPEED);
  253. IoSubscribeUpdateVariable(BOOSTER_PUMP_ENABLE);
  254. IoSubscribeUpdateVariable(BOOSTER_PUMP_CURRENT);
  255. IoSubscribeUpdateVariable(DEGAS_PURGE);
  256. IoSubscribeUpdateVariable(DEGAS_ADJUST);
  257. IoSubscribeUpdateVariable(DEGAS_PUMP_PRESSURE);
  258. IoSubscribeUpdateVariable(DEGAS_PUMP_ENABLE);
  259. IoSubscribeUpdateVariable(DIW_ENABLE);
  260. IoSubscribeUpdateVariable(DIW_PROCESS);
  261. IoSubscribeUpdateVariable(DIW_PRESSURE);
  262. IoSubscribeUpdateVariable(DIW_DEGAS);
  263. IoSubscribeUpdateVariable(DIW_TOTAL_FLOW);
  264. IoSubscribeUpdateVariable(VACUUM_PUMP_ENABLE);
  265. IoSubscribeUpdateVariable(VACUUM_PUMP_POWER);
  266. IoSubscribeUpdateVariable(VACUUM_PUMP_PRESSURE);
  267. IoSubscribeUpdateVariable(VACUUM_PUMP_SPEED);
  268. IoSubscribeUpdateVariable(VACUUM_PUMP_SPEED_ENABLE);
  269. IoSubscribeUpdateVariable(LEAK_DETECTED);
  270. }
  271. /// <summary>
  272. /// 初始化变量
  273. /// </summary>
  274. /// <param name="variable"></param>
  275. private void IoSubscribeUpdateVariable(string variable)
  276. {
  277. _variableInitializeDic[variable] = false;
  278. IOModuleManager.Instance.SubscribeModuleVariable(Module, variable, UpdateVariableValue);
  279. }
  280. /// <summary>
  281. /// 更新变量数值
  282. /// </summary>
  283. /// <param name="variable"></param>
  284. /// <param name="value"></param>
  285. private void UpdateVariableValue(string variable, object value)
  286. {
  287. if (!_commonData.IsDataInitialized)
  288. {
  289. _commonData.IsDataInitialized = true;
  290. _commonData.BoosterPumpModel = "Manual";
  291. }
  292. PropertyInfo property = _commonData.GetType().GetProperty(variable);
  293. if (property != null)
  294. {
  295. property.SetValue(_commonData, value);
  296. }
  297. if (_variableInitializeDic.ContainsKey(variable) && !_variableInitializeDic[variable])
  298. {
  299. _variableInitializeDic[variable] = true;
  300. }
  301. switch (variable)
  302. {
  303. case BOOSTER_PUMP_STATUS:
  304. string statusContent = _commonData.BoosterPumpStatus ? "On" : "Off";
  305. _commonData.BoosterPumpStatusContent = $"{_commonData.BoosterPumpModel}: {statusContent}";
  306. break;
  307. case DIW_PRESSURE:
  308. if (double.TryParse(value.ToString(), out var pressure))
  309. {
  310. _commonData.BoosterPumpPressureData.Value = pressure;
  311. }
  312. break;
  313. }
  314. }
  315. /// <summary>
  316. /// 初始化OP
  317. /// </summary>
  318. private void InitializeOperation()
  319. {
  320. OP.Subscribe($"{Module}.VacuumPumpPowerOn", (cmd,para)=> { return VacuumPumpPowerOn(); });
  321. OP.Subscribe($"{Module}.VacuumPumpPowerOff", (cmd, para) => { return VacuumPumpPowerOff(); });
  322. OP.Subscribe($"{Module}.VacuumPumpEnable", (cmd, para) => { return VacuumPumpEnable(); });
  323. OP.Subscribe($"{Module}.VacuumPumpDisable", (cmd, para) => { return VacuumPumpDisable(); });
  324. OP.Subscribe($"{Module}.VacuumPumpSpeedEnable", (cmd, para) => { return VacuumSpeedEnable(); });
  325. OP.Subscribe($"{Module}.VacuumPumpSpeedDisable", (cmd, para) => { return VacuumSpeedDisable(); });
  326. OP.Subscribe($"{Module}.VacuumPumpSpeed", (cmd, para) => { return WriteVacuumSpeedOperation(cmd, para); });
  327. OP.Subscribe($"{Module}.DegasPumpEnable", (cmd, para) => { return DegasPumpEnable(); });
  328. OP.Subscribe($"{Module}.DegasPumpDisable", (cmd, para) => { return DegasPumpDisable(); });
  329. OP.Subscribe($"{Module}.DegasAdjustOn", (cmd, para) => { return DegasAdjustOn(); });
  330. OP.Subscribe($"{Module}.DegasAdjustOff", (cmd, para) => { return DegasAdjustOff(); });
  331. OP.Subscribe($"{Module}.DegasPurgeOn", (cmd, para) => { return N2PurgeValveOn(); });
  332. OP.Subscribe($"{Module}.DegasPurgeOff", (cmd, para) => { return N2PurgeValveOff(); });
  333. OP.Subscribe($"{Module}.DiwDegasValveOn", (cmd, para) => { return DiwDegasValveOn(); });
  334. OP.Subscribe($"{Module}.DiwDegasValveOff", (cmd, para) => { return DiwDegasValveOff(); });
  335. OP.Subscribe($"{Module}.DiwEnable", (cmd, para) => { return DiwEnable(); });
  336. OP.Subscribe($"{Module}.DiwDisable", (cmd, para) => { return DiwDisable(); });
  337. OP.Subscribe($"{Module}.DiwProcessOn", (cmd, para) => { return DiwProcessOn(); });
  338. OP.Subscribe($"{Module}.DiwProcessOff", (cmd, para) => { return DiwProcessOff(); });
  339. OP.Subscribe($"{Module}.BoosterPumpEnable", BoosterPumpEnableOperation);
  340. OP.Subscribe($"{Module}.BoosterPumpDisable", BoosterPumpDisableOperation);
  341. OP.Subscribe($"{Module}.BoosterPumpSpeed", BoosterPumpSpeedKeyDownOperation);
  342. OP.Subscribe($"{Module}.ChamberUp", (cmd, para) => { return ChamberUp(); });
  343. OP.Subscribe($"{Module}.ChamberDown", (cmd, para) => { return ChamberDown(); });
  344. OP.Subscribe($"{Module}.BoosterPumpSpeedAuto", (cmd, para) => { return BoosterPumpSpeedAutoOperation(); });
  345. OP.Subscribe($"{Module}.BoosterPumpSpeedManual", (cmd, para) => { return BoosterPumpSpeedManualOperation(); });
  346. OP.Subscribe($"{Module}.DisabledAction", DisabledOperation);
  347. OP.Subscribe($"{Module}.ManualAction", ManualOperation);
  348. OP.Subscribe($"{Module}.AutoAction", AutoOperation);
  349. OP.Subscribe($"{Module}.EngineeringModeAction", EngineeringModeOperation);
  350. OP.Subscribe($"{Module}.ProductionModeAction", ProductionModeOperation);
  351. OP.Subscribe($"{Module}.HomeAllRotation", HomeAllRotation);
  352. }
  353. #endregion
  354. #region Action
  355. #region HomeAllRotation
  356. public bool HomeAllRotation(string cmd, object[] param)
  357. {
  358. if (_status == RState.Running)
  359. {
  360. LOG.WriteLog(eEvent.ERR_PREWET, Module.ToString(), $"{Module} current execute {_currentOperation},cannot home all rotation");
  361. return false;
  362. }
  363. _status = _simpleHomeRoutine.Start();
  364. _currentOperation = VPWOperation.HomeAllRotation;
  365. return _status == RState.Running;
  366. }
  367. #endregion
  368. #region Vacum Pump
  369. /// <summary>
  370. /// Pump Power On
  371. /// </summary>
  372. /// <returns></returns>
  373. public bool VacuumPumpPowerOn()
  374. {
  375. return WriteVariableValue(VACUUM_PUMP_POWER, true);
  376. }
  377. /// <summary>
  378. /// Pump Power Off
  379. /// </summary>
  380. /// <returns></returns>
  381. public bool VacuumPumpPowerOff()
  382. {
  383. return WriteVariableValue(VACUUM_PUMP_POWER, false);
  384. }
  385. /// <summary>
  386. /// Pump Enable
  387. /// </summary>
  388. /// <returns></returns>
  389. public bool VacuumPumpEnable()
  390. {
  391. return WriteVariableValue(VACUUM_PUMP_ENABLE, true);
  392. }
  393. /// <summary>
  394. /// Pump Disable
  395. /// </summary>
  396. /// <returns></returns>
  397. public bool VacuumPumpDisable()
  398. {
  399. return WriteVariableValue(VACUUM_PUMP_ENABLE, false);
  400. }
  401. /// <summary>
  402. /// Speed Enable
  403. /// </summary>
  404. /// <returns></returns>
  405. public bool VacuumSpeedEnable()
  406. {
  407. return WriteVariableValue(VACUUM_PUMP_SPEED_ENABLE, true);
  408. }
  409. /// <summary>
  410. /// Speed disable
  411. /// </summary>
  412. /// <returns></returns>
  413. public bool VacuumSpeedDisable()
  414. {
  415. return WriteVariableValue(VACUUM_PUMP_SPEED_ENABLE, false);
  416. }
  417. /// <summary>
  418. /// 写入Vacuum速度
  419. /// </summary>
  420. /// <param name="speed"></param>
  421. /// <returns></returns>
  422. private bool WriteVacuumSpeedOperation(string cmd, object[] param)
  423. {
  424. if (short.TryParse(param[0].ToString(), out var speed))
  425. {
  426. return WriteVariableValue(VACUUM_PUMP_SPEED, speed);
  427. }
  428. else
  429. {
  430. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"Write VacuumSpeed {param[0]} is not short");
  431. return false;
  432. }
  433. }
  434. /// <summary>
  435. /// 写入速度
  436. /// </summary>
  437. /// <param name="speed"></param>
  438. /// <returns></returns>
  439. public bool WriteVacuumSpeed(short speed)
  440. {
  441. return WriteVariableValue(VACUUM_PUMP_SPEED, speed);
  442. }
  443. #endregion
  444. #region Degas Pump
  445. /// <summary>
  446. /// Degas Pump Enable
  447. /// </summary>
  448. /// <returns></returns>
  449. public bool DegasPumpEnable()
  450. {
  451. return WriteVariableValue(DEGAS_PUMP_ENABLE, true);
  452. }
  453. /// <summary>
  454. /// Degas Pump disable
  455. /// </summary>
  456. /// <returns></returns>
  457. public bool DegasPumpDisable()
  458. {
  459. return WriteVariableValue(DEGAS_PUMP_ENABLE, false);
  460. }
  461. /// <summary>
  462. /// Degas Adjust On
  463. /// </summary>
  464. /// <returns></returns>
  465. public bool DegasAdjustOn()
  466. {
  467. return WriteVariableValue(DEGAS_ADJUST, true);
  468. }
  469. /// <summary>
  470. /// Degas Adjust Off
  471. /// </summary>
  472. /// <returns></returns>
  473. public bool DegasAdjustOff()
  474. {
  475. return WriteVariableValue(DEGAS_ADJUST, false);
  476. }
  477. #endregion
  478. #region Booster Pump
  479. /// <summary>
  480. /// Pump Enable操作
  481. /// </summary>
  482. /// <param name="cmd"></param>
  483. /// <param name="param"></param>
  484. /// <returns></returns>
  485. public bool BoosterPumpEnableOperation(string cmd, object[] param)
  486. {
  487. if (_status == RState.Running)
  488. {
  489. LOG.WriteLog(eEvent.ERR_PREWET, Module.ToString(), $"{Module} current execute {_currentOperation},cannot Pump enable");
  490. return false;
  491. }
  492. _status = _boosterPumpEnableRoutine.Start();
  493. _currentOperation = VPWOperation.PumpEnable;
  494. return _status == RState.Running;
  495. }
  496. /// <summary>
  497. /// pump disable 操作
  498. /// </summary>
  499. /// <param name="cmd"></param>
  500. /// <param name="param"></param>
  501. /// <returns></returns>
  502. public bool BoosterPumpDisableOperation(string cmd, object[] param)
  503. {
  504. if (_status == RState.Running)
  505. {
  506. LOG.WriteLog(eEvent.ERR_PREWET, Module.ToString(), $"{Module} current execute {_currentOperation},cannot Pump disable");
  507. return false;
  508. }
  509. _status = _boosterPumpDisableRoutine.Start();
  510. _currentOperation = VPWOperation.PumpDisable;
  511. return _status == RState.Running;
  512. //return PumpDisable();
  513. }
  514. /// <summary>
  515. /// Booster Pump enable
  516. /// </summary>
  517. /// <returns></returns>
  518. public bool BoosterPumpEnable()
  519. {
  520. return WriteVariableValue(BOOSTER_PUMP_ENABLE, true);
  521. }
  522. /// <summary>
  523. /// Booster Pump Disable
  524. /// </summary>
  525. /// <returns></returns>
  526. public bool BoosterPumpDisable()
  527. {
  528. return WriteVariableValue(BOOSTER_PUMP_ENABLE, false);
  529. }
  530. /// <summary>
  531. /// 写入Booster泵速
  532. /// </summary>
  533. /// <param name="speed"></param>
  534. /// <returns></returns>
  535. public bool BoosterPumpSpeed(short speed=0)
  536. {
  537. return WriteVariableValue(BOOSTER_PUMP_SPEED, speed == 0 ? _lastBoosterPumpSpeed : speed);
  538. }
  539. /// Booster Pump Speed回车操作
  540. /// </summary>
  541. /// <param name="cmd"></param>
  542. /// <param name="param"></param>
  543. /// <returns></returns>
  544. private bool BoosterPumpSpeedKeyDownOperation(string cmd, object[] param)
  545. {
  546. if (_commonData.BoosterPumpSpeedAuto)
  547. {
  548. LOG.WriteLog(eEvent.ERR_PREWET, Module, "Pump speed is auto,cannot change speed");
  549. return false;
  550. }
  551. short speed = (short)param[0];
  552. bool result = BoosterPumpSpeed(speed);
  553. if (result)
  554. {
  555. _vpwMainPersistentValue.Speed = speed;
  556. _lastBoosterPumpSpeed = speed;
  557. VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
  558. }
  559. return true;
  560. }
  561. /// <summary>
  562. /// Pump Speed手动模式
  563. /// </summary>
  564. /// <param name="cmd"></param>
  565. /// <param name="param"></param>
  566. /// <returns></returns>
  567. private bool BoosterPumpSpeedManualOperation()
  568. {
  569. _commonData.BoosterPumpSpeedAuto = false;
  570. _commonData.BoosterPumpModel = "Manual";
  571. string statusContent = _commonData.BoosterPumpStatus ? "On" : "Off";
  572. _commonData.BoosterPumpStatusContent = $"{_commonData.BoosterPumpModel}: {statusContent}";
  573. return true;
  574. }
  575. /// <summary>
  576. /// Pump Speed自动模式
  577. /// </summary>
  578. /// <param name="cmd"></param>
  579. /// <param name="param"></param>
  580. /// <returns></returns>
  581. private bool BoosterPumpSpeedAutoOperation()
  582. {
  583. _commonData.BoosterPumpSpeedAuto = true;
  584. _commonData.BoosterPumpModel = "Auto";
  585. string statusContent = _commonData.BoosterPumpStatus ? "On" : "Off";
  586. _commonData.BoosterPumpStatusContent = $"{_commonData.BoosterPumpModel}: {statusContent}";
  587. return true;
  588. }
  589. #endregion
  590. #region Chamber
  591. /// <summary>
  592. /// 上升
  593. /// </summary>
  594. /// <returns></returns>
  595. public bool ChamberUp()
  596. {
  597. return WriteVariableValue(CHAMBER_CLOSE, true);
  598. }
  599. /// <summary>
  600. /// 下降
  601. /// </summary>
  602. /// <returns></returns>
  603. public bool ChamberDown()
  604. {
  605. return WriteVariableValue(CHAMBER_CLOSE, false);
  606. }
  607. #endregion
  608. #region Mode switch
  609. /// <summary>
  610. /// DisabledAction
  611. /// </summary>
  612. /// <param name="cmd"></param>
  613. /// <param name="param"></param>
  614. /// <returns></returns>
  615. private bool DisabledOperation(string cmd, object[] args)
  616. {
  617. string currentOperation = "Disabled";
  618. VpwMainEntity vpwMainEntity = Singleton<RouteManager>.Instance.GetModule<VpwMainEntity>(Module);
  619. if (vpwMainEntity != null && _vpwMainPersistentValue != null && _vpwMainPersistentValue.OperatingMode != currentOperation)
  620. {
  621. string preOperation = _vpwMainPersistentValue.OperatingMode;
  622. if (vpwMainEntity.IsBusy)
  623. {
  624. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Disabled mode");
  625. return false;
  626. }
  627. vpwMainEntity.EnterInit();
  628. _vpwMainPersistentValue.OperatingMode = currentOperation;
  629. LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  630. }
  631. VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
  632. return true;
  633. }
  634. /// <summary>
  635. /// ManualAction
  636. /// </summary>
  637. /// <param name="cmd"></param>
  638. /// <param name="param"></param>
  639. /// <returns></returns>
  640. private bool ManualOperation(string cmd, object[] args)
  641. {
  642. string currentOperation = "Manual";
  643. VpwMainEntity vpwMainEntity = Singleton<RouteManager>.Instance.GetModule<VpwMainEntity>(Module);
  644. if (vpwMainEntity != null && _vpwMainPersistentValue != null && _vpwMainPersistentValue.OperatingMode != currentOperation)
  645. {
  646. string preOperation = _vpwMainPersistentValue.OperatingMode;
  647. if (vpwMainEntity.IsBusy)
  648. {
  649. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Manual mode");
  650. return false;
  651. }
  652. vpwMainEntity.EnterInit();
  653. _vpwMainPersistentValue.OperatingMode = currentOperation;
  654. _boosterBoostPumpTarget = VPWBoostPumpTarget.Pressure;
  655. LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  656. }
  657. VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
  658. return true;
  659. }
  660. /// <summary>
  661. /// AutoAction
  662. /// </summary>
  663. /// <param name="cmd"></param>
  664. /// <param name="param"></param>
  665. /// <returns></returns>
  666. private bool AutoOperation(string cmd, object[] args)
  667. {
  668. string currentOperation = "Auto";
  669. VpwMainEntity vpwMainEntity = Singleton<RouteManager>.Instance.GetModule<VpwMainEntity>(Module);
  670. if (vpwMainEntity != null && _vpwMainPersistentValue != null && _vpwMainPersistentValue.OperatingMode != currentOperation)
  671. {
  672. string preOperation = _vpwMainPersistentValue.OperatingMode;
  673. if (vpwMainEntity.IsBusy)
  674. {
  675. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Auto mode");
  676. return false;
  677. }
  678. vpwMainEntity.EnterInit();
  679. _vpwMainPersistentValue.OperatingMode = currentOperation;
  680. LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  681. }
  682. VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
  683. return true;
  684. }
  685. /// <summary>
  686. /// EngineeringModeAction
  687. /// </summary>
  688. /// <param name="cmd"></param>
  689. /// <param name="param"></param>
  690. /// <returns></returns>
  691. private bool EngineeringModeOperation(string cmd, object[] args)
  692. {
  693. string currentRecipeOperation = "Engineering";
  694. if (_vpwMainPersistentValue != null)
  695. {
  696. _vpwMainPersistentValue.RecipeOperatingMode = currentRecipeOperation;
  697. }
  698. VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
  699. return true;
  700. }
  701. /// <summary>
  702. /// ProductionAction
  703. /// </summary>
  704. /// <param name="cmd"></param>
  705. /// <param name="param"></param>
  706. /// <returns></returns>
  707. private bool ProductionModeOperation(string cmd, object[] args)
  708. {
  709. string currentRecipeOperation = "Production";
  710. if (_vpwMainPersistentValue != null)
  711. {
  712. _vpwMainPersistentValue.RecipeOperatingMode = currentRecipeOperation;
  713. }
  714. VpwMainPersistentManager.Instance.UpdatePersistentValue(Module);
  715. return true;
  716. }
  717. #endregion
  718. #region DIW
  719. /// <summary>
  720. /// DIW Enable
  721. /// </summary>
  722. /// <returns></returns>
  723. public bool DiwEnable()
  724. {
  725. return WriteVariableValue(DIW_ENABLE, true);
  726. }
  727. /// <summary>
  728. /// DIW Disable
  729. /// </summary>
  730. /// <returns></returns>
  731. public bool DiwDisable()
  732. {
  733. return WriteVariableValue(DIW_ENABLE, false);
  734. }
  735. /// <summary>
  736. /// DIW Process On
  737. /// </summary>
  738. /// <returns></returns>
  739. public bool DiwProcessOn()
  740. {
  741. return WriteVariableValue(DIW_PROCESS, true);
  742. }
  743. /// <summary>
  744. /// DIW Process On
  745. /// </summary>
  746. /// <returns></returns>
  747. public bool DiwProcessOff()
  748. {
  749. return WriteVariableValue(DIW_PROCESS, false);
  750. }
  751. /// <summary>
  752. /// DIW Degas Valve On
  753. /// </summary>
  754. /// <returns></returns>
  755. public bool DiwDegasValveOn()
  756. {
  757. return WriteVariableValue(DIW_DEGAS, true);
  758. }
  759. /// <summary>
  760. /// DIW Degas Valve Off
  761. /// </summary>
  762. /// <returns></returns>
  763. public bool DiwDegasValveOff()
  764. {
  765. return WriteVariableValue(DIW_DEGAS, false);
  766. }
  767. #endregion
  768. #region N2Purge
  769. /// <summary>
  770. /// 打开N2 Purge
  771. /// </summary>
  772. /// <returns></returns>
  773. public bool N2PurgeValveOn()
  774. {
  775. return WriteVariableValue(DEGAS_PURGE, true);
  776. }
  777. /// <summary>
  778. /// 关闭N2 Purge
  779. /// </summary>
  780. /// <returns></returns>
  781. public bool N2PurgeValveOff()
  782. {
  783. return WriteVariableValue(DEGAS_PURGE, false);
  784. }
  785. #endregion
  786. /// <summary>
  787. /// 写变量
  788. /// </summary>
  789. /// <param name="variable"></param>
  790. /// <param name="value"></param>
  791. /// <returns></returns>
  792. private bool WriteVariableValue(string variable, object value)
  793. {
  794. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{variable}");
  795. return IOModuleManager.Instance.WriteIoValue(ioName, value);
  796. }
  797. #endregion
  798. /// <summary>
  799. /// 定时器
  800. /// </summary>
  801. /// <returns></returns>
  802. public bool OnTimer()
  803. {
  804. _commonData.BoosterPumpPressureData.MinError = SC.GetValue<double>($"VPWMain.PumpPressure.Error_Min");
  805. _commonData.BoosterPumpPressureData.MinWarning = SC.GetValue<double>($"VPWMain.PumpPressure.Warning_Min");
  806. _commonData.BoosterPumpPressureData.MaxError = SC.GetValue<double>($"VPWMain.PumpPressure.Error_Max");
  807. _commonData.BoosterPumpPressureData.MaxWarning = SC.GetValue<double>($"VPWMain.PumpPressure.Warning_Max");
  808. _commonData.PressureTarget = SC.GetValue<double>($"VPWMain.PressureTarget");
  809. if (_status == RState.Running)
  810. {
  811. IRoutine routine = GetCurrentRoutine();
  812. if (routine != null)
  813. {
  814. RState rsState = routine.Monitor();
  815. if (rsState == RState.Failed || rsState == RState.Timeout)
  816. {
  817. _status = RState.Failed;
  818. _currentOperation = VPWOperation.None;
  819. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module.ToString(), $"{_currentOperation} error");
  820. _isStartAutoSpeed = false;
  821. }
  822. else if (rsState == RState.End)
  823. {
  824. if (_currentOperation == VPWOperation.PumpEnable)
  825. {
  826. _isStartAutoSpeed = true;
  827. }
  828. else if (_currentOperation == VPWOperation.PumpDisable)
  829. {
  830. _isStartAutoSpeed = false;
  831. }
  832. _status = RState.End;
  833. _currentOperation = VPWOperation.None;
  834. }
  835. }
  836. }
  837. if (_isStartAutoSpeed)
  838. {
  839. AdjustPumpSpeed();
  840. }
  841. MonitorTotalFlow();
  842. BoosterPumpMonitor();
  843. WaterPressureMonitor();
  844. return true;
  845. }
  846. //Speed Auto模式同时pump enbled,对water pressure 上下限进行监控
  847. private void WaterPressureMonitor()
  848. {
  849. if (_commonData.BoosterPumpSpeedAuto && _commonData.BoosterPumpEnable)
  850. {
  851. if(_commonData.DiwPressure > _commonData.BoosterPumpPressureData.MaxError)
  852. {
  853. LOG.WriteLog(eEvent.ERR_VPW, Module, $"water pressure {_commonData.DiwPressure} is large than Error_max {_commonData.BoosterPumpPressureData.MaxError},Booster Pump Closed!");
  854. BoosterPumpDisable();
  855. }
  856. else if (_commonData.DiwPressure > _commonData.BoosterPumpPressureData.MaxWarning)
  857. {
  858. if(!AlarmListManager.Instance.IsContainDataWarn(Module, "WaterPressure"))
  859. {
  860. AlarmListManager.Instance.AddWarn(Module, "WaterPressure", $"water pressure {_commonData.DiwPressure} is large than Warning_max {_commonData.BoosterPumpPressureData.MaxWarning}");
  861. LOG.WriteLog(eEvent.WARN_VPW, Module, $"water pressure {_commonData.DiwPressure} is large than Warning_max {_commonData.BoosterPumpPressureData.MaxWarning}");
  862. }
  863. }
  864. else if (_commonData.DiwPressure < _commonData.BoosterPumpPressureData.MinError)
  865. {
  866. LOG.WriteLog(eEvent.ERR_VPW, Module, $"water pressure {_commonData.DiwPressure} is lower than Error_min {_commonData.BoosterPumpPressureData.MinError},Booster Pump Closed!");
  867. BoosterPumpDisable();
  868. }
  869. else if (_commonData.DiwPressure < _commonData.BoosterPumpPressureData.MinWarning)
  870. {
  871. if (!AlarmListManager.Instance.IsContainDataWarn(Module, "WaterPressure"))
  872. {
  873. AlarmListManager.Instance.AddWarn(Module, "WaterPressure", $"water pressure {_commonData.DiwPressure} is large than Warning_min {_commonData.BoosterPumpPressureData.MinWarning}");
  874. LOG.WriteLog(eEvent.WARN_VPW, Module, $"water pressure {_commonData.DiwPressure} is lower than Warning_min {_commonData.BoosterPumpPressureData.MinWarning}");
  875. }
  876. }
  877. }
  878. }
  879. //total flow不满足条件过一段时间自动关闭增压泵
  880. private void BoosterPumpMonitor()
  881. {
  882. double totalFlowStartLimit = SC.GetValue<double>("VPWMain.Plumbing.TotalFlowStartLowLimit");
  883. int flowFaultHoldOffTime = SC.GetValue<int>($"VPWMain.Plumbing.FlowFaultHoldoffTime");
  884. if (_commonData.DiwTotalFlow < totalFlowStartLimit)
  885. {
  886. if (!_totalFlowAbnormal)
  887. {
  888. _totalFlowAbnormal = true;
  889. _totalFlowAbnormalDetectTime = DateTime.Now;
  890. }
  891. if ((DateTime.Now - _totalFlowAbnormalDetectTime).TotalSeconds > flowFaultHoldOffTime && _commonData.BoosterPumpEnable)
  892. {
  893. LOG.WriteLog(eEvent.WARN_VPW, Module, $"total flow is lower than start limit more than {flowFaultHoldOffTime} min,Booster Pump Closed!");
  894. BoosterPumpDisable();
  895. _totalFlowAbnormalDetectTime = DateTime.Now;
  896. }
  897. }
  898. else
  899. {
  900. _totalFlowAbnormal = false;
  901. }
  902. }
  903. /// <summary>
  904. /// 调速
  905. /// </summary>
  906. public void AdjustPumpSpeed()
  907. {
  908. //Speed Auto模式同时pump enbled,根据kdi调整泵速
  909. if (_commonData.BoosterPumpSpeedAuto && _commonData.BoosterPumpEnable)
  910. {
  911. _pumpKp = SC.GetValue<double>($"VPWMain.PumpKp");
  912. _pumpKd = SC.GetValue<double>($"VPWMain.PumpKd");
  913. _pumpKi = SC.GetValue<double>($"VPWMain.PumpKi");
  914. double limit = SC.GetValue<double>("VPWMain.PrewetTargetLimit");
  915. double downLimit = SC.GetValue<double>("VPWMain.PrewetDownTargetLimit");
  916. double minSpeedDelta = SC.GetValue<double>("VPWMain.MinSpeedDelta");
  917. short speed = 0;
  918. if (_boosterBoostPumpTarget == VPWBoostPumpTarget.Pressure)
  919. {
  920. speed= PdiAlgorithm.Instance.CalculateSpeed(_pumpKp, _pumpKi, _pumpKd, _commonData.PressureTarget,
  921. _commonData.BoosterPumpPressureData.Value, _lastBoosterPumpSpeed, limit, downLimit, minSpeedDelta);
  922. }
  923. else
  924. {
  925. speed= PdiAlgorithm.Instance.CalculateSpeed(_pumpFlowKp, _pumpFlowKi, _pumpFlowKd, _boosterTargetFlow,
  926. _cellFlow, _lastBoosterPumpSpeed, limit, downLimit, minSpeedDelta);
  927. }
  928. //short speed = PdiAlgorithm.Instance.CalculateSpeed(PrewetPumpData.PressureTarget, PrewetPumpData.PumpPressureData.Value,
  929. // _lastPumpSpeed, limit, downLimit);
  930. if (Math.Abs(speed - _lastBoosterPumpSpeed) >= 1)
  931. {
  932. _lastBoosterPumpSpeed = speed;
  933. BoosterPumpSpeed(speed);
  934. }
  935. }
  936. }
  937. /// <summary>
  938. /// 当前Routine;
  939. /// </summary>
  940. /// <returns></returns>
  941. private IRoutine GetCurrentRoutine()
  942. {
  943. switch (_currentOperation)
  944. {
  945. case VPWOperation.PumpEnable:
  946. return _boosterPumpEnableRoutine;
  947. case VPWOperation.PumpDisable:
  948. return _boosterPumpDisableRoutine;
  949. case VPWOperation.HomeAllRotation:
  950. return _simpleHomeRoutine;
  951. default:
  952. return null;
  953. }
  954. }
  955. /// <summary>
  956. /// 监控总流量
  957. /// </summary>
  958. private void MonitorTotalFlow()
  959. {
  960. double totalFlow = _commonData.DiwTotalFlow;
  961. double totalFlowStartLimit = SC.GetValue<double>("VPWMain.Plumbing.TotalFlowStartLowLimit");
  962. int dripValveOpenIdlePeriod = SC.GetValue<int>("VPWMain.DripValveOpenIdlePeriod")*60*1000;
  963. if (dripValveOpenIdlePeriod == 0)
  964. {
  965. return;
  966. }
  967. if (totalFlow < totalFlowStartLimit&&_totalFlowWatch.IsRunning)
  968. {
  969. LOG.WriteLog(eEvent.INFO_VPW, Module, $"total flow is less then start limit");
  970. _totalFlowWatch.Stop();
  971. return;
  972. }
  973. _totalFlowTrig.CLK = totalFlow >= totalFlowStartLimit;
  974. if (_totalFlowTrig.Q)
  975. {
  976. LOG.WriteLog(eEvent.INFO_VPW, Module, $"total flow is over start limit");
  977. _totalFlowWatch.Start();
  978. }
  979. if (_totalFlowWatch.ElapsedMilliseconds >= dripValveOpenIdlePeriod)
  980. {
  981. LOG.WriteLog(eEvent.INFO_VPW, Module, $"the time of total flow is over DripValveOpenIdlePeriod");
  982. List<VpwCellDevice> vpwCellDevices = new List<VpwCellDevice>();
  983. VpwMainItem vpwMainItem = VpwMainItemManager.Instance.GetItem(ModuleName.VPWMain1.ToString());
  984. if (vpwMainItem == null || vpwMainItem.VpwCells == null)
  985. {
  986. return;
  987. }
  988. foreach (var item in vpwMainItem.VpwCells)
  989. {
  990. VpwCellDevice cellDevice = DEVICE.GetDevice<VpwCellDevice>(item.ModuleName);
  991. vpwCellDevices.Add(cellDevice);
  992. }
  993. _totalFlowWatch.Reset();
  994. foreach (var item in vpwCellDevices)
  995. {
  996. VpwCellEntity vpwCellEntity = Singleton<RouteManager>.Instance.GetModule<VpwCellEntity>(item.Module);
  997. if (vpwCellEntity == null || vpwCellEntity.IsDisable)
  998. {
  999. continue;
  1000. }
  1001. if (item.CommonData.FlowDrip)
  1002. {
  1003. continue;
  1004. }
  1005. item.FlowDripOn();
  1006. LOG.WriteLog(eEvent.INFO_VPW, Module, $"{item.Module} open drip valve after DripValveOpenIdlePeriod");
  1007. }
  1008. }
  1009. }
  1010. /// <summary>
  1011. /// 监控
  1012. /// </summary>
  1013. public void Monitor()
  1014. {
  1015. }
  1016. public void Reset()
  1017. {
  1018. }
  1019. public void Terminate()
  1020. {
  1021. }
  1022. }
  1023. }