FurnaceELK/Furnace/FurnaceRT/Equipments/PMs/PMN2Purge.cs

using Aitex.Core.RT.DataCenter;
using Aitex.Core.RT.Device;
using Aitex.Core.RT.Device.Unit;
using Aitex.Core.RT.Log;
using Aitex.Core.RT.SCCore;
using Aitex.Core.Util;
using DocumentFormat.OpenXml.Packaging;
using FurnaceRT.Devices;
using FurnaceRT.Equipments.PMs.Devices;
using FurnaceRT.Extraction;
using MECF.Framework.Common.CommonData.SorterDefines;
using MECF.Framework.Common.Equipment;
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts.TDK;
using System;
using System.Collections.Generic;
using System.Diagnostics;

namespace FurnaceRT.Equipments.PMs
{
    /// <summary>
    /// 分布类 定义N2Purge的执行逻辑
    /// </summary>
    public partial class PMModule
    {
        private R_TRIG _trigN2UpRD = new R_TRIG();
        private R_TRIG _trigN2DownRD = new R_TRIG();
        private R_TRIG _trigN2AirUpRD = new R_TRIG();
        private R_TRIG _trigN2AirDownRD = new R_TRIG();
        private R_TRIG _trigN2AirDownTwoRD = new R_TRIG();
        private R_TRIG _trigSelectN2PurgeModeD = new R_TRIG();

        private Dictionary<string, Tuple<R_TRIG, List<Tuple<IDevice, string>>>> _n2PurgeSequenceAction;
        private Dictionary<string, Func<bool>> _n2PurgeSequenceStatus;
        private Dictionary<string, R_TRIG> _rTrigDict;
        private N2PurgeModeEnum _N2PurgeMode = N2PurgeModeEnum.Auto;
        private double _n2PurgeData = 20;
        private double _n2ToAirData = 185000;

        private double _manualPhase2StabilityTime = 0;
        private double _manualPhase4StabilityTime = 0;
        private bool _manualPhase2NeedCheck = true;
        private bool _manualPhase4NeedCheck = true;
        private bool _enableAbortN2purge = true;

        private Dictionary<string, Stopwatch> _allTimeDict = new Dictionary<string, Stopwatch>();
        private void InitN2PurgeData()
        {
            DATA.Subscribe($"{Module}.O2DensityData", () => GetO2DensityData(), SubscriptionAttribute.FLAG.IgnoreSaveDB);
            DATA.Subscribe($"{Module}.CheckO2Location", () => GetCheckO2Location(), SubscriptionAttribute.FLAG.IgnoreSaveDB);
            DATA.Subscribe($"{Module}.O2SetCheckSetPoint", () => GetO2SetCheckSetPoint(), SubscriptionAttribute.FLAG.IgnoreSaveDB);

            DATA.Subscribe($"{Module}.N2PurgeMode", () => SC.ContainsItem("PM1.SelectN2PurgeMode") ? SC.GetStringValue("PM1.SelectN2PurgeMode") : "");
        }

