363 lines
12 KiB
C#
363 lines
12 KiB
C#
|
using Aitex.Core.RT.Device;
|
|||
|
|
using Aitex.Core.RT.Device.Devices;
|
|||
|
|
using Aitex.Core.RT.Device.Unit;
|
|||
|
|
using Aitex.Core.RT.Event;
|
|||
|
|
using Aitex.Core.RT.Routine;
|
|||
|
|
using Aitex.Core.RT.SCCore;
|
|||
|
|
using MECF.Framework.Common.Equipment;
|
|||
|
|
using System;
|
|||
|
|
using System.Collections.Generic;
|
|||
|
|
using System.Diagnostics;
|
|||
|
|
|
|||
|
|
namespace SicPM2.Routines
|
|||
|
|
{
|
|||
|
|
public class PMExchangeMoRoutine : PMBaseRoutine
|
|||
|
|
{
|
|||
|
|
private enum RoutineStep
|
|||
|
|
{
|
|||
|
|
SetGroupE,
|
|||
|
|
SetGroupK,
|
|||
|
|
|
|||
|
|
SetM7,
|
|||
|
|
SetM8,
|
|||
|
|
SetM11,
|
|||
|
|
SetPc2,
|
|||
|
|
|
|||
|
|
OpenV73,
|
|||
|
|
CloseV73,
|
|||
|
|
SetGroup1,
|
|||
|
|
SetGroup11,
|
|||
|
|
SetGroup2,
|
|||
|
|
SetGroup3,
|
|||
|
|
SetGroup4,
|
|||
|
|
SetGroup5,
|
|||
|
|
SetGroup6,
|
|||
|
|
|
|||
|
|
StartLoop,
|
|||
|
|
EndLoop,
|
|||
|
|
|
|||
|
|
SetM7Default,
|
|||
|
|
SetM8Default,
|
|||
|
|
SetPc2Default,
|
|||
|
|
SetM11Default,
|
|||
|
|
SetGroupV25,
|
|||
|
|
|
|||
|
|
|
|||
|
|
TimeDelay1,
|
|||
|
|
TimeDelay2,
|
|||
|
|
TimeDelay3,
|
|||
|
|
TimeDelay4,
|
|||
|
|
TimeDelay5,
|
|||
|
|
TimeDelay6,
|
|||
|
|
TimeDelay7,
|
|||
|
|
TimeDelay8,
|
|||
|
|
TimeDelay9,
|
|||
|
|
TimeDelay10,
|
|||
|
|
TimeDelay11,
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private bool _isTCS = false; //标记是TMA换源还是TCS换源
|
|||
|
|
private PM2Module _pm1Module;
|
|||
|
|
private ModuleName moduleName;
|
|||
|
|
private IoInterLock _pmIoInterLock;
|
|||
|
|
|
|||
|
|
private int _IoValueOpenCloseTimeout = 10; //开关超时时间
|
|||
|
|
private int _loopCount;
|
|||
|
|
private double _OpenTime = 10;
|
|||
|
|
private double _CLoseTime = 10;
|
|||
|
|
private int _routineTimeOut;
|
|||
|
|
|
|||
|
|
//默认为TMA换源参数
|
|||
|
|
private int mfc7Or10 = 7;
|
|||
|
|
private int mfc8Or12 = 8;
|
|||
|
|
private int mfc11 = 11;
|
|||
|
|
private int pc2Or3 = 2;
|
|||
|
|
private List<string> _lstGroupV73 = new List<string>() { "V73" };
|
|||
|
|
private List<string> _lstGroupV50 = new List<string>() { "V50" };
|
|||
|
|
private List<string> _lstGroupV48 = new List<string>() { "V48" };
|
|||
|
|
private List<string> _lstGroupV49 = new List<string>() { "V49" };
|
|||
|
|
|
|||
|
|
private List<string> _lstGroup1 = new List<string>() { "V46","V46s","V73" };
|
|||
|
|
private List<string> _lstGroup2 = new List<string>() { "V46", "V46s" };
|
|||
|
|
private List<string> _lstGroup3 = new List<string>() { "V43", "V43s", "V45" };
|
|||
|
|
|
|||
|
|
private Stopwatch _swTimer = new Stopwatch();
|
|||
|
|
public PMExchangeMoRoutine(ModuleName module, PM2Module pm1) : base(module, pm1)
|
|||
|
|
{
|
|||
|
|
moduleName = module;
|
|||
|
|
_pm1Module = pm1;
|
|||
|
|
Name = "MoExchange";
|
|||
|
|
_pmIoInterLock = DEVICE.GetDevice<IoInterLock>($"{Module}.PMInterLock");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void Init(string moName)
|
|||
|
|
{
|
|||
|
|
if (moName.ToUpper().Contains("TCS"))
|
|||
|
|
{
|
|||
|
|
_isTCS = true;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
_isTCS = false;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public override Result Start(params object[] objs)
|
|||
|
|
{
|
|||
|
|
Reset();
|
|||
|
|
|
|||
|
|
if (_pm1Module.V69.Status)
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog(Module, $"can not Exchange Mo,V69 should be Closed");
|
|||
|
|
return Result.FAIL;
|
|||
|
|
}
|
|||
|
|
if (_pm1Module.V72.Status)
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog(Module, $"can not Exchange Mo,V72 should be Closed");
|
|||
|
|
return Result.FAIL;
|
|||
|
|
}
|
|||
|
|
if (_pm1Module.V74.Status)
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog(Module, $"can not Exchange Mo,V74 should be Closed");
|
|||
|
|
return Result.FAIL;
|
|||
|
|
}
|
|||
|
|
if (_pm1Module.EPV2.Status)
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog(Module, $"can not Exchange Mo,EPV2 should be Closed");
|
|||
|
|
return Result.FAIL;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_loopCount = SC.GetValue<int>($"PM.{Module}.MoExchange.CycleCount");
|
|||
|
|
_OpenTime= SC.GetValue<int>($"PM.{Module}.MoExchange.PumpTime");
|
|||
|
|
_CLoseTime = SC.GetValue<int>($"PM.{Module}.MoExchange.VentTime");
|
|||
|
|
_routineTimeOut = SC.GetValue<int>($"PM.{Module}.MoExchange.RoutineTimeOut");
|
|||
|
|
|
|||
|
|
|
|||
|
|
//设置TCS换源参数
|
|||
|
|
if (_isTCS)
|
|||
|
|
{
|
|||
|
|
mfc7Or10 = 10;
|
|||
|
|
mfc8Or12 = 12;
|
|||
|
|
pc2Or3 = 3;
|
|||
|
|
|
|||
|
|
_lstGroup1 = new List<string>() { "V50"};
|
|||
|
|
_lstGroup2 = new List<string>() { "V48" };
|
|||
|
|
_lstGroup3 = new List<string>() { "V49" };
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
mfc7Or10 = 7;
|
|||
|
|
mfc8Or12 = 8;
|
|||
|
|
pc2Or3 = 2;
|
|||
|
|
|
|||
|
|
_lstGroup1 = new List<string>() { "V46" };
|
|||
|
|
_lstGroup2 = new List<string>() { "V43" };
|
|||
|
|
_lstGroup3 = new List<string>() { "V45" };
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (!_pmIoInterLock.SetPMExchangeMoRoutineRunning(true, out string reason))
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog(Module, $"can not Exchange Mo,{reason}");
|
|||
|
|
return Result.FAIL;
|
|||
|
|
}
|
|||
|
|
_swTimer.Restart();
|
|||
|
|
Notify("Start");
|
|||
|
|
return Result.RUN;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public override Result Monitor()
|
|||
|
|
{
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
if (SC.GetValue<bool>("System.IsATMMode"))
|
|||
|
|
{
|
|||
|
|
return Result.DONE;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
CheckRoutineTimeOut();
|
|||
|
|
|
|||
|
|
// 关闭E组和K组的阀门
|
|||
|
|
SetIoValueByGroup((int)RoutineStep.SetGroupE, IoGroupName.E, false, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByGroup((int)RoutineStep.SetGroupK, IoGroupName.K, false, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByGroup((int)RoutineStep.SetGroupV25, IoGroupName.V25, true, _IoValueOpenCloseTimeout);
|
|||
|
|
|
|||
|
|
|
|||
|
|
//设定M7,M8 80%,PC2设定Max
|
|||
|
|
SetMfcValueByPercent((int)RoutineStep.SetM7, mfc7Or10, 80);
|
|||
|
|
SetMfcValueByPercent((int)RoutineStep.SetM8, mfc8Or12, 80);
|
|||
|
|
if (_isTCS)
|
|||
|
|
{
|
|||
|
|
SetMfcValueByPercent((int)RoutineStep.SetM11, mfc11, 80);
|
|||
|
|
}
|
|||
|
|
SetPCValueByPercent((int)RoutineStep.SetPc2, pc2Or3, 100);
|
|||
|
|
|
|||
|
|
//打开V73,V46,V46s，保持30s
|
|||
|
|
SetIoValueByList((int)RoutineStep.OpenV73, _lstGroupV73, true, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup11, _lstGroup1, true, _IoValueOpenCloseTimeout);
|
|||
|
|
TimeDelay((int)RoutineStep.TimeDelay1, 30);
|
|||
|
|
|
|||
|
|
//Loop
|
|||
|
|
Loop((int)RoutineStep.StartLoop, _loopCount);
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup1, _lstGroup1, false, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup2, _lstGroup2, true, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup3, _lstGroup3, true, _IoValueOpenCloseTimeout);
|
|||
|
|
TimeDelay((int)RoutineStep.TimeDelay2, _OpenTime);
|
|||
|
|
|
|||
|
|
//SetIoValueByList((int)RoutineStep.SetGroup4, _lstGroup3, false, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup5, _lstGroup2, false, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup6, _lstGroup1, true, _IoValueOpenCloseTimeout);
|
|||
|
|
TimeDelay((int)RoutineStep.TimeDelay3, _CLoseTime);
|
|||
|
|
|
|||
|
|
EndLoop((int)RoutineStep.EndLoop);
|
|||
|
|
|
|||
|
|
//关闭V73,V46,V46s
|
|||
|
|
SetIoValueByList((int)RoutineStep.SetGroup6, _lstGroup1, false, _IoValueOpenCloseTimeout);
|
|||
|
|
SetIoValueByList((int)RoutineStep.CloseV73, _lstGroupV73, false, _IoValueOpenCloseTimeout);
|
|||
|
|
|
|||
|
|
SetMfcValueToDefaultByID((int)RoutineStep.SetM7Default, mfc7Or10);
|
|||
|
|
SetMfcValueToDefaultByID((int)RoutineStep.SetM8Default, mfc8Or12);
|
|||
|
|
if (_isTCS)
|
|||
|
|
{
|
|||
|
|
SetMfcValueToDefaultByID((int)RoutineStep.SetM11Default, mfc11);
|
|||
|
|
}
|
|||
|
|
SetPcToDefault((int)RoutineStep.SetPc2Default, new List<int> { pc2Or3 });
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
catch (RoutineBreakException)
|
|||
|
|
{
|
|||
|
|
return Result.RUN;
|
|||
|
|
}
|
|||
|
|
catch (RoutineFaildException)
|
|||
|
|
{
|
|||
|
|
return Result.FAIL;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
Notify($"Finished ! Elapsed time: {(int)(_swTimer.ElapsedMilliseconds / 1000)} s");
|
|||
|
|
_swTimer.Stop();
|
|||
|
|
SetRoutineRuningDo();
|
|||
|
|
return Result.DONE;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private void SetRoutineRuningDo()
|
|||
|
|
{
|
|||
|
|
_pmIoInterLock.DoExchangeMoRoutineRunning = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public override void Abort()
|
|||
|
|
{
|
|||
|
|
SetRoutineRuningDo();
|
|||
|
|
|
|||
|
|
PmDevice.SetIoValue(_lstGroup1,false);
|
|||
|
|
PmDevice.SetIoValue(_lstGroup2, false);
|
|||
|
|
PmDevice.SetMfcValueToDefault(new List<int> { mfc7Or10 });
|
|||
|
|
PmDevice.SetMfcValueToDefault(new List<int> { mfc8Or12 });
|
|||
|
|
PmDevice.SetMfcValueToDefault(new List<int> { mfc11 });
|
|||
|
|
PmDevice.SetPCValueToDefault(new List<int> { pc2Or3 });
|
|||
|
|
PmDevice.SetRotationServo(0, 0);
|
|||
|
|
|
|||
|
|
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 SetIoValueByList(int id, List<string> lstIo, bool close, int timeout)
|
|||
|
|
{
|
|||
|
|
Tuple<bool, Result> ret = ExecuteAndWait(id, () =>
|
|||
|
|
{
|
|||
|
|
_pm1Module.SetIoValue(lstIo, close);
|
|||
|
|
return true;
|
|||
|
|
}, () =>
|
|||
|
|
{
|
|||
|
|
return _pm1Module.CheckIoValue(lstIo, close);
|
|||
|
|
},
|
|||
|
|
timeout * 1000);
|
|||
|
|
|
|||
|
|
if (ret.Item1)
|
|||
|
|
{
|
|||
|
|
if (ret.Item2 == Result.FAIL)
|
|||
|
|
{
|
|||
|
|
throw (new RoutineFaildException());
|
|||
|
|
}
|
|||
|
|
else if (ret.Item2 == Result.TIMEOUT)
|
|||
|
|
{
|
|||
|
|
throw (new RoutineFaildException());
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
throw (new RoutineBreakException());
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private void SetMfcValueToDefaultByID(int id, int mfcID)
|
|||
|
|
{
|
|||
|
|
Tuple<bool, Result> ret = Execute(id, () =>
|
|||
|
|
{
|
|||
|
|
List<int> lst = new List<int> { mfcID };
|
|||
|
|
_pm1Module.SetMfcModelToNormal(lst);
|
|||
|
|
_pm1Module.SetMfcValueToDefault(lst);
|
|||
|
|
return true;
|
|||
|
|
});
|
|||
|
|
|
|||
|
|
if (ret.Item1)
|
|||
|
|
{
|
|||
|
|
if (ret.Item2 == Result.FAIL)
|
|||
|
|
{
|
|||
|
|
throw (new RoutineFaildException());
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
throw (new RoutineBreakException());
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
private void SetMfcValueByPercent(int id,int mfcID, double percent)
|
|||
|
|
{
|
|||
|
|
Tuple<bool, Result> ret = Execute(id, () =>
|
|||
|
|
{
|
|||
|
|
_pm1Module.SetMfcModelToNormal(new List<int> { mfcID });
|
|||
|
|
_pm1Module.SetMfcValueByPercent(mfcID, percent);
|
|||
|
|
return true;
|
|||
|
|
});
|
|||
|
|
|
|||
|
|
if (ret.Item1)
|
|||
|
|
{
|
|||
|
|
if (ret.Item2 == Result.FAIL)
|
|||
|
|
{
|
|||
|
|
throw (new RoutineFaildException());
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
throw (new RoutineBreakException());
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private void SetPCValueByPercent(int id,int pcID,double percent)
|
|||
|
|
{
|
|||
|
|
Tuple<bool, Result> ret = Execute(id, () =>
|
|||
|
|
{
|
|||
|
|
_pm1Module.SetPcModelToNormal(new List<int> { pcID });
|
|||
|
|
_pm1Module.SetPCValueByPercent(pcID, percent);
|
|||
|
|
return true;
|
|||
|
|
});
|
|||
|
|
|
|||
|
|
if (ret.Item1)
|
|||
|
|
{
|
|||
|
|
if (ret.Item2 == Result.FAIL)
|
|||
|
|
{
|
|||
|
|
throw (new RoutineFaildException());
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
throw (new RoutineBreakException());
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|