CrossDoseResetRoutine.cs 6.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201
  1. using Aitex.Core.RT.Device;
  2. using Aitex.Core.RT.Log;
  3. using Aitex.Core.RT.Routine;
  4. using CyberX8_Core;
  5. using CyberX8_RT.Devices.Reservoir;
  6. using MECF.Framework.Common.Beckhoff.ModuleIO;
  7. using MECF.Framework.Common.Equipment;
  8. using MECF.Framework.Common.IOCore;
  9. using MECF.Framework.Common.Persistent.Reservoirs;
  10. using MECF.Framework.Common.Routine;
  11. using MECF.Framework.Common.TwinCat;
  12. using System;
  13. using System.Collections.Generic;
  14. using System.Linq;
  15. using System.Reflection;
  16. using System.Text;
  17. using System.Threading.Tasks;
  18. using System.Windows;
  19. namespace CyberX8_RT.Devices.Dose
  20. {
  21. public class CrossDoseResetRoutine : RoutineBase, IRoutine
  22. {
  23. private enum ResetStep
  24. {
  25. Reset_True,
  26. Reset_Wait,
  27. Reset_False,
  28. End
  29. }
  30. private enum POSStatus
  31. {
  32. Busy,
  33. InTarget,
  34. Warning,
  35. Error
  36. }
  37. #region 内部变量
  38. /// <summary>
  39. /// 模块名称
  40. /// </summary>
  41. private string _moduleName;
  42. /// <summary>
  43. /// 超时时间
  44. /// </summary>
  45. private int _timeOut = 2000;
  46. /// <summary>
  47. /// CompactMembranReservoirDevice
  48. /// </summary>
  49. private CompactMembranReservoirDevice _cmReservoirDevice;
  50. /// <summary>
  51. /// ReservoirsPersistentValue
  52. /// </summary>
  53. private ReservoirsPersistentValue _persistentValue;
  54. #endregion
  55. #region 属性
  56. public RState CurrentState { get { return Runner.Status; } }
  57. #endregion
  58. /// <summary>
  59. /// 构造函数
  60. /// </summary>
  61. /// <param name="module"></param>
  62. public CrossDoseResetRoutine(string module) : base(module)
  63. {
  64. _moduleName = module;
  65. }
  66. /// <summary>
  67. /// Monitor
  68. /// </summary>
  69. /// <returns></returns>
  70. public RState Monitor()
  71. {
  72. Runner.Run(ResetStep.Reset_True, SetTrue, _delay_1ms)
  73. .Wait(ResetStep.Reset_Wait, WaitCompleteEndStatus, _timeOut)
  74. .Run(ResetStep.Reset_False, SetFalse, _delay_1ms)
  75. .End(ResetStep.End, ClearData, _delay_1ms);
  76. return Runner.Status;
  77. }
  78. #region Operation
  79. /// <summary>
  80. /// Reset置1
  81. /// </summary>
  82. /// <returns></returns>
  83. private bool SetTrue()
  84. {
  85. //Reset = 1
  86. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{_moduleName}.TransferPumpReset");
  87. bool result = IOModuleManager.Instance.WriteIoValue(ioName, true);
  88. if (!result)
  89. {
  90. return false;
  91. }
  92. return true;
  93. }
  94. /// <summary>
  95. /// Wait Reset Done End
  96. /// </summary>
  97. /// <returns></returns>
  98. private bool WaitCompleteEndStatus()
  99. {
  100. ushort status = (ushort)_cmReservoirDevice.ReservoirData.TransferPumpPOSStatus;
  101. if (!CheckPOSStatus(status, POSStatus.Error))
  102. {
  103. return true;
  104. }
  105. return false;
  106. }
  107. /// <summary>
  108. /// Reset置0
  109. /// </summary>
  110. /// <returns></returns>
  111. private bool SetFalse()
  112. {
  113. //Reset = 0
  114. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{_moduleName}.TransferPumpReset");
  115. bool result = IOModuleManager.Instance.WriteIoValue(ioName, false);
  116. if (!result)
  117. {
  118. return false;
  119. }
  120. _cmReservoirDevice.InitializeCrossDose(true);
  121. return true;
  122. }
  123. /// <summary>
  124. /// 清除数据
  125. /// </summary>
  126. /// <returns></returns>
  127. private bool ClearData()
  128. {
  129. _persistentValue.AutoCrossDoseStartTime = DateTime.MinValue;
  130. _persistentValue.AutoCrossDoseStartAmpHour = 0;
  131. _cmReservoirDevice.ReservoirData.RemainingCrossDoseVolume = 0;
  132. ReservoirsPersistentManager.Instance.UpdatePersistentValue(_moduleName);
  133. return true;
  134. }
  135. #endregion
  136. /// <summary>
  137. /// Start
  138. /// </summary>
  139. /// <param name="objs"></param>
  140. /// <returns></returns>
  141. public RState Start(params object[] objs)
  142. {
  143. _cmReservoirDevice = DEVICE.GetDevice<CompactMembranReservoirDevice>($"{_moduleName}");
  144. if (_cmReservoirDevice == null)
  145. {
  146. LOG.WriteLog(eEvent.ERR_RESERVOIR, _moduleName, "Compact Membran Reservoir Device is not exist");
  147. return RState.Failed;
  148. }
  149. _persistentValue = ReservoirsPersistentManager.Instance.GetReservoirsPersistentValue(_moduleName);
  150. if (_persistentValue == null)
  151. {
  152. LOG.WriteLog(eEvent.ERR_RESERVOIR, _moduleName, "Reservoir Persistent Value Object is not exist");
  153. return RState.Failed;
  154. }
  155. return Runner.Start(Module, "Reset Cross Dose");
  156. }
  157. /// <summary>
  158. /// Abort
  159. /// </summary>
  160. public void Abort()
  161. {
  162. Runner.Stop($"Stop Reset");
  163. }
  164. /// <summary>
  165. /// POS状态判断
  166. /// </summary>
  167. /// <param name="status"></param>
  168. /// <param name="statusName"></param>
  169. /// <returns></returns>
  170. private bool CheckPOSStatus(ushort status, POSStatus statusName)
  171. {
  172. bool result = false;
  173. switch (statusName)
  174. {
  175. case POSStatus.Busy:
  176. byte bit0 = (byte)(status & 0b0001);
  177. result = (bit0 == 1) ? true : false;
  178. break;
  179. case POSStatus.InTarget:
  180. byte bit1 = (byte)((status & 0b0010) >> 1);
  181. result = (bit1 == 1) ? true : false;
  182. break;
  183. case POSStatus.Warning:
  184. byte bit2 = (byte)((status & 0b0100) >> 2);
  185. result = (bit2 == 1) ? true : false;
  186. break;
  187. case POSStatus.Error:
  188. byte bit3 = (byte)((status & 0b1000) >> 3);
  189. result = (bit3 == 1) ? true : false;
  190. break;
  191. default:
  192. break;
  193. }
  194. return result;
  195. }
  196. }
  197. }