        private void InitN2PurgeConfigData()
        {
            _n2PurgeData = SC.ContainsItem($"System.N2PurgeData") ? SC.GetValue<double>("System.N2PurgeData") : 20;
            _n2ToAirData = SC.ContainsItem($"System.N2PurgeData") ? SC.GetValue<double>("System.N2ToAirData") : 185000;

            _enableAbortN2purge = SC.ContainsItem($"PM1.N2Purge.EnableAbortN2purge") ? SC.GetValue<bool>("PM1.N2Purge.EnableAbortN2purge") : false;
            _manualPhase2StabilityTime = SC.ContainsItem($"PM1.N2Purge.Manual_phase2.StabilityTime") ? SC.GetValue<double>("PM1.N2Purge.Manual_phase2.StabilityTime") : 0;
            _manualPhase2NeedCheck = _manualPhase2StabilityTime > 0;

            _manualPhase4StabilityTime = SC.ContainsItem($"PM1.N2Purge.Manual_phase4.StabilityTime") ? SC.GetValue<double>("PM1.N2Purge.Manual_phase4.StabilityTime") : 0;
            _manualPhase4NeedCheck = _manualPhase4StabilityTime > 0;

            _n2PurgeSequenceAction = ExtractionMethods.GetN2PurgeSequenceAction();
            _n2PurgeSequenceStatus = new Dictionary<string, Func<bool>>()
            {
                {"N2PurgeAIRTo20PPM",()=> GetN2PurgeAIRTo20PPMStatus()},
                {"N2PurgeUnder20PPM",()=> GetN2PurgeUnder20PPMStatus()},
                {"AIR",()=> GetN2PurgeAIRStatus()},
                {"DoorOpen",()=> GetN2PurgeDoorOpenStatus()},
                {"Foup1",()=> GetN2PurgeFoup1Status()},
                {"Foup2",()=> GetN2PurgeFoup2Status()},

                {N2PurgeModeEnum.Manual_phase1.ToString(),()=>  GetN2PurgePhase1() },
                {N2PurgeModeEnum.Manual_phase2.ToString(),()=>  GetN2PurgePhase2()},
                {N2PurgeModeEnum.Manual_phase3.ToString(),()=>  GetN2PurgePhase3() },
                {N2PurgeModeEnum.Manual_phase4.ToString(),()=>  GetN2PurgePhase4() },
                {N2PurgeModeEnum.Manual_phase5.ToString(),()=>  GetN2PurgePhase5() },

            };
            _allTimeDict = new Dictionary<string, Stopwatch>()
            {
                {N2PurgeModeEnum.Manual_phase1.ToString(),new Stopwatch() },
                {N2PurgeModeEnum.Manual_phase2.ToString(),new Stopwatch()},
                {N2PurgeModeEnum.Manual_phase3.ToString(),new Stopwatch()},
                {N2PurgeModeEnum.Manual_phase4.ToString(),new Stopwatch() },
                {N2PurgeModeEnum.Manual_phase5.ToString(),new Stopwatch() }
            };
            _rTrigDict = new Dictionary<string, R_TRIG>();
        }

        private void MonitorN2Purge()
        {
            if (IsAbortN2purge())
            {
                SC.SetItemValue("PM1.SelectN2PurgeMode", N2PurgeModeEnum.ATMMode.ToString());
            }

            var selectN2PurgeMode = SC.ContainsItem("PM1.SelectN2PurgeMode") ? SC.GetStringValue("PM1.SelectN2PurgeMode") : "";
            if (string.IsNullOrEmpty(selectN2PurgeMode))
            {
                return;
            }
            SetN2PurgeModeAction(selectN2PurgeMode);
        }

