386 lines
13 KiB
C#
386 lines
13 KiB
C#
using System;
|
||
using System.Collections.Generic;
|
||
using System.Reflection;
|
||
using System.Xml;
|
||
using Aitex.Core.Common.DeviceData;
|
||
using Aitex.Core.RT.DataCenter;
|
||
using Aitex.Core.RT.Event;
|
||
using Aitex.Core.RT.IOCore;
|
||
using Aitex.Core.RT.Log;
|
||
using Aitex.Core.RT.OperationCenter;
|
||
using Aitex.Core.RT.SCCore;
|
||
using Aitex.Core.Util;
|
||
using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.LoadPorts.TDK;
|
||
|
||
namespace Aitex.Core.RT.Device.Devices
|
||
{
|
||
public interface IValve
|
||
{
|
||
bool TurnValve(bool isOn, out string reason);
|
||
}
|
||
|
||
public class IoValve : BaseDevice, IDevice, IValve
|
||
{
|
||
public string GVName { get { return Name; } }
|
||
|
||
public string GVDeviceID { get { return DeviceID; } }
|
||
|
||
public bool GVIsDefaultOpen { get { return _isDefaultOpen; } }
|
||
|
||
public Func<bool, bool> FuncCheckInterLock;
|
||
public Func<bool, bool> FuncForceOpen;
|
||
public Action<bool> ActionAfterOnOff; //作用于EPV1和EPV2
|
||
|
||
|
||
[Subscription(AITValveDataPropertyName.SetPoint)]
|
||
public bool SetPoint //True:open| False:close
|
||
{
|
||
get
|
||
{
|
||
if (_doOpen == null)
|
||
return false;
|
||
|
||
return _isNc ? _doOpen.Value : !_doOpen.Value;
|
||
}
|
||
set
|
||
{
|
||
if (_doOpen != null)
|
||
{
|
||
_doOpen.Value = _isNc ? value : !value;
|
||
}
|
||
if (_doClose != null)
|
||
{
|
||
_doClose.Value = _isNc ? !value : value;
|
||
}
|
||
}
|
||
}
|
||
|
||
[Subscription(AITValveDataPropertyName.Status)]
|
||
public bool Status //True:open | False:close
|
||
{
|
||
get
|
||
{
|
||
if (_diOpenSensor != null && _diCloseSensor != null)
|
||
return _diOpenSensor.Value && !_diCloseSensor.Value;
|
||
|
||
if (_diCloseSensor != null)
|
||
return !_diCloseSensor.Value;
|
||
|
||
if (_diOpen != null)
|
||
return _isNc ? _diOpen.Value : !_diOpen.Value;
|
||
|
||
if (_doOpen != null)
|
||
return _isNc ? _doOpen.Value : !_doOpen.Value;
|
||
|
||
if (_doClose != null)
|
||
return _isNc ? !_doClose.Value : _doClose.Value;
|
||
return false;
|
||
}
|
||
}
|
||
|
||
private AITValveData DeviceData
|
||
{
|
||
get
|
||
{
|
||
AITValveData data = new AITValveData()
|
||
{
|
||
UniqueName = _uniqueName,
|
||
DeviceName = GVName,
|
||
DefaultValue = GVIsDefaultOpen,
|
||
DeviceSchematicId = DeviceID,
|
||
DisplayName = Display,
|
||
Feedback = Status,
|
||
SetPoint = SetPoint,
|
||
};
|
||
|
||
return data;
|
||
}
|
||
}
|
||
|
||
/// <summary>
|
||
/// normal closed, 0 关闭,1打开
|
||
/// </summary>
|
||
public bool _isNc;
|
||
|
||
/// <summary>
|
||
/// default open
|
||
/// </summary>
|
||
public bool _isDefaultOpen;
|
||
|
||
private DIAccessor _diOpenSensor;
|
||
private DIAccessor _diCloseSensor;
|
||
|
||
private DIAccessor _diOpen;
|
||
private DOAccessor _doOpen;
|
||
private DOAccessor _doClose;
|
||
|
||
private bool _operation;
|
||
|
||
R_TRIG forceOpenTrigger = new R_TRIG();
|
||
R_TRIG eventTrigger = new R_TRIG();
|
||
R_TRIG _mutexSignalTrigger = new R_TRIG();
|
||
DeviceTimer _timer = new DeviceTimer();
|
||
DeviceTimer _mutexSignalTimer = new DeviceTimer();
|
||
private SCConfigItem _scBypassEnableTable;
|
||
|
||
private string _uniqueName;
|
||
|
||
public IoValve(string module, XmlElement node, string ioModule = "")
|
||
{
|
||
var attrModule = node.GetAttribute("module");
|
||
base.Module = string.IsNullOrEmpty(attrModule) ? module : attrModule;
|
||
base.Name = node.GetAttribute("id");
|
||
base.Display = node.GetAttribute("display");
|
||
base.DeviceID = node.GetAttribute("schematicId");
|
||
|
||
_isNc = Convert.ToBoolean(node.GetAttribute("isNc"));
|
||
_isDefaultOpen = Convert.ToBoolean(node.GetAttribute("isDefaultOpen"));
|
||
|
||
_diOpenSensor = ParseDiNode("diOpenSensor", node, ioModule);
|
||
_diCloseSensor = ParseDiNode("diCloseSensor", node, ioModule);
|
||
_doOpen = ParseDoNode("doOpen", node, ioModule);
|
||
_diOpen = ParseDiNode("diOpen", node, ioModule);
|
||
_doClose = ParseDoNode("doClose", node, ioModule);
|
||
|
||
_uniqueName = $"{Module}.{Name}";
|
||
_scBypassEnableTable = ParseScNode("BypassEnableTable", node, module, "System.BypassEnableTable");
|
||
}
|
||
|
||
public bool Initialize()
|
||
{
|
||
DATA.Subscribe($"Device.{Module}.{GVName}", () => DeviceData);
|
||
DATA.Subscribe($"{_uniqueName}.DeviceData", () => DeviceData);
|
||
|
||
OP.Subscribe($"{_uniqueName}.{AITValveOperation.GVTurnValve}", InvokeOpenCloseValve);
|
||
|
||
|
||
DEVICE.Register(String.Format("{0}.{1}", Name, AITValveOperation.GVTurnValve), (out string reason, int time, object[] param) =>
|
||
{
|
||
bool bOn = Convert.ToBoolean((string)param[0]);
|
||
bool ret = TurnValve(bOn, out reason);
|
||
if (ret)
|
||
{
|
||
reason = string.Format("Valve {0}{1}", Name, bOn ? "Open" : "Close");
|
||
return true;
|
||
}
|
||
|
||
return false;
|
||
});
|
||
|
||
//for recipe
|
||
DEVICE.Register(String.Format("{0}", Name), (out string reason, int time, object[] param) =>
|
||
{
|
||
bool bOn = Convert.ToBoolean((string)param[0]);
|
||
bool ret = TurnValve(bOn, out reason);
|
||
if (ret)
|
||
{
|
||
reason = string.Format("Valve {0}{1}", Name, bOn ? "Open" : "Close");
|
||
return true;
|
||
}
|
||
|
||
return false;
|
||
});
|
||
|
||
return true;
|
||
}
|
||
|
||
public void Terminate()
|
||
{
|
||
string reason;
|
||
TurnValve(_isDefaultOpen, out reason);
|
||
}
|
||
|
||
|
||
|
||
private bool InvokeOpenCloseValve(string method, object[] args)
|
||
{
|
||
string reason;
|
||
bool op = Convert.ToBoolean(args[0]);
|
||
string name = op ? "Open" : "Close";
|
||
|
||
if (!TurnValve(op, out reason))
|
||
return false;
|
||
|
||
EV.PostInfoLog(Module, $"{name} valve {Module}.{Name}");
|
||
|
||
return true;
|
||
}
|
||
|
||
public void Monitor()
|
||
{
|
||
try
|
||
{
|
||
if (_diOpenSensor != null && _diCloseSensor != null)
|
||
{
|
||
if (_diOpenSensor.Value != _diCloseSensor.Value)
|
||
{
|
||
_mutexSignalTimer.Start(2000);
|
||
}
|
||
|
||
_mutexSignalTrigger.CLK = _mutexSignalTimer.IsTimeout();
|
||
|
||
if (_mutexSignalTrigger.Q)
|
||
{
|
||
EV.PostWarningLog(Module, $"Valve {Name} was abnormal,Reason:diOpenSensor's value is {_diOpenSensor.Value} and diCloseSensor's value is {_diCloseSensor.Value} too.");
|
||
}
|
||
}
|
||
|
||
if (_timer.IsTimeout())
|
||
{
|
||
forceOpenTrigger.RST = true;
|
||
_timer.Stop();
|
||
|
||
if (Status != _operation)
|
||
{
|
||
if (_operation)
|
||
{
|
||
string reason;
|
||
if (!_doOpen.Check(_isNc ? true : false, out reason))
|
||
EV.PostMessage(Module, EventEnum.ValveOperationFail, Module, Display, "Open", ":Failed for interlock " + reason);
|
||
else
|
||
EV.PostMessage(Module, EventEnum.ValveOperationFail, Module, Display, "Open", ":Valve keep closed ");
|
||
|
||
}
|
||
else
|
||
{
|
||
string reason;
|
||
if (!_doOpen.Check(_isNc ? true : false, out reason))
|
||
EV.PostMessage(Module, EventEnum.ValveOperationFail, Module, Display, "Close", ":Failed for interlock " + reason);
|
||
else
|
||
EV.PostMessage(Module, EventEnum.ValveOperationFail, Module, Display, "Close", ":Valve keep open");
|
||
|
||
}
|
||
}
|
||
else if(ActionAfterOnOff != null)
|
||
{
|
||
ActionAfterOnOff(Status);
|
||
}
|
||
_operation = SetPoint;
|
||
}
|
||
else if (_timer.IsIdle())
|
||
{
|
||
eventTrigger.CLK = SetPoint != _operation; // fire event only check at first, SetPoint set by interlock
|
||
if (eventTrigger.Q)
|
||
{
|
||
if (_operation)
|
||
{
|
||
string reason;
|
||
if (!_doOpen.Check(_isNc ? true : false, out reason))
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module, string.Format("Valve {0} was {1},Reason:{2}", Display, "Close", reason));
|
||
else
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module, string.Format("Valve {0} was {1},Reason {2}", Display, "Close", "PLC kept"));
|
||
}
|
||
else
|
||
{
|
||
string reason;
|
||
if (!_doOpen.Check(_isNc ? true : false, out reason))
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module, string.Format("Valve {0} was {1},Reason:{2}", Display, "Open", reason));
|
||
else
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module, string.Format("Valve {0} was {1},Reason {2}", Display, "Open", "PLC Kept"));
|
||
}
|
||
_operation = SetPoint;
|
||
}
|
||
}
|
||
|
||
//达到一定条件,强制打开阀门
|
||
if(FuncForceOpen!= null && !_scBypassEnableTable.BoolValue)
|
||
{
|
||
forceOpenTrigger.CLK = FuncForceOpen(Status);
|
||
if (forceOpenTrigger.Q)
|
||
{
|
||
SetPoint = !Status;
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module, $"Force Set {Name} to {!Status} for Interlock enable table!");
|
||
}
|
||
}
|
||
}
|
||
catch (Exception ex)
|
||
{
|
||
LOG.Write(ex);
|
||
|
||
}
|
||
|
||
}
|
||
|
||
|
||
public bool TurnValve(bool isOn, out string reason)
|
||
{
|
||
bool bValue = _isNc ? isOn : !isOn;
|
||
var stringOnOff = isOn ? "On" : "Off";
|
||
|
||
if (_doOpen != null)
|
||
{
|
||
if (!_doOpen.Check(bValue, out reason))
|
||
{
|
||
EV.PostWarningLog(Module, $"Turn {Display} {stringOnOff} failed for Interlock!");
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module,
|
||
$"Valve {Display} was {stringOnOff},Reason:{reason}");
|
||
return false;
|
||
}
|
||
|
||
if (FuncCheckInterLock != null && !_scBypassEnableTable.BoolValue)
|
||
{
|
||
if (!FuncCheckInterLock(isOn))
|
||
{
|
||
EV.PostWarningLog(Module, $"Turn {Display} {stringOnOff} failed for check condition!");
|
||
return false;
|
||
}
|
||
}
|
||
}
|
||
if (_doClose != null)
|
||
{
|
||
if (!_doClose.Check(!bValue, out reason))
|
||
{
|
||
EV.PostMessage(Module, EventEnum.SwInterlock, Module, string.Format("Valve {0} was {1},Reason:{2}", Display, "Close", reason));
|
||
return false;
|
||
}
|
||
}
|
||
|
||
string _mfcName;
|
||
if (ControlMFC.ValveControlMFC.TryGetValue(Name, out _mfcName))
|
||
{
|
||
if (!isOn)//关闭蝶阀时,关闭MFC,如果MFC为0时可以不用设置,但是没有获取MFC当前状态的函数,
|
||
{
|
||
IoMFC ioValve = DEVICE.GetDevice<IoMFC>($"{Module}.{_mfcName}");
|
||
if (ioValve != null)
|
||
{
|
||
ioValve.Ramp(0, 0);
|
||
EV.PostInfoLog(Module, $"{Module} {_mfcName} Close Before {Display} Close");
|
||
}
|
||
|
||
}
|
||
}
|
||
|
||
EV.PostInfoLog(Module, $"Turn {Display} {stringOnOff}");
|
||
|
||
reason = "";
|
||
SetPoint = isOn;
|
||
|
||
_operation = isOn;
|
||
_timer.Start(2000); //2 seconds to monitor
|
||
|
||
return true;
|
||
}
|
||
|
||
public void Reset()
|
||
{
|
||
eventTrigger.RST = true;
|
||
forceOpenTrigger.RST = true;
|
||
}
|
||
|
||
|
||
}
|
||
|
||
public class ControlMFC
|
||
{
|
||
/// <summary>
|
||
/// Key= IoValve_id , Value=IoMFC_id
|
||
/// </summary>
|
||
public static Dictionary<string, string> ValveControlMFC = new Dictionary<string, string>()
|
||
{
|
||
{ "TMVent","Mfc60" },
|
||
{ "V96",$"Mfc38" },
|
||
{ "V94",$"Mfc36" },
|
||
};
|
||
}
|
||
}
|