291 lines
9.1 KiB
C#
291 lines
9.1 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.SCCore;
|
||
using Aitex.Core.Util;
|
||
|
||
namespace Aitex.Core.RT.Device.Unit
|
||
{
|
||
public enum SlitValveStateEnum
|
||
{
|
||
Unknown,
|
||
Up,
|
||
Down,
|
||
Error,
|
||
}
|
||
|
||
public class IoSlitValve : BaseDevice, IDevice
|
||
{
|
||
public SlitValveStateEnum State
|
||
{
|
||
get
|
||
{
|
||
if (_diOpen.Value && _diClose.Value)
|
||
return SlitValveStateEnum.Error;
|
||
if (_diOpen.Value && !_diClose.Value)
|
||
return SlitValveStateEnum.Up;
|
||
if (!_diOpen.Value && _diClose.Value)
|
||
return SlitValveStateEnum.Down;
|
||
return SlitValveStateEnum.Unknown;
|
||
}
|
||
}
|
||
enum DeviceState
|
||
{
|
||
Idle,
|
||
Opening,
|
||
Closing,
|
||
Error,
|
||
}
|
||
|
||
private DIAccessor _diOpen;
|
||
private DIAccessor _diClose;
|
||
|
||
private DIAccessor _diOpenEnable;
|
||
private DIAccessor _diCloseEnable;
|
||
|
||
private DOAccessor _doOpen;
|
||
private DOAccessor _doClose;
|
||
|
||
private DeviceState _state = DeviceState.Idle;
|
||
private DeviceTimer _timer = new DeviceTimer();
|
||
|
||
private SCConfigItem _scTimeout;
|
||
|
||
public bool IsOpen { get { return !_diClose.Value && _diOpen.Value; } }
|
||
public bool IsClose { get { return _diClose.Value && !_diOpen.Value; } }
|
||
|
||
public bool EnableOpenInterlock { get { return _diOpenEnable.Value; } }
|
||
public bool EnableCloseInterlock { get { return _diCloseEnable.Value; } }
|
||
|
||
//在开&关完成之后，是否保持输出，默认不保持
|
||
private bool _keepSignalOut = false;
|
||
private DeviceTimer _mutexSignalTimer = new DeviceTimer();
|
||
private R_TRIG _mutexSignalTrigger = new R_TRIG();
|
||
|
||
public IoSlitValve(string module, XmlElement node, string ioModule = "")
|
||
{
|
||
base.Module = string.IsNullOrEmpty(node.GetAttribute("module")) ? module : node.GetAttribute("module");
|
||
base.Name = node.GetAttribute("id");
|
||
base.Display = node.GetAttribute("display");
|
||
base.DeviceID = node.GetAttribute("schematicId");
|
||
|
||
_keepSignalOut = string.IsNullOrEmpty(node.GetAttribute("keepSignalOut")) ? false : Convert.ToBoolean(node.GetAttribute("keepSignalOut"));
|
||
_diOpen = ParseDiNode("diOpen", node, ioModule);
|
||
_diClose = ParseDiNode("diClose", node, ioModule);
|
||
|
||
_diOpenEnable = ParseDiNode("diOpenEnable", node, ioModule);
|
||
_diCloseEnable = ParseDiNode("diCloseEnable", node, ioModule);
|
||
|
||
_doOpen = ParseDoNode("doOpen", node, ioModule);
|
||
_doClose = ParseDoNode("doClose", node, ioModule);
|
||
|
||
_scTimeout = ParseScNode("scTimeout", node, ioModule);
|
||
}
|
||
|
||
public bool Initialize()
|
||
{
|
||
_state = DeviceState.Idle;
|
||
|
||
DATA.Subscribe($"{Module}.{Name}.OpenFeedback", () => _diOpen.Value);
|
||
DATA.Subscribe($"{Module}.{Name}.OpenEnable", () => _diOpenEnable != null ? _diOpenEnable.Value : false);
|
||
DATA.Subscribe($"{Module}.{Name}.OpenSetpoint", () => _doOpen.Value);
|
||
|
||
DATA.Subscribe($"{Module}.{Name}.CloseEnable", () => _diCloseEnable != null ? _diCloseEnable.Value : false);
|
||
DATA.Subscribe($"{Module}.{Name}.CloseFeedback", () => _diClose.Value);
|
||
DATA.Subscribe($"{Module}.{Name}.CloseSetpoint", () => _doClose.Value);
|
||
|
||
DEVICE.Register($"{Module}.{Name}.Open", (out string reason, int time, object[] param) =>
|
||
{
|
||
reason = "";
|
||
return Open(out reason);
|
||
});
|
||
|
||
DEVICE.Register($"{Module}.{Name}.Close", (out string reason, int time, object[] param) =>
|
||
{
|
||
reason = "";
|
||
return Close(out reason);
|
||
});
|
||
|
||
return true;
|
||
}
|
||
|
||
|
||
public void Monitor()
|
||
{
|
||
if (_diOpen != null && _diClose != null)
|
||
{
|
||
if (State != SlitValveStateEnum.Error)
|
||
{
|
||
_mutexSignalTimer.Start(2000);
|
||
}
|
||
|
||
_mutexSignalTrigger.CLK = _mutexSignalTimer.IsTimeout();
|
||
|
||
if (_mutexSignalTrigger.Q)
|
||
{
|
||
EV.PostWarningLog(Module, $"Valve {Name} was abnormal，Reason：diOpen's value is {_diOpen.Value} and diClose's value is {_diClose.Value} too.");
|
||
}
|
||
}
|
||
|
||
switch (_state)
|
||
{
|
||
case DeviceState.Opening:
|
||
if (IsOpen)
|
||
{
|
||
if (!_keepSignalOut)
|
||
{
|
||
if (!_doOpen.SetValue(false, out string reason))
|
||
{
|
||
LOG.Error($"{Module} reset DO failed, {reason}");
|
||
}
|
||
}
|
||
|
||
_state = DeviceState.Idle;
|
||
}
|
||
else if (_timer.IsTimeout())
|
||
{
|
||
if (!_doOpen.SetValue(false, out string reason))
|
||
{
|
||
LOG.Error($"{Module} reset DO failed, {reason}");
|
||
}
|
||
|
||
if (_keepSignalOut)
|
||
{
|
||
_doClose.SetValue(true, out _);
|
||
}
|
||
|
||
EV.PostAlarmLog(Module, $"{Module} {Name} Can not open in {_scTimeout.IntValue} seconds");
|
||
|
||
_state = DeviceState.Error;
|
||
}
|
||
break;
|
||
case DeviceState.Closing:
|
||
if (IsClose)
|
||
{
|
||
if (!_keepSignalOut)
|
||
{
|
||
if (!_doClose.SetValue(false, out string reason))
|
||
{
|
||
LOG.Error($"{Module} reset DO failed, {reason}");
|
||
}
|
||
}
|
||
|
||
_state = DeviceState.Idle;
|
||
}
|
||
else if (_timer.IsTimeout())
|
||
{
|
||
if (!_doClose.SetValue(false, out string reason))
|
||
{
|
||
LOG.Error($"{Module} reset DO failed, {reason}");
|
||
}
|
||
|
||
if (_keepSignalOut)
|
||
{
|
||
_doOpen.SetValue(true, out _);
|
||
}
|
||
|
||
EV.PostAlarmLog(Module, $"{Module} {Name} Can not close in {_scTimeout.IntValue} seconds");
|
||
|
||
_state = DeviceState.Error;
|
||
}
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
|
||
public void Terminate()
|
||
{
|
||
if (!_keepSignalOut)
|
||
{
|
||
_doOpen.SetValue(false, out _);
|
||
_doClose.SetValue(false, out _);
|
||
}
|
||
}
|
||
|
||
public bool CheckInterlockEnable(bool open)
|
||
{
|
||
return open ? (_diOpenEnable == null || _diOpenEnable.Value) : (_diCloseEnable == null || _diCloseEnable.Value);
|
||
}
|
||
|
||
public bool SetSlitValve(bool open, out string reason)
|
||
{
|
||
if (open)
|
||
return Open(out reason);
|
||
|
||
return Close(out reason);
|
||
|
||
}
|
||
|
||
public bool Open(out string reason)
|
||
{
|
||
if (_diOpenEnable != null && !_diOpenEnable.Value)
|
||
{
|
||
reason = "interlock blocked open";
|
||
return false;
|
||
}
|
||
|
||
if (!_doClose.SetValue(false, out reason) || !_doOpen.SetValue(true, out reason))
|
||
{
|
||
_doOpen.SetValue(false, out _);
|
||
|
||
if (_keepSignalOut)
|
||
{
|
||
_doClose.SetValue(true, out _);
|
||
}
|
||
else
|
||
{
|
||
_doClose.SetValue(false, out _);
|
||
}
|
||
return false;
|
||
}
|
||
|
||
_timer.Start(_scTimeout.IntValue * 1000);
|
||
|
||
_state = DeviceState.Opening;
|
||
return true;
|
||
}
|
||
|
||
|
||
public bool Close(out string reason)
|
||
{
|
||
if (_diCloseEnable != null && !_diCloseEnable.Value)
|
||
{
|
||
reason = "interlock blocked close";
|
||
return false;
|
||
}
|
||
|
||
if (!_doClose.SetValue(true, out reason) || !_doOpen.SetValue(false, out reason))
|
||
{
|
||
_doClose.SetValue(false, out _);
|
||
|
||
if (_keepSignalOut)
|
||
{
|
||
_doOpen.SetValue(true, out _);
|
||
}
|
||
else
|
||
{
|
||
_doOpen.SetValue(false, out _);
|
||
}
|
||
return false;
|
||
}
|
||
|
||
_timer.Start(_scTimeout.IntValue * 1000);
|
||
|
||
_state = DeviceState.Closing;
|
||
|
||
return true;
|
||
}
|
||
|
||
|
||
public void Reset()
|
||
{
|
||
}
|
||
}
|
||
}
|
||
|