VpwMainDevice.cs 41 KB

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