Sic08/Modules/Mainframe/UnLoads/Routines/UnLoadCoolingAndPurgeRoutine.cs

using System.Diagnostics;
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 SicModules.UnLoads.Routines.Base;

namespace SicModules.UnLoads.Routines
{
    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);
                    CloseVentValveAndWait((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;
        }
    }
}