        private void SetN2PurgeModeAction(string selectN2PurgeMode)
        {
            _N2PurgeMode = (N2PurgeModeEnum)Enum.Parse(typeof(N2PurgeModeEnum), selectN2PurgeMode);

            switch (_N2PurgeMode)
            {
                case N2PurgeModeEnum.Auto:
                    // 自动模式下的操作
                    break;
                case N2PurgeModeEnum.ManualMode:
                    break;
                case N2PurgeModeEnum.N2PurgeMode:

                    ProcessPhase(_trigN2UpRD, N2PurgeModeEnum.Manual_phase1.ToString());
                    ProcessPhase(_trigN2DownRD, N2PurgeModeEnum.Manual_phase2.ToString(), _manualPhase2NeedCheck, (int)(_manualPhase2StabilityTime * 1000));
                    break;
                case N2PurgeModeEnum.ATMMode:

                    ProcessPhase(_trigN2AirDownRD, N2PurgeModeEnum.Manual_phase3.ToString());
                    ProcessPhase(_trigN2AirUpRD, N2PurgeModeEnum.Manual_phase4.ToString(), _manualPhase4NeedCheck, (int)(_manualPhase4StabilityTime * 1000));
                    ProcessPhase(_trigN2AirDownTwoRD, N2PurgeModeEnum.Manual_phase5.ToString());
                    break;
            }

        }
        bool CheckConditionInTime(string modeKey, int millisecondsTimeout, Func<bool> condition)
        {
            var stopwatch = _allTimeDict[modeKey];
            if (!_allTimeDict[modeKey].IsRunning)
            {
                _allTimeDict[modeKey].Restart();
            }
            while (stopwatch.ElapsedMilliseconds < millisecondsTimeout)
            {
                if (!_allTimeDict[modeKey].IsRunning)
                {
                    return true;
                }
                if (!condition())
                {
                    _allTimeDict[modeKey].Stop();
                    _allTimeDict[modeKey].Reset();
                    return false;
                }
            }
            if (stopwatch.ElapsedMilliseconds > millisecondsTimeout)
            {
                _allTimeDict[modeKey].Stop();
                _allTimeDict[modeKey].Reset();
            }
            return true;
        }
        private void ProcessPhase(R_TRIG r_TRIG, string modeKey, bool needCheck = false, int time = 0)
        {
            r_TRIG.CLK = needCheck ? (CheckConditionInTime(modeKey, time, () => _n2PurgeSequenceStatus[modeKey].Invoke())) : _n2PurgeSequenceStatus[modeKey].Invoke();
            if (r_TRIG.Q)
            {
                LOG.Info($"N2PurgeMode Trigger {modeKey}!,O2：{GetO2Density()},time:{_allTimeDict[modeKey].ElapsedMilliseconds}");
                SetN2PurgeValveData(modeKey);
                _allTimeDict[modeKey].Stop();
                _allTimeDict[modeKey].Reset();
            }
        }
        public void RestAllN2PrugeRD()
        {
            _trigN2AirDownRD.RST = false;
            _trigN2AirUpRD.RST = false;
            _trigN2DownRD.RST = false;
            _trigN2UpRD.RST = false;

            foreach (var item in _allTimeDict)
            {
                item.Value.Stop();
                item.Value.Reset();
            }

        }
        private void SetN2PurgeValveData(string mode)
        {
            var value = _n2PurgeSequenceAction[mode];

            foreach (var operateItem in value.Item2)
            {
                if (operateItem.Item1 is IoMFC)
                {
                    var ioMFc = (operateItem.Item1 as IoMFC);
                    { ioMFc.SetMfcValue(out _, 0, new object[] { float.Parse(operateItem.Item2.ToString()) }); }
                }

                if (operateItem.Item1 is IoValve)
                {
                    var ioValve = (operateItem.Item1 as IoValve);

                    ioValve.TurnValve(bool.Parse(operateItem.Item2), out _);
                }
                if (operateItem.Item1 is IoTrigger)
                {
                    var ioTrigger = (operateItem.Item1 as IoTrigger);

                    ioTrigger.CheckAndSet(bool.Parse(operateItem.Item2), out _);
                }
            }


        }

        private bool SetN2PurgeMode(out string reason, int time, object[] param)
        {
            reason = string.Empty;
            var mode = param[0].ToString();
            _N2PurgeMode = (N2PurgeModeEnum)Enum.Parse(typeof(N2PurgeModeEnum), mode);

            if (SC.ContainsItem("PM1.SelectN2PurgeMode"))
            {
                SC.SetItemValue("PM1.SelectN2PurgeMode", mode);
            }
            RestAllN2PrugeRD();
            return true;
        }

