VpwMainDevice.cs 43 KB

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