VpwCellDevice.cs 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598
  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.Util;
  6. using MECF.Framework.Common.Beckhoff.ModuleIO;
  7. using MECF.Framework.Common.CommonData.Prewet;
  8. using MECF.Framework.Common.CommonData.Vpw;
  9. using MECF.Framework.Common.IOCore;
  10. using MECF.Framework.Common.Persistent.SRD;
  11. using MECF.Framework.Common.Persistent.Temperature;
  12. using MECF.Framework.Common.Persistent.VpwCell;
  13. using MECF.Framework.Common.Persistent.VpwMain;
  14. using MECF.Framework.Common.ToolLayout;
  15. using MECF.Framework.Common.Utilities;
  16. using PunkHPX8_RT.Devices.AXIS;
  17. using PunkHPX8_RT.Devices.Resistivity;
  18. using PunkHPX8_RT.Devices.VpwMain;
  19. using PunkHPX8_RT.Modules;
  20. using PunkHPX8_RT.Modules.VpwMain;
  21. using System;
  22. using System.Collections.Generic;
  23. using System.Linq;
  24. using System.Reflection;
  25. using System.Text;
  26. using System.Threading.Tasks;
  27. namespace PunkHPX8_RT.Devices.VpwCell
  28. {
  29. public class VpwCellDevice : BaseDevice, IDevice
  30. {
  31. #region 常量
  32. private const string COMMON_DATA = "CommonData";
  33. private const string DIW_FLOW = "DiwFlow";
  34. private const string VACUUM_PRESSURE = "VacuumPressure";
  35. private const string FLOW_DRIP = "FlowDrip";
  36. private const string FLOW_SMALL = "FlowSmall";
  37. private const string FLOW_LARGE = "FlowLarge";
  38. private const string VACUUM_VALVE = "VacuumValve";
  39. private const string VENT_VALVE = "VentValve";
  40. private const string DRAIN_VALVE = "DrainValve";
  41. private const string PERSISTENT_VALUE = "PersistentValue";
  42. private const string LOOPDO_VALUE = "LoopDoValue";
  43. #endregion
  44. #region 内部变量
  45. /// <summary>
  46. /// 变量是否初始化字典
  47. /// </summary>
  48. private Dictionary<string, bool> _variableInitializeDic = new Dictionary<string, bool>();
  49. /// <summary>
  50. /// 数据
  51. /// </summary>
  52. private VpwCellCommonData _commonData=new VpwCellCommonData();
  53. /// Vpw main数据
  54. /// </summary>
  55. private VpwMainCommonData _mainCommonData = new VpwMainCommonData();
  56. /// <summary>
  57. /// 持久性数值
  58. /// </summary>
  59. private VpwCellPersistentValue _vpwCellPersistentValue;
  60. /// <summary>
  61. /// 水平电机
  62. /// </summary>
  63. private JetAxisBase _rotationAxis;
  64. /// <summary>
  65. /// 水阻计控制器
  66. /// </summary>
  67. private ResistivityController _resistivityController;
  68. /// <summary>
  69. /// 水阻值
  70. /// </summary>
  71. private double _resistivityValue;
  72. /// <summary>
  73. /// main device
  74. /// </summary>
  75. private VpwMainDevice _vpwMainDevice;
  76. #endregion
  77. #region 属性
  78. /// <summary>
  79. /// 数据
  80. /// </summary>
  81. public VpwCellCommonData CommonData { get { return _commonData; } }
  82. /// <summary>
  83. /// vpw main数据
  84. /// </summary>
  85. public VpwMainCommonData MainCommonData { get { return _mainCommonData; } }
  86. /// <summary>
  87. /// 操作模式
  88. /// </summary>
  89. public string OperationMode { get { return _vpwCellPersistentValue.OperatingMode; } }
  90. /// <summary>
  91. /// 工程模式
  92. /// </summary>
  93. public string EngineerMode { get { return _vpwCellPersistentValue.RecipeOperatingMode; } }
  94. /// <summary>
  95. /// LoopDO数值
  96. /// </summary>
  97. public double LoopDOValue { get { return GetLoopDOValue(); } }
  98. #endregion
  99. /// <summary>
  100. /// 构造函数
  101. /// </summary>
  102. /// <param name="moduleName"></param>
  103. public VpwCellDevice(string moduleName) : base(moduleName, moduleName, moduleName, moduleName)
  104. {
  105. }
  106. #region 初始化
  107. /// <summary>
  108. /// 初始化
  109. /// </summary>
  110. /// <returns></returns>
  111. public bool Initialize()
  112. {
  113. InitializeParameter();
  114. InitializeRoutine();
  115. SubscribeData();
  116. SubscribeValueAction();
  117. InitializeOperation();
  118. return true;
  119. }
  120. /// <summary>
  121. /// 初始化参数
  122. /// </summary>
  123. private void InitializeParameter()
  124. {
  125. _rotationAxis = DEVICE.GetDevice<JetAxisBase>($"{Module}.Rotation");
  126. _vpwCellPersistentValue = VpwCellPersistentManager.Instance.GetPersistentValue(Module);
  127. VpwCellItem vpwCellItem=VpwCellItemManager.Instance.GetVpwItem(Module);
  128. if (vpwCellItem != null)
  129. {
  130. _resistivityController = DEVICE.GetDevice<ResistivityController>(vpwCellItem.ResistivityID);
  131. }
  132. _vpwMainDevice = DEVICE.GetDevice<VpwMainDevice>($"VPWMain1");
  133. if(_vpwMainDevice != null)
  134. {
  135. _mainCommonData = _vpwMainDevice.CommonData;
  136. }
  137. }
  138. /// <summary>
  139. /// 初始化Routine
  140. /// </summary>
  141. private void InitializeRoutine()
  142. {
  143. }
  144. /// <summary>
  145. /// 订阅
  146. /// </summary>
  147. private void SubscribeData()
  148. {
  149. DATA.Subscribe($"{Module}.{COMMON_DATA}", () => CommonData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  150. DATA.Subscribe($"{Module}.{PERSISTENT_VALUE}", () => _vpwCellPersistentValue, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  151. DATA.Subscribe($"{Module}.DiwCellFlow", () => CommonData.DiwFlow, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  152. DATA.Subscribe($"{Module}.{LOOPDO_VALUE}", ()=> { return GetLoopDOValue(); }, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  153. }
  154. /// <summary>
  155. /// 获取Loop do数值
  156. /// </summary>
  157. /// <returns></returns>
  158. private double GetLoopDOValue()
  159. {
  160. if (_resistivityController != null)
  161. {
  162. string value = _resistivityController.ResisitivityValue;
  163. if (double.TryParse(value, out _resistivityValue))
  164. {
  165. return _resistivityValue;
  166. }
  167. else
  168. {
  169. _resistivityValue = 0;
  170. return 0;
  171. }
  172. }
  173. else
  174. {
  175. return 0;
  176. }
  177. }
  178. /// <summary>
  179. /// 订阅数据
  180. /// </summary>
  181. private void SubscribeValueAction()
  182. {
  183. IoSubscribeUpdateVariable(DIW_FLOW);
  184. IoSubscribeUpdateVariable(DRAIN_VALVE);
  185. IoSubscribeUpdateVariable(VACUUM_PRESSURE);
  186. IoSubscribeUpdateVariable(VACUUM_VALVE);
  187. IoSubscribeUpdateVariable(VENT_VALVE);
  188. IoSubscribeUpdateVariable(FLOW_DRIP);
  189. IoSubscribeUpdateVariable(FLOW_LARGE);
  190. IoSubscribeUpdateVariable(FLOW_SMALL);
  191. }
  192. /// <summary>
  193. /// 初始化变量
  194. /// </summary>
  195. /// <param name="variable"></param>
  196. private void IoSubscribeUpdateVariable(string variable)
  197. {
  198. _variableInitializeDic[variable] = false;
  199. IOModuleManager.Instance.SubscribeModuleVariable(Module, variable, UpdateVariableValue);
  200. }
  201. /// <summary>
  202. /// 更新变量数值
  203. /// </summary>
  204. /// <param name="variable"></param>
  205. /// <param name="value"></param>
  206. private void UpdateVariableValue(string variable, object value)
  207. {
  208. PropertyInfo property = _commonData.GetType().GetProperty(variable);
  209. if (property != null)
  210. {
  211. property.SetValue(_commonData, value);
  212. }
  213. if (_variableInitializeDic.ContainsKey(variable) && !_variableInitializeDic[variable])
  214. {
  215. _variableInitializeDic[variable] = true;
  216. }
  217. }
  218. /// <summary>
  219. /// 初始化OP
  220. /// </summary>
  221. private void InitializeOperation()
  222. {
  223. OP.Subscribe($"{Module}.FlowDripOn", (cmd,para)=> { return FlowDripOn(); });
  224. OP.Subscribe($"{Module}.FlowDripOff", (cmd, para) => { return FlowDripOff(); });
  225. OP.Subscribe($"{Module}.FlowSmallOn", (cmd, para) => { return FlowSmallOn(); });
  226. OP.Subscribe($"{Module}.FlowSmallOff", (cmd, para) => { return FlowSmallOff(); });
  227. OP.Subscribe($"{Module}.FlowLargeOn", (cmd, para) => { return FlowLargeOn(); });
  228. OP.Subscribe($"{Module}.FlowLargeOff", (cmd, para) => { return FlowLargeOff(); });
  229. OP.Subscribe($"{Module}.VentValveOn", (cmd, para) => { return VentValveOn(); });
  230. OP.Subscribe($"{Module}.VentValveOff", (cmd, para) => { return VentValveOff(); });
  231. OP.Subscribe($"{Module}.DrainValveOn", (cmd, para) => { return DrainValveOn(); });
  232. OP.Subscribe($"{Module}.DrainValveOff", (cmd, para) => { return DrainValveOff(); });
  233. OP.Subscribe($"{Module}.VacuumValveOn", (cmd, para) => { return VacuumValveOn(); });
  234. OP.Subscribe($"{Module}.VacuumValveOff", (cmd, para) => { return VacuumValveOff(); });
  235. OP.Subscribe($"{Module}.DisabledAction", DisabledOperation);
  236. OP.Subscribe($"{Module}.ManualAction", ManualOperation);
  237. OP.Subscribe($"{Module}.AutoAction", AutoOperation);
  238. OP.Subscribe($"{Module}.EngineeringModeAction", EngineeringModeOperation);
  239. OP.Subscribe($"{Module}.ProductionModeAction", ProductionModeOperation);
  240. }
  241. #endregion
  242. #region Action
  243. #region Flow
  244. /// <summary>
  245. /// Flow Drip on
  246. /// </summary>
  247. /// <returns></returns>
  248. public bool FlowDripOn()
  249. {
  250. return WriteVariableValue(FLOW_DRIP, true);
  251. }
  252. /// <summary>
  253. /// Flow Drip Off
  254. /// </summary>
  255. /// <returns></returns>
  256. public bool FlowDripOff()
  257. {
  258. return WriteVariableValue(FLOW_DRIP, false);
  259. }
  260. /// <summary>
  261. /// Flow Small On
  262. /// </summary>
  263. /// <returns></returns>
  264. public bool FlowSmallOn()
  265. {
  266. return WriteVariableValue(FLOW_SMALL, true);
  267. }
  268. /// <summary>
  269. /// Flow Small Off
  270. /// </summary>
  271. /// <returns></returns>
  272. public bool FlowSmallOff()
  273. {
  274. return WriteVariableValue(FLOW_SMALL, false);
  275. }
  276. /// <summary>
  277. /// Flow Large On
  278. /// </summary>
  279. /// <returns></returns>
  280. public bool FlowLargeOn()
  281. {
  282. return WriteVariableValue(FLOW_LARGE, true);
  283. }
  284. /// <summary>
  285. /// Flow Large Off
  286. /// </summary>
  287. /// <returns></returns>
  288. public bool FlowLargeOff()
  289. {
  290. return WriteVariableValue(FLOW_LARGE, false);
  291. }
  292. #endregion
  293. #region Mode Switch
  294. /// <summary>
  295. /// DisabledAction
  296. /// </summary>
  297. /// <param name="cmd"></param>
  298. /// <param name="param"></param>
  299. /// <returns></returns>
  300. private bool DisabledOperation(string cmd, object[] args)
  301. {
  302. string currentOperation = "Disabled";
  303. VpwCellEntity vpwCellEntity = Singleton<RouteManager>.Instance.GetModule<VpwCellEntity>(Module);
  304. if (vpwCellEntity != null && _vpwCellPersistentValue != null && _vpwCellPersistentValue.OperatingMode != currentOperation)
  305. {
  306. string preOperation = _vpwCellPersistentValue.OperatingMode;
  307. if (vpwCellEntity.IsBusy)
  308. {
  309. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Disabled mode");
  310. return false;
  311. }
  312. vpwCellEntity.EnterInit();
  313. _vpwCellPersistentValue.OperatingMode = currentOperation;
  314. LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  315. }
  316. VpwCellPersistentManager.Instance.UpdatePersistentValue(Module);
  317. return true;
  318. }
  319. /// <summary>
  320. /// ManualAction
  321. /// </summary>
  322. /// <param name="cmd"></param>
  323. /// <param name="param"></param>
  324. /// <returns></returns>
  325. private bool ManualOperation(string cmd, object[] args)
  326. {
  327. string currentOperation = "Manual";
  328. VpwCellEntity vpwCellEntity = Singleton<RouteManager>.Instance.GetModule<VpwCellEntity>(Module);
  329. if (vpwCellEntity != null && _vpwCellPersistentValue != null && _vpwCellPersistentValue.OperatingMode != currentOperation)
  330. {
  331. string preOperation = _vpwCellPersistentValue.OperatingMode;
  332. if (vpwCellEntity.IsBusy)
  333. {
  334. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Manual mode");
  335. return false;
  336. }
  337. vpwCellEntity.EnterInit();
  338. _vpwCellPersistentValue.OperatingMode = currentOperation;
  339. LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  340. }
  341. VpwCellPersistentManager.Instance.UpdatePersistentValue(Module);
  342. return true;
  343. }
  344. /// <summary>
  345. /// AutoAction
  346. /// </summary>
  347. /// <param name="cmd"></param>
  348. /// <param name="param"></param>
  349. /// <returns></returns>
  350. private bool AutoOperation(string cmd, object[] args)
  351. {
  352. string currentOperation = "Auto";
  353. VpwCellEntity vpwCellEntity = Singleton<RouteManager>.Instance.GetModule<VpwCellEntity>(Module);
  354. if (vpwCellEntity != null && _vpwCellPersistentValue != null && _vpwCellPersistentValue.OperatingMode != currentOperation)
  355. {
  356. string preOperation = _vpwCellPersistentValue.OperatingMode;
  357. if (vpwCellEntity.IsBusy)
  358. {
  359. LOG.WriteLog(eEvent.ERR_VPWMAIN, Module, $"{Module} is Busy, can't switch to Auto mode");
  360. return false;
  361. }
  362. vpwCellEntity.EnterInit();
  363. _vpwCellPersistentValue.OperatingMode = currentOperation;
  364. LOG.WriteLog(eEvent.INFO_VPWMAIN, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  365. }
  366. VpwCellPersistentManager.Instance.UpdatePersistentValue(Module);
  367. return true;
  368. }
  369. /// <summary>
  370. /// EngineeringModeAction
  371. /// </summary>
  372. /// <param name="cmd"></param>
  373. /// <param name="param"></param>
  374. /// <returns></returns>
  375. private bool EngineeringModeOperation(string cmd, object[] args)
  376. {
  377. string currentRecipeOperation = "Engineering";
  378. if (_vpwCellPersistentValue != null)
  379. {
  380. _vpwCellPersistentValue.RecipeOperatingMode = currentRecipeOperation;
  381. }
  382. VpwCellPersistentManager.Instance.UpdatePersistentValue(Module);
  383. return true;
  384. }
  385. /// <summary>
  386. /// ProductionAction
  387. /// </summary>
  388. /// <param name="cmd"></param>
  389. /// <param name="param"></param>
  390. /// <returns></returns>
  391. private bool ProductionModeOperation(string cmd, object[] args)
  392. {
  393. string currentRecipeOperation = "Production";
  394. if (_vpwCellPersistentValue != null)
  395. {
  396. _vpwCellPersistentValue.RecipeOperatingMode = currentRecipeOperation;
  397. }
  398. VpwCellPersistentManager.Instance.UpdatePersistentValue(Module);
  399. return true;
  400. }
  401. #endregion
  402. #region Vent Valve
  403. /// <summary>
  404. /// Vent Valve On
  405. /// </summary>
  406. /// <returns></returns>
  407. public bool VentValveOn()
  408. {
  409. return WriteVariableValue(VENT_VALVE, true);
  410. }
  411. /// <summary>
  412. /// Vent Valve Off
  413. /// </summary>
  414. /// <returns></returns>
  415. public bool VentValveOff()
  416. {
  417. return WriteVariableValue(VENT_VALVE, false);
  418. }
  419. #endregion
  420. #region Drain Valve
  421. /// <summary>
  422. /// Drain Valve On
  423. /// </summary>
  424. /// <returns></returns>
  425. public bool DrainValveOn()
  426. {
  427. return WriteVariableValue(DRAIN_VALVE, true);
  428. }
  429. /// <summary>
  430. /// Drain Valve Off
  431. /// </summary>
  432. /// <returns></returns>
  433. public bool DrainValveOff()
  434. {
  435. return WriteVariableValue(DRAIN_VALVE, false);
  436. }
  437. #endregion
  438. #region Vacuum
  439. /// <summary>
  440. /// Vacuum valve on
  441. /// </summary>
  442. /// <returns></returns>
  443. public bool VacuumValveOn()
  444. {
  445. return WriteVariableValue(VACUUM_VALVE, true);
  446. }
  447. /// <summary>
  448. /// Vacuum valve off
  449. /// </summary>
  450. /// <returns></returns>
  451. public bool VacuumValveOff()
  452. {
  453. return WriteVariableValue(VACUUM_VALVE, false);
  454. }
  455. #endregion
  456. /// <summary>
  457. /// 写变量
  458. /// </summary>
  459. /// <param name="variable"></param>
  460. /// <param name="value"></param>
  461. /// <returns></returns>
  462. private bool WriteVariableValue(string variable, object value)
  463. {
  464. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{variable}");
  465. return IOModuleManager.Instance.WriteIoValue(ioName, value);
  466. }
  467. #endregion
  468. #region Axis
  469. /// <summary>
  470. /// 电机是否上电
  471. /// </summary>
  472. /// <returns></returns>
  473. public bool CheckRotationSwitchOn()
  474. {
  475. return _rotationAxis.IsSwitchOn;
  476. }
  477. /// <summary>
  478. /// Home rotation
  479. /// </summary>
  480. /// <returns></returns>
  481. public bool HomeRotation()
  482. {
  483. return _rotationAxis.Home();
  484. }
  485. /// <summary>
  486. /// 检验Rotation Home结果
  487. /// </summary>
  488. /// <returns></returns>
  489. public bool CheckHomeEndStatus()
  490. {
  491. return CheckRotationEndStatus() && _rotationAxis.IsHomed;
  492. }
  493. /// <summary>
  494. /// 检验Rotation结束状态
  495. /// </summary>
  496. /// <returns></returns>
  497. public bool CheckRotationEndStatus()
  498. {
  499. return _rotationAxis.Status == PunkHPX8_Core.RState.End;
  500. }
  501. /// <summary>
  502. /// 检验Rotation失败状态
  503. /// </summary>
  504. /// <returns></returns>
  505. public bool CheckRotationStopStatus()
  506. {
  507. return _rotationAxis.Status == PunkHPX8_Core.RState.Failed;
  508. }
  509. /// <summary>
  510. /// 设置速度
  511. /// </summary>
  512. /// <param name="speed"></param>
  513. /// <returns></returns>
  514. public bool SetRotationSpeed(int speed)
  515. {
  516. _rotationAxis.SetProfileSpeed(speed);
  517. return true;
  518. }
  519. /// <summary>
  520. /// 电机运动
  521. /// </summary>
  522. /// <param name="position"></param>
  523. /// <returns></returns>
  524. public bool RotationProfilePosition(double position)
  525. {
  526. return _rotationAxis.ProfilePositionOperation(position);
  527. }
  528. /// <summary>
  529. /// 停止运动
  530. /// </summary>
  531. /// <returns></returns>
  532. public bool StopProfilePosition()
  533. {
  534. return _rotationAxis.StopPositionOperation();
  535. }
  536. /// <summary>
  537. /// 是否Rotation运动
  538. /// </summary>
  539. /// <returns></returns>
  540. public bool CheckRotationRunning()
  541. {
  542. return _rotationAxis.IsRun;
  543. }
  544. #endregion
  545. /// <summary>
  546. /// 定时器
  547. /// </summary>
  548. /// <returns></returns>
  549. public bool OnTimer()
  550. {
  551. if (_rotationAxis != null)
  552. {
  553. _rotationAxis.OnTimer();
  554. }
  555. return true;
  556. }
  557. /// <summary>
  558. /// 监控
  559. /// </summary>
  560. public void Monitor()
  561. {
  562. }
  563. public void Reset()
  564. {
  565. }
  566. public void Terminate()
  567. {
  568. }
  569. }
  570. }