236 lines
7.5 KiB
C#
236 lines
7.5 KiB
C#
using Aitex.Core.RT.Event;
|
||
using Aitex.Core.RT.Routine;
|
||
using Aitex.Core.RT.SCCore;
|
||
using Aitex.Core.Util;
|
||
using MECF.Framework.Common.Equipment;
|
||
using System;
|
||
using System.Collections.Generic;
|
||
using System.Diagnostics;
|
||
using System.Linq;
|
||
using System.Text;
|
||
using System.Threading.Tasks;
|
||
|
||
namespace Mainframe.UnLoads
|
||
{
|
||
public class UnLoadCoolingAndPurgeRoutine : UnLoadBaseRoutine
|
||
{
|
||
enum RoutineStep
|
||
{
|
||
SlowPump,
|
||
FastPump,
|
||
PumpDelay,
|
||
CloseFastValve,
|
||
CloseSlowValve,
|
||
SlowVent,
|
||
FastVent,
|
||
VentDelay,
|
||
CloseFastVentValve,
|
||
CloseSlowVentValve,
|
||
StartLoop,
|
||
LoopPump,
|
||
LoopVent,
|
||
StopLoop,
|
||
TimeDelay1,
|
||
TimeDelay2
|
||
}
|
||
|
||
private int _purgeCount;
|
||
private int _routineTimeOut;
|
||
private double _pumpSwitchPressure;
|
||
private double _pumpBasePressure;
|
||
private int _pumpDelayTime;
|
||
private int _pumpTimeOut;
|
||
private double _ventBasePressure;
|
||
private int _ventDelayTime;
|
||
private int _ventTimeOut;
|
||
private int _coolingTimeInSec;
|
||
private bool _isPurgeDone;
|
||
private R_TRIG _trigPurgeDone;
|
||
|
||
|
||
private readonly Stopwatch _swTimer = new Stopwatch();
|
||
private readonly Stopwatch _swCooling = new Stopwatch();
|
||
|
||
public UnLoadCoolingAndPurgeRoutine()
|
||
{
|
||
Module = ModuleName.UnLoad.ToString();
|
||
Name = "CoolingAndPurge";
|
||
}
|
||
|
||
public void Init()
|
||
{
|
||
|
||
}
|
||
|
||
public override Result Start(params object[] objs)
|
||
{
|
||
Reset();
|
||
|
||
if (objs.Length == 3
|
||
&& int.TryParse(objs[0].ToString(), out int coolingTime)
|
||
&& int.TryParse(objs[1].ToString(), out int purgeCount)
|
||
&& int.TryParse(objs[2].ToString(), out int pumpDelayTime))
|
||
{
|
||
_coolingTimeInSec = coolingTime;
|
||
_purgeCount = purgeCount;
|
||
_pumpDelayTime = pumpDelayTime;
|
||
}
|
||
else
|
||
{
|
||
_coolingTimeInSec = SC.GetValue<int>("UnLoad.CoolingTimeFallback");
|
||
_purgeCount = SC.GetValue<int>("UnLoad.Purge.CyclePurgeCount");
|
||
_pumpDelayTime = SC.GetValue<int>("UnLoad.Purge.PumpDelayTime");
|
||
}
|
||
|
||
_routineTimeOut = SC.GetValue<int>("UnLoad.Purge.RoutineTimeOut");
|
||
_pumpSwitchPressure = SC.GetValue<double>("UnLoad.Pump.SlowFastPumpSwitchPressure");
|
||
_pumpBasePressure = SC.GetValue<double>("UnLoad.Purge.PumpBasePressure");
|
||
_pumpTimeOut = SC.GetValue<int>("UnLoad.Purge.PumpTimeOut");
|
||
_ventBasePressure = SC.GetValue<double>("UnLoad.Purge.VentBasePressure");
|
||
_ventDelayTime = SC.GetValue<int>("UnLoad.Purge.VentDelayTime");
|
||
_ventTimeOut = _pumpTimeOut;
|
||
|
||
_isPurgeDone = false;
|
||
_trigPurgeDone = new R_TRIG();
|
||
|
||
string reason;
|
||
|
||
if (!UnLoadDevice.CheckLidClose())
|
||
{
|
||
EV.PostAlarmLog(Module, $"can not purge, lid is open");
|
||
return Result.FAIL;
|
||
}
|
||
if (!TMDevice.SetFastPumpValve(false, out reason))
|
||
{
|
||
EV.PostAlarmLog(Module, $"can not purge, TM fast pump value can not close");
|
||
return Result.FAIL;
|
||
}
|
||
if (!TMDevice.CheckSlitValveClose(ModuleHelper.Converter(UnLoadDevice.Module)))
|
||
{
|
||
EV.PostAlarmLog(Module, $"Can not purge, slit valve is open");
|
||
return Result.FAIL;
|
||
}
|
||
if (!TMDevice.SetTmToLLVent(false, out _))
|
||
{
|
||
EV.PostAlarmLog(Module, $"can not vent,can not close v85!");
|
||
}
|
||
|
||
if (!TmIoInterLock.SetUnloadPurgeRoutineRunning(true, out reason))
|
||
{
|
||
EV.PostAlarmLog(Module, $"can not purge,{reason}");
|
||
return Result.FAIL;
|
||
}
|
||
if (SC.GetValue<bool>("System.IsATMMode"))
|
||
{
|
||
return Result.DONE;
|
||
}
|
||
|
||
//LockPump2(out reason);
|
||
|
||
_swTimer.Restart();
|
||
_swCooling.Restart();
|
||
|
||
Notify("CoolingAnd Purge Start");
|
||
return Result.RUN;
|
||
}
|
||
|
||
|
||
public override Result Monitor()
|
||
{
|
||
try
|
||
{
|
||
CheckRoutineTimeOut();
|
||
|
||
if (_purgeCount > 0)
|
||
{
|
||
Loop((int)RoutineStep.StartLoop, _purgeCount);
|
||
|
||
SlowPump((int)RoutineStep.SlowPump, _pumpSwitchPressure, _pumpTimeOut);
|
||
FastPump((int)RoutineStep.FastPump, _pumpBasePressure, _pumpTimeOut);
|
||
TimeDelay((int)RoutineStep.PumpDelay, _pumpDelayTime);
|
||
CloseFastPumpValve((int)RoutineStep.CloseFastValve);
|
||
CloseSlowPumpValve((int)RoutineStep.CloseSlowValve);
|
||
|
||
TimeDelay((int)RoutineStep.TimeDelay1, 1);
|
||
|
||
SlowVent((int)RoutineStep.SlowVent, _ventBasePressure, _ventTimeOut);
|
||
CloseVentValve((int)RoutineStep.CloseSlowVentValve);
|
||
|
||
TimeDelay((int)RoutineStep.VentDelay, _ventDelayTime);
|
||
EndLoop((int)RoutineStep.StopLoop);
|
||
}
|
||
|
||
// 如果Purge完成,及时释放Pump2,否则可能由于Cooling时间设定过长,导致Pump一直被占用。
|
||
_isPurgeDone = true;
|
||
_trigPurgeDone.CLK = _isPurgeDone;
|
||
if (_trigPurgeDone.Q)
|
||
{
|
||
//UnlockPump2();
|
||
}
|
||
|
||
CheckCoolingDone();
|
||
}
|
||
catch (RoutineBreakException)
|
||
{
|
||
return Result.RUN;
|
||
}
|
||
catch (RoutineFaildException)
|
||
{
|
||
//UnlockPump2();
|
||
return Result.FAIL;
|
||
}
|
||
|
||
var result = Result.DONE;
|
||
if (TmIoInterLock.SetUnloadPurgeRoutineRunning(false, out var reason) == false)
|
||
{
|
||
EV.PostWarningLog(Module, $"Unable to perform {nameof(TmIoInterLock.SetUnloadPurgeRoutineRunning)}, {reason}");
|
||
result = Result.FAIL;
|
||
}
|
||
|
||
Notify($"Finished ! Elapsed time: {(int)(_swTimer.ElapsedMilliseconds / 1000)} s");
|
||
return result;
|
||
}
|
||
|
||
public override void Abort()
|
||
{
|
||
TmIoInterLock.SetUnloadPurgeRoutineRunning(false, out _);
|
||
base.Abort();
|
||
}
|
||
|
||
private void CheckRoutineTimeOut()
|
||
{
|
||
if (_routineTimeOut > 10)
|
||
{
|
||
if ((int)(_swTimer.ElapsedMilliseconds / 1000) > _routineTimeOut)
|
||
{
|
||
EV.PostAlarmLog(Module, $"Routine TimeOut! over {_routineTimeOut} s");
|
||
throw (new RoutineFaildException());
|
||
}
|
||
}
|
||
}
|
||
|
||
private void CheckCoolingDone()
|
||
{
|
||
if (_swCooling.Elapsed.TotalSeconds > _coolingTimeInSec)
|
||
{
|
||
_swCooling.Stop();
|
||
return;
|
||
}
|
||
|
||
throw new RoutineBreakException();
|
||
}
|
||
|
||
|
||
public int GetRemainedTime()
|
||
{
|
||
if (_swCooling.IsRunning)
|
||
{
|
||
var remain = _coolingTimeInSec - (int)(_swCooling.Elapsed.TotalSeconds);
|
||
return remain < 0 ? 0 : remain;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
}
|
||
}
|