        /// <summary>
        /// 获取当前O2检测位置的设定值
        /// </summary>
        /// <returns></returns>
        private string GetO2SetCheckSetPoint()
        {
            if (SensorO2DetectSideLA != null && SensorO2DetectSideLA.Value)
            {
                var key = "PM1.N2Purge.N2PurgeLAO2CheckSV";
                if (SC.ContainsItem(key))
                    return SC.GetValue<double>(key).ToString("f3");
            }

            if ((SensorO2DetectSideFIMS1 != null && SensorO2DetectSideFIMS1.Value) || (SensorO2DetectSideFIMS2 != null && SensorO2DetectSideFIMS2.Value))
            {
                var key = "PM1.N2Purge.N2PurgeFOUPO2CheckSV";
                if (SC.ContainsItem(key))
                    return SC.GetValue<double>(key).ToString("f3");
            }
            return "";
        }
        /// <summary>
        /// 获取当前O2检测位置
        /// </summary>
        /// <returns></returns>
        private string GetCheckO2Location()
        {
            if (SensorO2DetectSideLA != null && SensorO2DetectSideLA.Value)
                return SensorO2DetectSideLA.Display;

            if (SensorO2DetectSideFIMS1 != null && SensorO2DetectSideFIMS1.Value)
                return SensorO2DetectSideFIMS1.Display;

            if (SensorO2DetectSideFIMS2 != null && SensorO2DetectSideFIMS2.Value)
                return SensorO2DetectSideFIMS2.Display;

            return "";
        }
        /// <summary>
        /// 获取当前O2浓度
        /// </summary>
        /// <returns></returns>
        private string GetO2DensityData()
        {
            var result = "";

            result = ConcentrationO2.FeedBack.ToString("f3");
            return result;
        }
        private double GetO2Density()
        {

            return ConcentrationO2.FeedBack;
        }
        private bool GetN2PurgePhase1()
        {
            return (GetO2Density() >= _n2PurgeData) && GetLADoorOpenStatus();
        }
        private bool GetN2PurgePhase2()
        {
            return (GetO2Density() < _n2PurgeData) && GetLADoorOpenStatus();
        }
        private bool GetN2PurgePhase3()
        {
            return GetO2Density() < _n2ToAirData && GetLADoorOpenStatus();
        }
        private bool GetN2PurgePhase5()
        {
            return GetO2Density() >= _n2ToAirData && !GetLADoorOpenStatus();
        }
        private bool GetN2PurgePhase4()
        {
            return GetO2Density() >= _n2ToAirData && GetLADoorOpenStatus();
        }
        private bool GetN2PurgeAIRTo20PPMStatus()
        {
            return ValveAV202.DOOpen.Value;
        }
        private bool GetN2PurgeUnder20PPMStatus(double value = 20)
        {

            return ConcentrationO2.Value < value;
        }
        private bool GetN2PurgeAIRStatus()
        {
            return ValveAV202.DOClose.Value && (AlarmSignalFilterBox1DoorSwitch != null ? !AlarmSignalFilterBox1DoorSwitch.Value : false);
        }
        private bool GetLADoorOpenStatus()
        {
            return (bool)(SensorLADoorSw1?.Value);
        }
        private bool GetN2PurgeDoorOpenStatus()
        {
            return ValveAV202.DOClose.Value && (AlarmSignalFilterBox1DoorSwitch != null ? !AlarmSignalFilterBox1DoorSwitch.Value : false);
        }
        private bool GetN2PurgeFoup1Status()
        {
            return GetN2PurgeAIRTo20PPMStatus() && GetN2PurgeUnder20PPMStatus() && FIMS1.IsFoupExist && FIMS1.CollisionAvoidanceUpDownStatus == DeviceStatus.Down;
        }
        private bool GetN2PurgeFoup2Status()
        {
            return GetN2PurgeAIRTo20PPMStatus() && GetN2PurgeUnder20PPMStatus() && FIMS2.IsFoupExist && FIMS2.CollisionAvoidanceUpDownStatus == DeviceStatus.Down; ;
        }
        public bool IsAbortN2purge()
        {
            if (!_enableAbortN2purge)
            {
                return false;
            }

            if (SensorSL02001gasboxdoorsw11.Value || SensorSL02001gasboxdoorsw12.Value || SensorSL02002gasboxdoorsw11.Value || SensorSL02002gasboxdoorsw12.Value || SensorSL05002LAdoorsw2.Value || SensorSL05004LAfurnacedoorsw.Value)
            {
                return true;
            }


            return false;

        }

        public void SetN2PurgeLAO2CheckFirstEnable(bool isEable)
        {
            if (TrigN2PurgeLAO2CheckFirstEnable != null && TrigN2PurgeLAO2CheckFirstEnable.Value != isEable)
            {
                TrigN2PurgeLAO2CheckFirstEnable.SetTrigger(isEable, out _);
            }
        }
        public void SetN2PurgeFIMS1O2CheckEnable(ModuleName fims, bool isEable)
        {
            if (fims == ModuleName.FIMS1 && TrigN2PurgeFIMS1O2CheckEnable != null && TrigN2PurgeFIMS1O2CheckEnable.Value != isEable)
            {
                TrigN2PurgeFIMS1O2CheckEnable.SetTrigger(isEable, out _);
            }

            if (fims == ModuleName.FIMS2 && TrigN2PurgeFIMS2O2CheckEnable != null && TrigN2PurgeFIMS2O2CheckEnable.Value != isEable)
            {
                TrigN2PurgeFIMS2O2CheckEnable.SetTrigger(isEable, out _);

            }
        }
        public void SetN2PurgeProcess(bool isEable)
        {
            if (TrigN2PurgeProcess != null && TrigN2PurgeProcess.Value != isEable)
            {
                TrigN2PurgeProcess.SetTrigger(isEable, out _);
            }
        }
        public void SetN2PurgeLAO2CheckSV(float value)
        {
            if (TrigN2PurgeLAO2CheckSV != null)
                TrigN2PurgeLAO2CheckSV?.SetAOTrigger(value, out _);
        }
        public void SetN2PurgeFOUPO2CheckSV(float value)
        {
            if (TrigN2PurgeFOUPO2CheckSV != null)
                TrigN2PurgeFOUPO2CheckSV?.SetAOTrigger(value, out _);
        }

