360 lines
12 KiB
C#
360 lines
12 KiB
C#
|
using System;
|
|||
|
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;
|
|||
|
|
|||
|
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))
|
|||
|
{
|
|||
|
EV.PostWarningLog(Module, $"Can not {name} valve {Module}.{Name}, {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)
|
|||
|
{
|
|||
|
if (SC.GetValue<bool>($"System.SetUp.Is{Module}Installed"))//PM屏蔽时会调用
|
|||
|
{
|
|||
|
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, string.Format("Valve {0} was {1},Reason:{2}", Display, "Open", 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;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
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;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
}
|