RinseKeepwetRoutine.cs 5.6 KB

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