RinseKeepwetRoutine.cs 5.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175
  1. using Aitex.Core.RT.Device;
  2. using Aitex.Core.RT.Log;
  3. using Aitex.Core.RT.Routine;
  4. using Aitex.Core.RT.SCCore;
  5. using CyberX8_Core;
  6. using CyberX8_RT.Devices.Facilities;
  7. using CyberX8_RT.Devices.Resistivity;
  8. using CyberX8_RT.Devices.Rinse;
  9. using MECF.Framework.Common.CommonData.Rinse;
  10. using MECF.Framework.Common.Routine;
  11. using System;
  12. using System.Collections.Generic;
  13. using System.Linq;
  14. using System.Text;
  15. using System.Threading.Tasks;
  16. namespace CyberX8_RT.Modules.Rinse
  17. {
  18. public class RinseKeepwetRoutine : RoutineBase, IRoutine
  19. {
  20. private const int LOTTRACK_TIME = 1000;
  21. private const string DI_WATER_PRESSURE_VALUE = "DiWaterPressure";
  22. private enum KeepwetStep
  23. {
  24. CloseDumpValve,
  25. KeepWetStart,
  26. KeepWetWait,
  27. CloseFillValve,
  28. KeepWetSlowDrain,
  29. End
  30. }
  31. #region 内部变量
  32. /// <summary>
  33. /// 低于Clamp的水位
  34. /// </summary>
  35. private double _belowClampWaterLevel = 0;
  36. /// <summary>
  37. /// 设备对象
  38. /// </summary>
  39. private RinseDevice _device;
  40. /// <summary>
  41. /// 注满数值
  42. /// </summary>
  43. private int _sensorReadingFull;
  44. /// <summary>
  45. /// lock track time
  46. /// </summary>
  47. private DateTime _lotTackTime = DateTime.Now;
  48. /// <summary>
  49. /// LotTrack数据
  50. /// </summary>
  51. private List<RinseLotTrackData> _datas = new List<RinseLotTrackData>();
  52. /// <summary>
  53. /// LotTrack数据
  54. /// </summary>
  55. public List<RinseLotTrackData> RinseLotTrackDatas { get { return _datas; } }
  56. /// <summary>
  57. /// Facilities
  58. /// </summary>
  59. private SystemFacilities _facilities;
  60. #endregion
  61. /// <summary>
  62. /// 构造函数
  63. /// </summary>
  64. /// <param name="module"></param>
  65. public RinseKeepwetRoutine(string module) : base(module)
  66. {
  67. }
  68. /// <summary>
  69. /// 中止
  70. /// </summary>
  71. public void Abort()
  72. {
  73. _device.FillValveOff();
  74. _device.DrainValveOn();
  75. Runner.Stop("Manual Abort");
  76. }
  77. /// <summary>
  78. /// 监控
  79. /// </summary>
  80. /// <returns></returns>
  81. public RState Monitor()
  82. {
  83. LottrackRecord();
  84. Runner.Run(KeepwetStep.CloseDumpValve, () => _device.DrainValveOff(), _delay_1ms)
  85. .Run(KeepwetStep.KeepWetStart, () => _device.FillValveOn(), _delay_1ms)
  86. .Wait(KeepwetStep.KeepWetWait, CheckFillFullStatus)
  87. .Run(KeepwetStep.CloseFillValve, () => _device.FillValveOff(), _delay_1ms)
  88. .Wait(KeepwetStep.KeepWetSlowDrain, CheckDrainStatus)
  89. .End(KeepwetStep.End, NullFun, _delay_1ms);
  90. return Runner.Status;
  91. }
  92. /// <summary>
  93. /// 启动
  94. /// </summary>
  95. /// <param name="objs"></param>
  96. /// <returns></returns>
  97. public RState Start(params object[] objs)
  98. {
  99. _belowClampWaterLevel = SC.GetValue<double>("QDR.QDRKeepWetBelowClampWaterLevel");
  100. _sensorReadingFull = SC.GetValue<int>("QDR.SensorReadingFull");
  101. _device = DEVICE.GetDevice<RinseDevice>(Module);
  102. _facilities = DEVICE.GetDevice<SystemFacilities>("System.Facilities");
  103. if (_facilities == null)
  104. {
  105. LOG.WriteLog(eEvent.ERR_RINSE, Module, "Facility is null");
  106. return RState.Failed;
  107. }
  108. _datas.Clear();
  109. return Runner.Start(Module, "Start Rinse Keepwet");
  110. }
  111. /// 记录Lottrack
  112. /// </summary>
  113. private void LottrackRecord()
  114. {
  115. //记录Lottrack
  116. if (DateTime.Now.Subtract(_lotTackTime).TotalMilliseconds >= LOTTRACK_TIME)
  117. {
  118. AddLotTrackData();
  119. _lotTackTime = DateTime.Now;
  120. }
  121. }
  122. /// <summary>
  123. /// 检验是否注满
  124. /// </summary>
  125. /// <returns></returns>
  126. private bool CheckFillFullStatus()
  127. {
  128. double currentWaterLevel = _device.RinseData.WaterLevel;
  129. bool result = currentWaterLevel > _sensorReadingFull;
  130. return result;
  131. }
  132. /// <summary>
  133. /// 检验是否排空
  134. /// </summary>
  135. /// <returns></returns>
  136. private bool CheckDrainStatus()
  137. {
  138. double currentWaterLevel = _device.RinseData.WaterLevel;
  139. bool result = currentWaterLevel < _belowClampWaterLevel;
  140. return result;
  141. }
  142. /// <summary>
  143. /// 获取Lot Track数据
  144. /// </summary>
  145. /// <returns></returns>
  146. private void AddLotTrackData()
  147. {
  148. RinseLotTrackData data = new RinseLotTrackData();
  149. data.TimeStamp = DateTime.Now;
  150. data.WaterLevel = _device.RinseData.WaterLevel;
  151. data.DIFillEnabled = _device.RinseData.FillValve;
  152. data.DumpEnabled = _device.RinseData.DrainValve;
  153. data.WaterPressure = _facilities.GetCommonLimitDataByName(DI_WATER_PRESSURE_VALUE).Value;
  154. ResistivityController resistivityController = DEVICE.GetDevice<ResistivityController>(_device.RinseItem.ResistivityID);
  155. if (resistivityController != null)
  156. {
  157. try
  158. {
  159. data.Resistivity = double.Parse(resistivityController.ResisitivityValue.Trim());
  160. }
  161. catch
  162. {
  163. data.Resistivity = 0;
  164. }
  165. }
  166. _datas.Add(data);
  167. }
  168. }
  169. }