        public void SetAVParameter(ModuleName fims, bool isEable)
        {
            if (fims == ModuleName.FIMS1)
            {
                var avValve58 = DEVICE.GetDevice<IoValve>($"{ModuleName.PM1}.ValveAV58");
                avValve58?.TurnValve(isEable, out _);
            }

            if (fims == ModuleName.FIMS2)
            {
                var avValve59 = DEVICE.GetDevice<IoValve>($"{ModuleName.PM1}.ValveAV59");
                avValve59?.TurnValve(isEable, out _);
            }

        }
        /// <summary>
        /// N2Purge相关时间参数，电气要求设定为秒，实际下发按照毫秒
        /// </summary>
        public void SetN2PurgeParameters()
        {
            if (SC.ContainsItem("PM1.N2Purge.TransferRoomArrivalWaitTime") && TrigN2PurgeLAO2CheckTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.TransferRoomArrivalWaitTime") ;
                TrigN2PurgeLAO2CheckTime.SetAOTrigger(time, out _);
            }

            if (SC.ContainsItem("PM1.N2Purge.TransferRoomStableWaitTime") && TrigN2PurgeLAO2OverTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.TransferRoomStableWaitTime") ;
                TrigN2PurgeLAO2OverTime.SetAOTrigger(time, out _);
            }

            if (SC.ContainsItem("PM1.N2Purge.FOUPOpenerArrivalWaitTime") && TrigN2PurgeFOUPO2CheckTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.FOUPOpenerArrivalWaitTime") ;
                TrigN2PurgeFOUPO2CheckTime.SetAOTrigger(time, out _);
            }

            if (SC.ContainsItem("PM1.N2Purge.FOUPOpenerStableWaitTime") && TrigN2PurgeFOUPO2OverTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.FOUPOpenerStableWaitTime") ;
                TrigN2PurgeFOUPO2OverTime.SetAOTrigger(time, out _);
            }

            if (SC.ContainsItem("PM1.N2Purge.O2DetectorTransferRoomToFOUPTime") && TrigN2PurgeExchangeLATOFOUPWaitTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.O2DetectorTransferRoomToFOUPTime") ;
                TrigN2PurgeExchangeLATOFOUPWaitTime.SetAOTrigger(time, out _);
            }

            if (SC.ContainsItem("PM1.N2Purge.O2DetectorFOUPToTransferRoomTime") && TrigN2PurgeExchangeFOUPTOLAWaitTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.O2DetectorFOUPToTransferRoomTime") ;
                TrigN2PurgeExchangeFOUPTOLAWaitTime.SetAOTrigger(time, out _);
            }

            if (SC.ContainsItem("PM1.N2Purge.O2DetectorFOUPToFOUPTime") && TrigN2PurgeExchangeFOUPTOFOUPWaitTime != null)
            {
                var time = (float)SC.GetValue<double>("PM1.N2Purge.O2DetectorFOUPToFOUPTime") ;
                TrigN2PurgeExchangeFOUPTOFOUPWaitTime.SetAOTrigger(time, out _);
            }
            SetN2PurgeLAO2CheckSV((float)SC.GetValue<double>("PM1.N2Purge.N2PurgeLAO2CheckSV"));
            SetN2PurgeFOUPO2CheckSV((float)SC.GetValue<double>("PM1.N2Purge.N2PurgeFOUPO2CheckSV"));
        }

        public void InitN2PurgeMode(string n2PurgeModeStr, bool isN2Purge)
        {
            if (SC.ContainsItem("PM1.RecipeRelevancyN2Purge") && SC.GetValue<bool>("PM1.RecipeRelevancyN2Purge") && SC.ContainsItem("PM1.SelectN2PurgeMode"))
            {
                if (!isN2Purge)
                {
                    SC.SetItemValueFromString("PM1.SelectN2PurgeMode", N2PurgeModeEnum.ManualMode.ToString());
                }
                else
                {
                    var setValue = GetN2PurgeModeEnumByStr(n2PurgeModeStr);
                    SC.SetItemValueFromString("PM1.SelectN2PurgeMode", setValue);
                }
                RestAllN2PrugeRD();
            }
        }
    }
}