VpwCellDevice.cs 18 KB

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