840 lines
30 KiB
C#
840 lines
30 KiB
C#
|
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.RT.Tolerance;
|
|||
|
|
using Aitex.Core.Util;
|
|||
|
|
using MECF.Framework.Common.Event;
|
|||
|
|
using System;
|
|||
|
|
using System.Collections.Generic;
|
|||
|
|
using System.Linq;
|
|||
|
|
using System.Xml;
|
|||
|
|
|
|||
|
|
namespace Aitex.Core.RT.Device.Unit
|
|||
|
|
{
|
|||
|
|
public class RfTuneItem
|
|||
|
|
{
|
|||
|
|
public float RangeFrom { get; set; }
|
|||
|
|
public float RangeTo { get; set; }
|
|||
|
|
public float Percent { get; set; }
|
|||
|
|
public float Value { get; set; }
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public class IoRf2 : BaseDevice, IDevice
|
|||
|
|
{
|
|||
|
|
public float PowerRange
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
return _scPowerRange == null ? 1000 : (float)_scPowerRange.IntValue;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public float ScaleFrequency
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
return 1000;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
public string UnitPower
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
return "W";
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool IsRfOn //True：on
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
if (_diStatus != null)
|
|||
|
|
return _diStatus.Value;
|
|||
|
|
|
|||
|
|
return _doPowerOn.Value;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public float PowerSetPoint
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
float tuned = _isFloatAioType ? GetTuneValue(_aoPower.FloatValue, false) : GetTuneValue(_aoPower.Value, false);
|
|||
|
|
float calibrated = CalibrationPower(tuned, false);
|
|||
|
|
if (calibrated < 0)
|
|||
|
|
calibrated = 0;
|
|||
|
|
|
|||
|
|
return calibrated;
|
|||
|
|
}
|
|||
|
|
set
|
|||
|
|
{
|
|||
|
|
float tuned = GetTuneValue(value, true);
|
|||
|
|
float calibrated = CalibrationPower(tuned, true);
|
|||
|
|
if (calibrated < 0)
|
|||
|
|
calibrated = 0;
|
|||
|
|
|
|||
|
|
if (_isFloatAioType)
|
|||
|
|
_aoPower.FloatValue = calibrated;
|
|||
|
|
else
|
|||
|
|
_aoPower.Value = (short)calibrated;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public float RFForwardPower
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
if (_aiForwardPower == null)
|
|||
|
|
return 0;
|
|||
|
|
|
|||
|
|
float tuned = _isFloatAioType
|
|||
|
|
? GetTuneValue(_aiForwardPower.FloatValue, false)
|
|||
|
|
: GetTuneValue(_aiForwardPower.Value, false);
|
|||
|
|
|
|||
|
|
float calibrated = CalibrationPower(tuned, false);
|
|||
|
|
if (calibrated < 0)
|
|||
|
|
calibrated = 0;
|
|||
|
|
|
|||
|
|
return calibrated;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public float RFReflectPower
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
return _aiReflectedPower == null ? 0 : (_isFloatAioType ? GetTuneValue(_aiReflectedPower.FloatValue, false) : GetTuneValue(_aiReflectedPower.Value, false));
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool RFInterlock
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
return _diIntlk == null || _diIntlk.Value;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool MainPowerOnSetPoint
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
if (_doPowerOn != null)
|
|||
|
|
return _doPowerOn.Value;
|
|||
|
|
return false;
|
|||
|
|
}
|
|||
|
|
set
|
|||
|
|
{
|
|||
|
|
if (_doPowerOn != null)
|
|||
|
|
{
|
|||
|
|
if (!_doPowerOn.SetValue(value, out string reason))
|
|||
|
|
{
|
|||
|
|
LOG.Write(reason);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private DateTime _powerOnStartTime;
|
|||
|
|
private TimeSpan _powerOnElapsedTime;
|
|||
|
|
public string PowerOnTime
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
if (IsRfOn)
|
|||
|
|
_powerOnElapsedTime = DateTime.Now - _powerOnStartTime;
|
|||
|
|
|
|||
|
|
return string.Format("{0}:{1}:{2}", ((int)_powerOnElapsedTime.TotalHours).ToString("00"),
|
|||
|
|
_powerOnElapsedTime.Minutes.ToString("00"), (_powerOnElapsedTime.Seconds > 0 ? (_powerOnElapsedTime.Seconds + 1) : 0).ToString("00"));
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private AITRfData DeviceData
|
|||
|
|
{
|
|||
|
|
get
|
|||
|
|
{
|
|||
|
|
AITRfData data = new AITRfData()
|
|||
|
|
{
|
|||
|
|
Module = Module,
|
|||
|
|
DeviceName = Name,
|
|||
|
|
DeviceSchematicId = DeviceID,
|
|||
|
|
DisplayName = Display,
|
|||
|
|
ForwardPower = RFForwardPower,
|
|||
|
|
ReflectPower = RFReflectPower,
|
|||
|
|
IsInterlockOk = RFInterlock,
|
|||
|
|
IsRfOn = IsRfOn,
|
|||
|
|
IsRfAlarm = _diAlarm.Value,
|
|||
|
|
|
|||
|
|
PowerSetPoint = PowerSetPoint,
|
|||
|
|
|
|||
|
|
ScalePower = PowerRange,
|
|||
|
|
|
|||
|
|
UnitPower = UnitPower,
|
|||
|
|
|
|||
|
|
PowerOnElapsedTime = PowerOnTime,
|
|||
|
|
|
|||
|
|
EnablePulsing = false,
|
|||
|
|
EnableVoltageCurrent = false,
|
|||
|
|
|
|||
|
|
IsToleranceError = !AlarmPowerToleranceAlarm.IsAcknowledged || !AlarmReflectPowerToleranceAlarm.IsAcknowledged,
|
|||
|
|
IsToleranceWarning = !AlarmPowerToleranceWarning.IsAcknowledged || !AlarmReflectPowerToleranceWarning.IsAcknowledged,
|
|||
|
|
|
|||
|
|
WorkMode = (int)RfMode.ContinuousWaveMode,
|
|||
|
|
};
|
|||
|
|
|
|||
|
|
return data;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
private DIAccessor _diStatus = null;
|
|||
|
|
private DIAccessor _diIntlk = null;
|
|||
|
|
private DIAccessor _diAlarm;
|
|||
|
|
|
|||
|
|
private DOAccessor _doPowerOn = null;
|
|||
|
|
private DOAccessor _doOn = null;
|
|||
|
|
|
|||
|
|
private AIAccessor _aiReflectedPower = null;
|
|||
|
|
private AIAccessor _aiForwardPower = null;
|
|||
|
|
|
|||
|
|
private AOAccessor _aoPower = null;
|
|||
|
|
|
|||
|
|
//SC
|
|||
|
|
private SCConfigItem _scEnablePowerAlarm;
|
|||
|
|
private SCConfigItem _scPowerAlarmRange = null;
|
|||
|
|
private SCConfigItem _scPowerAlarmTime = null;
|
|||
|
|
private SCConfigItem _scPowerWarningRange = null;
|
|||
|
|
private SCConfigItem _scPowerWarningTime = null;
|
|||
|
|
|
|||
|
|
private SCConfigItem _scEnableReflectPowerAlarm;
|
|||
|
|
private SCConfigItem _scReflectPowerAlarmRange = null;
|
|||
|
|
private SCConfigItem _scReflectPowerAlarmTime = null;
|
|||
|
|
private SCConfigItem _scReflectPowerWarningRange = null;
|
|||
|
|
private SCConfigItem _scReflectPowerWarningTime = null;
|
|||
|
|
|
|||
|
|
private SCConfigItem _scPowerRange;
|
|||
|
|
private SCConfigItem _scCoefficient;
|
|||
|
|
private SCConfigItem _scPowerOnTimeout;
|
|||
|
|
|
|||
|
|
private SCConfigItem _scPowerTuneEnable;
|
|||
|
|
private SCConfigItem _scPowerTuneIsPercent;
|
|||
|
|
private SCConfigItem _scPowerTuneTable;
|
|||
|
|
|
|||
|
|
private SCConfigItem[] _scPowerCalibrationTable;
|
|||
|
|
private SCConfigItem _scPowerCalibrationEnable;
|
|||
|
|
|
|||
|
|
private F_TRIG _trigInterlock = new F_TRIG();
|
|||
|
|
private R_TRIG _trigOn = new R_TRIG();
|
|||
|
|
private R_TRIG _trigError = new R_TRIG();
|
|||
|
|
|
|||
|
|
readonly DeviceTimer _powerOnTimer = new DeviceTimer();
|
|||
|
|
|
|||
|
|
private const string RFHighReflect = "RFHighReflect";
|
|||
|
|
private const string RFHardwareInterlock = "RFHardwareInterlock";
|
|||
|
|
private const string RFOutOfTolerance = "RFOutOfTolerance";
|
|||
|
|
|
|||
|
|
public AlarmEventItem AlarmPowerOnFailed { get; set; }
|
|||
|
|
|
|||
|
|
public AlarmEventItem AlarmPowerToleranceWarning { get; set; }
|
|||
|
|
public AlarmEventItem AlarmPowerToleranceAlarm { get; set; }
|
|||
|
|
|
|||
|
|
public AlarmEventItem AlarmReflectPowerToleranceWarning { get; set; }
|
|||
|
|
public AlarmEventItem AlarmReflectPowerToleranceAlarm { get; set; }
|
|||
|
|
|
|||
|
|
public AlarmEventItem AlarmDeviceAlarm { get; set; }
|
|||
|
|
|
|||
|
|
private ToleranceChecker _checkerPowerWarning;
|
|||
|
|
private ToleranceChecker _checkerPowerAlarm;
|
|||
|
|
private ToleranceChecker _checkerReflectPowerWarning;
|
|||
|
|
private ToleranceChecker _checkerReflectPowerAlarm;
|
|||
|
|
|
|||
|
|
private bool _isFloatAioType = false;
|
|||
|
|
|
|||
|
|
private List<RfTuneItem> _tuneTable;
|
|||
|
|
|
|||
|
|
|
|||
|
|
//calibration
|
|||
|
|
private List<CalbrationParas> _calibrationFormla;
|
|||
|
|
private List<RFCalibrationItem> _rfCalibrationDatas = new List<RFCalibrationItem>();
|
|||
|
|
private const int TenPoints = 10;
|
|||
|
|
|
|||
|
|
public IoRf2(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");
|
|||
|
|
|
|||
|
|
string scBasePath = node.GetAttribute("scBasePath");
|
|||
|
|
if (string.IsNullOrEmpty(scBasePath))
|
|||
|
|
scBasePath = $"{Module}.{Name}";
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
scBasePath = scBasePath.Replace("{module}", Module);
|
|||
|
|
}
|
|||
|
|
_isFloatAioType = !string.IsNullOrEmpty(node.GetAttribute("aioType")) && (node.GetAttribute("aioType") == "float");
|
|||
|
|
|
|||
|
|
_diStatus = ParseDiNode("diOn", node, ioModule);
|
|||
|
|
_diIntlk = ParseDiNode("diInterlock", node, ioModule);
|
|||
|
|
_diAlarm = ParseDiNode("diAlarm", node, ioModule);
|
|||
|
|
|
|||
|
|
_doPowerOn = ParseDoNode("doPowerOn", node, ioModule);
|
|||
|
|
_doOn = ParseDoNode("doOn", node, ioModule);
|
|||
|
|
|
|||
|
|
_aiReflectedPower = ParseAiNode("aiReflectPower", node, ioModule);
|
|||
|
|
_aiForwardPower = ParseAiNode("aiForwardPower", node, ioModule);
|
|||
|
|
|
|||
|
|
_aoPower = ParseAoNode("aoPower", node, ioModule);
|
|||
|
|
|
|||
|
|
_scEnablePowerAlarm = ParseScNode("scEnablePowerAlarm", node, ioModule, $"{scBasePath}.{Name}.EnablePowerAlarm");
|
|||
|
|
_scPowerAlarmRange = ParseScNode("scPowerAlarmRange", node, ioModule, $"{scBasePath}.{Name}.PowerAlarmRange");
|
|||
|
|
_scPowerAlarmTime = ParseScNode("scPowerAlarmTime", node, ioModule, $"{scBasePath}.{Name}.PowerAlarmTime");
|
|||
|
|
_scPowerWarningRange = ParseScNode("scPowerWarningRange", node, ioModule, $"{scBasePath}.{Name}.PowerWarningRange");
|
|||
|
|
_scPowerWarningTime = ParseScNode("scPowerWarningTime", node, ioModule, $"{scBasePath}.{Name}.PowerWarningTime");
|
|||
|
|
|
|||
|
|
_scEnableReflectPowerAlarm = ParseScNode("scEnableReflectPowerAlarm", node, ioModule, $"{scBasePath}.{Name}.EnableReflectPowerAlarm");
|
|||
|
|
_scReflectPowerAlarmRange = ParseScNode("scReflectPowerAlarmRange", node, ioModule, $"{scBasePath}.{Name}.ReflectPowerAlarmRange");
|
|||
|
|
_scReflectPowerAlarmTime = ParseScNode("scReflectPowerAlarmTime", node, ioModule, $"{scBasePath}.{Name}.ReflectPowerAlarmTime");
|
|||
|
|
_scReflectPowerWarningRange = ParseScNode("scReflectPowerWarningRange", node, ioModule, $"{scBasePath}.{Name}.ReflectPowerWarningRange");
|
|||
|
|
_scReflectPowerWarningTime = ParseScNode("scReflectPowerWarningTime", node, ioModule, $"{scBasePath}.{Name}.ReflectPowerWarningTime");
|
|||
|
|
|
|||
|
|
_scPowerRange = ParseScNode("scPowerRange", node, ioModule, $"{scBasePath}.{Name}.PowerRange");
|
|||
|
|
_scCoefficient = ParseScNode("scPowerCoefficient", node, ioModule, $"{scBasePath}.{Name}.PowerCoefficient");
|
|||
|
|
|
|||
|
|
_scPowerOnTimeout = ParseScNode("scPowerOnTimeout", node, ioModule, $"{scBasePath}.{Name}.PowerOnTimeout");
|
|||
|
|
|
|||
|
|
_scPowerTuneEnable = SC.GetConfigItem($"{scBasePath}.{Name}.PowerTuneEnable");
|
|||
|
|
_scPowerTuneIsPercent = SC.GetConfigItem($"{scBasePath}.{Name}.PowerTuneIsPercent");
|
|||
|
|
_scPowerTuneTable = SC.GetConfigItem($"{scBasePath}.{Name}.PowerTuneTable");
|
|||
|
|
|
|||
|
|
_scPowerCalibrationTable = new SCConfigItem[10];
|
|||
|
|
for (int i = 0; i < _scPowerCalibrationTable.Length; i++)
|
|||
|
|
{
|
|||
|
|
_scPowerCalibrationTable[i] = SC.GetConfigItem($"{scBasePath}.{Name}.Rate{i + 1}MeterPower");
|
|||
|
|
}
|
|||
|
|
_scPowerCalibrationEnable = SC.GetConfigItem($"{scBasePath}.{Name}.PowerCalibrationEnable");
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool Initialize()
|
|||
|
|
{
|
|||
|
|
UpdateTuneTable();
|
|||
|
|
InitializeCalalibration();
|
|||
|
|
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.DeviceData", () => DeviceData);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.PowerSetPoint", () => PowerSetPoint);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.ForwardPower", () => RFForwardPower);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.ReflectPower", () => RFReflectPower);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.IsRfOn", () => _diStatus.Value);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.IsInterlockOK", () => RFInterlock);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.RfOnSetPoint", () => _doOn.Value);
|
|||
|
|
DATA.Subscribe($"{Module}.{Name}.IsAlarm", () => _diAlarm.Value);
|
|||
|
|
|
|||
|
|
OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetPowerOnOff}", SetPowerOnOff);
|
|||
|
|
OP.Subscribe($"{Module}.{Name}.{AITRfOperation.SetPower}", SetPower);
|
|||
|
|
|
|||
|
|
AlarmPowerToleranceWarning = SubscribeAlarm($"{Module}.{Name}.PowerToleranceWarning", "", ResetPowerWarningChecker, EventLevel.Warning);
|
|||
|
|
AlarmPowerToleranceAlarm = SubscribeAlarm($"{Module}.{Name}.PowerToleranceAlarm", "", ResetPowerAlarmChecker);
|
|||
|
|
|
|||
|
|
AlarmReflectPowerToleranceWarning = SubscribeAlarm($"{Module}.{Name}.ReflectPowerToleranceWarning", "", ResetReflectPowerWarningChecker, EventLevel.Warning);
|
|||
|
|
AlarmReflectPowerToleranceAlarm = SubscribeAlarm($"{Module}.{Name}.ReflectPowerToleranceAlarm", "", ResetReflectPowerAlarmChecker);
|
|||
|
|
|
|||
|
|
AlarmPowerOnFailed = SubscribeAlarm($"{Module}.{Name}.PowerOnFailed", $"Failed turn {Display} on", null);
|
|||
|
|
AlarmDeviceAlarm = SubscribeAlarm($"{Module}.{Name}.DeviceAlarm", $"{Display} alarmed", ResetDeviceAlarmChecker);
|
|||
|
|
|
|||
|
|
|
|||
|
|
_checkerPowerWarning = new ToleranceChecker(_scPowerAlarmTime.IntValue);
|
|||
|
|
_checkerPowerAlarm = new ToleranceChecker(_scReflectPowerAlarmTime.IntValue);
|
|||
|
|
|
|||
|
|
_checkerReflectPowerWarning = new ToleranceChecker(_scPowerAlarmTime.IntValue);
|
|||
|
|
_checkerReflectPowerAlarm = new ToleranceChecker(_scReflectPowerAlarmTime.IntValue);
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private bool SetPowerOnOff(out string reason, int time, object[] param)
|
|||
|
|
{
|
|||
|
|
return SetPowerOnOff(Convert.ToBoolean((string)param[0]), out reason);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool SetMainPowerOnOff(bool isOn, out string reason)
|
|||
|
|
{
|
|||
|
|
MainPowerOnSetPoint = isOn;
|
|||
|
|
reason = string.Empty;
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private bool SetPower(out string reason, int time, object[] param)
|
|||
|
|
{
|
|||
|
|
reason = string.Empty;
|
|||
|
|
|
|||
|
|
float power = (float)Convert.ToDouble((string)param[0]);
|
|||
|
|
|
|||
|
|
if (power < 0 || power > PowerRange)
|
|||
|
|
{
|
|||
|
|
reason = $"{Name} setpoint value {power} is out of power range, should between 0 and {PowerRange}";
|
|||
|
|
EV.PostWarningLog(Module, reason);
|
|||
|
|
return false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
PowerSetPoint = power;
|
|||
|
|
|
|||
|
|
|
|||
|
|
reason = $"{Name} set power to {power}";
|
|||
|
|
|
|||
|
|
EV.PostInfoLog(Module, reason);
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public void Stop()
|
|||
|
|
{
|
|||
|
|
string reason = String.Empty;
|
|||
|
|
|
|||
|
|
_aoPower.Value = 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void Terminate()
|
|||
|
|
{
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public void Monitor()
|
|||
|
|
{
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
if (_powerOnTimer.IsTimeout() && !_diStatus.Value)
|
|||
|
|
{
|
|||
|
|
AlarmPowerOnFailed.Description =
|
|||
|
|
$"Can not turn {Display} power on in {(int)(_powerOnTimer.GetElapseTime() / 1000)} seconds";
|
|||
|
|
AlarmPowerOnFailed.Set();
|
|||
|
|
SetPowerOnOff(false, out string _);
|
|||
|
|
_powerOnTimer.Stop();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_trigOn.CLK = IsRfOn;
|
|||
|
|
|
|||
|
|
if (_trigOn.Q)
|
|||
|
|
{
|
|||
|
|
_powerOnStartTime = DateTime.Now;
|
|||
|
|
|
|||
|
|
_checkerPowerAlarm.Reset(_scPowerAlarmTime.IntValue);
|
|||
|
|
_checkerPowerWarning.Reset(_scPowerWarningTime.IntValue);
|
|||
|
|
_checkerReflectPowerAlarm.Reset(_scReflectPowerAlarmTime.IntValue);
|
|||
|
|
_checkerReflectPowerWarning.Reset(_scReflectPowerWarningTime.IntValue);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (_trigOn.M)
|
|||
|
|
{
|
|||
|
|
_checkerPowerWarning.Monitor(RFForwardPower, PowerSetPoint - _scPowerWarningRange.IntValue, PowerSetPoint + _scPowerWarningRange.IntValue, _scPowerWarningTime.IntValue);
|
|||
|
|
if (_checkerPowerWarning.Trig)
|
|||
|
|
{
|
|||
|
|
AlarmPowerToleranceWarning.Description = $"{Display} Forward power {RFForwardPower} out of range[{(PowerSetPoint - _scPowerWarningRange.IntValue)},{(PowerSetPoint + _scPowerWarningRange.IntValue)}] in {_scPowerWarningTime.IntValue} seconds";
|
|||
|
|
AlarmPowerToleranceWarning.Set();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_checkerPowerAlarm.Monitor(RFForwardPower, PowerSetPoint - _scPowerAlarmRange.IntValue, PowerSetPoint + _scPowerAlarmRange.IntValue, _scPowerAlarmTime.IntValue);
|
|||
|
|
if (_checkerPowerAlarm.Trig)
|
|||
|
|
{
|
|||
|
|
AlarmPowerToleranceAlarm.Description = $"{Display} Forward power {RFForwardPower} out of range[{(PowerSetPoint - _scPowerAlarmRange.IntValue)},{(PowerSetPoint + _scPowerAlarmRange.IntValue)}] in {_scPowerAlarmTime.IntValue} seconds";
|
|||
|
|
AlarmPowerToleranceAlarm.Set();
|
|||
|
|
|
|||
|
|
SetPowerOnOff(false, out _);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_checkerReflectPowerWarning.Monitor(RFReflectPower, 0, _scReflectPowerWarningRange.IntValue, _scReflectPowerWarningTime.IntValue);
|
|||
|
|
if (_checkerReflectPowerWarning.Trig)
|
|||
|
|
{
|
|||
|
|
AlarmReflectPowerToleranceWarning.Description = $"{Display} reflect power {RFReflectPower} out of range[0,{_scReflectPowerWarningRange.IntValue}] in {_scReflectPowerWarningTime.IntValue} seconds";
|
|||
|
|
AlarmReflectPowerToleranceWarning.Set();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_checkerReflectPowerAlarm.Monitor(RFReflectPower, 0, _scReflectPowerAlarmRange.IntValue, _scReflectPowerAlarmTime.IntValue);
|
|||
|
|
if (_checkerReflectPowerAlarm.Trig)
|
|||
|
|
{
|
|||
|
|
AlarmReflectPowerToleranceAlarm.Description = $"{Display} reflect power {RFReflectPower} out of range[0,{_scReflectPowerAlarmRange.IntValue}] in {_scReflectPowerAlarmTime.IntValue} seconds";
|
|||
|
|
AlarmReflectPowerToleranceAlarm.Set();
|
|||
|
|
|
|||
|
|
SetPowerOnOff(false, out _);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_trigError.CLK = _diAlarm.Value;
|
|||
|
|
if (_trigError.Q)
|
|||
|
|
{
|
|||
|
|
AlarmDeviceAlarm.Set();
|
|||
|
|
SetPowerOnOff(false, out string _);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
catch (Exception ex)
|
|||
|
|
{
|
|||
|
|
LOG.Write(ex);
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void Reset()
|
|||
|
|
{
|
|||
|
|
_trigInterlock.RST = true;
|
|||
|
|
_trigError.RST = true;
|
|||
|
|
_trigOn.RST = true;
|
|||
|
|
|
|||
|
|
AlarmDeviceAlarm.Reset();
|
|||
|
|
AlarmPowerOnFailed.Reset();
|
|||
|
|
|
|||
|
|
AlarmPowerToleranceAlarm.Reset();
|
|||
|
|
AlarmPowerToleranceWarning.Reset();
|
|||
|
|
|
|||
|
|
AlarmReflectPowerToleranceAlarm.Reset();
|
|||
|
|
AlarmReflectPowerToleranceWarning.Reset();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool ResetDeviceAlarmChecker()
|
|||
|
|
{
|
|||
|
|
return !_diAlarm.Value;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool ResetPowerWarningChecker()
|
|||
|
|
{
|
|||
|
|
_checkerPowerWarning.Reset(_scPowerWarningTime.IntValue);
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool ResetPowerAlarmChecker()
|
|||
|
|
{
|
|||
|
|
_checkerPowerAlarm.Reset(_scPowerAlarmTime.IntValue);
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool ResetReflectPowerWarningChecker()
|
|||
|
|
{
|
|||
|
|
_checkerReflectPowerWarning.Reset(_scReflectPowerWarningTime.IntValue);
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public bool ResetReflectPowerAlarmChecker()
|
|||
|
|
{
|
|||
|
|
_checkerReflectPowerAlarm.Reset(_scReflectPowerAlarmTime.IntValue);
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public bool SetPowerOnOff(bool isOn, out string reason)
|
|||
|
|
{
|
|||
|
|
if (!_diIntlk.Value)
|
|||
|
|
{
|
|||
|
|
if (isOn)
|
|||
|
|
{
|
|||
|
|
reason = $"{Name} interlock is not satisfied, can not be on";
|
|||
|
|
EV.PostWarningLog(Module, reason);
|
|||
|
|
return false;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (!isOn)
|
|||
|
|
{
|
|||
|
|
PowerSetPoint = 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
bool result = _doOn.SetValue(isOn, out reason);
|
|||
|
|
|
|||
|
|
if (result)
|
|||
|
|
{
|
|||
|
|
reason = $"Set {Name} power " + (isOn ? "On" : "Off");
|
|||
|
|
|
|||
|
|
EV.PostInfoLog(Module, reason);
|
|||
|
|
if (isOn)
|
|||
|
|
_powerOnTimer.Start(Math.Min(Math.Max(2, _scPowerOnTimeout.IntValue), 30) * 1000);
|
|||
|
|
else
|
|||
|
|
_powerOnTimer.Stop();
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
EV.PostAlarmLog(Module, reason);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return result;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void UpdateTuneTable()
|
|||
|
|
{
|
|||
|
|
_tuneTable = new List<RfTuneItem>();
|
|||
|
|
|
|||
|
|
// 100#200#5#-6;
|
|||
|
|
string scValue = _scPowerTuneTable.StringValue;
|
|||
|
|
|
|||
|
|
if (string.IsNullOrEmpty(scValue))
|
|||
|
|
return;
|
|||
|
|
|
|||
|
|
string[] items = scValue.Split(';');
|
|||
|
|
|
|||
|
|
for (int i = 0; i < items.Length; i++)
|
|||
|
|
{
|
|||
|
|
string itemValue = items[i];
|
|||
|
|
if (!string.IsNullOrEmpty(itemValue))
|
|||
|
|
{
|
|||
|
|
string[] pairValue = itemValue.Split('#');
|
|||
|
|
if (pairValue.Length == 4)
|
|||
|
|
{
|
|||
|
|
if (int.TryParse(pairValue[0], out int rangeItem1)
|
|||
|
|
&& int.TryParse(pairValue[1], out int rangeItem2)
|
|||
|
|
&& int.TryParse(pairValue[2], out int setItem1)
|
|||
|
|
&& int.TryParse(pairValue[3], out int setItem2))
|
|||
|
|
{
|
|||
|
|
_tuneTable.Add(new RfTuneItem()
|
|||
|
|
{
|
|||
|
|
Percent = setItem1,
|
|||
|
|
RangeFrom = rangeItem1,
|
|||
|
|
RangeTo = rangeItem2,
|
|||
|
|
Value = setItem2,
|
|||
|
|
});
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public float GetTuneValue(float raw, bool isOutput)
|
|||
|
|
{
|
|||
|
|
if (_scPowerTuneEnable == null || !_scPowerTuneEnable.BoolValue)
|
|||
|
|
return raw;
|
|||
|
|
|
|||
|
|
float tuned = raw;
|
|||
|
|
|
|||
|
|
foreach (var rfTuneItem in _tuneTable)
|
|||
|
|
{
|
|||
|
|
if (raw >= rfTuneItem.RangeFrom && raw <= rfTuneItem.RangeTo)
|
|||
|
|
{
|
|||
|
|
if (isOutput)
|
|||
|
|
{
|
|||
|
|
double percent = rfTuneItem.Percent / 100.0;
|
|||
|
|
tuned = (float)(_scPowerTuneIsPercent.BoolValue ? (raw + raw * percent) : (raw + rfTuneItem.Value));
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
double percent = rfTuneItem.Percent / 100.0;
|
|||
|
|
percent = 1 + percent;
|
|||
|
|
if (Math.Abs(percent) < 0.01)
|
|||
|
|
percent = 1;
|
|||
|
|
|
|||
|
|
tuned = (float)(_scPowerTuneIsPercent.BoolValue ? (raw / percent) : (raw - rfTuneItem.Value));
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (tuned < 0)
|
|||
|
|
{
|
|||
|
|
tuned = 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (tuned > PowerRange)
|
|||
|
|
{
|
|||
|
|
tuned = PowerRange;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return tuned;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
public void InitializeCalalibration()
|
|||
|
|
{
|
|||
|
|
var records = new List<RFCalibrationItem>();
|
|||
|
|
for (int i = 0; i < 10; i++)
|
|||
|
|
{
|
|||
|
|
records.Add(new RFCalibrationItem()
|
|||
|
|
{
|
|||
|
|
Setpoint = (float)(PowerRange / 10 * (i + 1)),
|
|||
|
|
Meter = (float)_scPowerCalibrationTable[i].DoubleValue,
|
|||
|
|
});
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_calibrationFormla = new List<CalbrationParas>();
|
|||
|
|
for (int i = 0; i < records.Count; i++)
|
|||
|
|
{
|
|||
|
|
if (i + 1 >= records.Count)
|
|||
|
|
break;
|
|||
|
|
|
|||
|
|
var para = Caculate(records[i], records[i + 1]);
|
|||
|
|
_calibrationFormla.Add(para);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
var para0 = new CalbrationParas()
|
|||
|
|
{
|
|||
|
|
upperLimit = (float)(PowerRange / 10),
|
|||
|
|
lowerLimit = 0,
|
|||
|
|
paraA = _calibrationFormla[0].paraA,
|
|||
|
|
paraB = _calibrationFormla[0].paraB,
|
|||
|
|
};
|
|||
|
|
|
|||
|
|
_calibrationFormla.Add(para0);
|
|||
|
|
_calibrationFormla = _calibrationFormla.OrderBy(x => x.lowerLimit).ToList();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void UpdateCalibrationInfo(List<float> meterList)
|
|||
|
|
{
|
|||
|
|
for (int i = 0; i < meterList.Count; i++)
|
|||
|
|
{
|
|||
|
|
_scPowerCalibrationTable[i].DoubleValue = meterList[i];
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
InitializeCalalibration();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private CalbrationParas Caculate(RFCalibrationItem record1, RFCalibrationItem record2)
|
|||
|
|
{
|
|||
|
|
var para = new CalbrationParas();
|
|||
|
|
para.paraA = (record1.Setpoint - record2.Setpoint) / (record1.Meter - record2.Meter);
|
|||
|
|
para.paraB = record1.Setpoint - record1.Meter * para.paraA;
|
|||
|
|
para.upperLimit = record1.Setpoint > record2.Setpoint ? record1.Setpoint : record2.Setpoint;
|
|||
|
|
para.lowerLimit = record1.Setpoint < record2.Setpoint ? record1.Setpoint : record2.Setpoint;
|
|||
|
|
return para;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private float CalibrationPower(float power, bool output)
|
|||
|
|
{
|
|||
|
|
//default enable
|
|||
|
|
if (_scPowerCalibrationEnable != null && !_scPowerCalibrationEnable.BoolValue)
|
|||
|
|
return power;
|
|||
|
|
|
|||
|
|
float ret = power;
|
|||
|
|
|
|||
|
|
if (output)
|
|||
|
|
{
|
|||
|
|
if (_calibrationFormla != null && _calibrationFormla.Any())
|
|||
|
|
{
|
|||
|
|
var para = _calibrationFormla.FirstOrDefault(x => x.lowerLimit <= power && x.upperLimit >= power);
|
|||
|
|
ret = ret * para.paraA + para.paraB;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return ret;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (_calibrationFormla != null && _calibrationFormla.Any())
|
|||
|
|
{
|
|||
|
|
var para = _calibrationFormla.FirstOrDefault(x => x.lowerLimit <= power && x.upperLimit >= power);
|
|||
|
|
ret = (ret - para.paraB) / para.paraA;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return ret < 0 || ret > float.MaxValue ? 0 : ret;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
public void SaveRFCalibrationData()
|
|||
|
|
{
|
|||
|
|
if (_rfCalibrationDatas.Count != TenPoints)
|
|||
|
|
{
|
|||
|
|
EV.PostInfoLog(Module, $"Save Rf calibration data failed, for some points have not been calibrated.");
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
_rfCalibrationDatas = _rfCalibrationDatas.OrderBy(x => x.Setpoint).ToList();
|
|||
|
|
//RFCalibrationData data = new RFCalibrationData()
|
|||
|
|
//{
|
|||
|
|
// Module = Module,
|
|||
|
|
// Name = Name,
|
|||
|
|
// Rate1Setpoint = _rfCalibrationDatas[0].Setpoint,
|
|||
|
|
// Rate1Feedback = _rfCalibrationDatas[0].Feedback,
|
|||
|
|
// Rate1Meter = _rfCalibrationDatas[0].Meter,
|
|||
|
|
|
|||
|
|
// Rate2Setpoint = _rfCalibrationDatas[1].Setpoint,
|
|||
|
|
// Rate2Feedback = _rfCalibrationDatas[1].Feedback,
|
|||
|
|
// Rate2Meter = _rfCalibrationDatas[1].Meter,
|
|||
|
|
|
|||
|
|
// Rate3Setpoint = _rfCalibrationDatas[2].Setpoint,
|
|||
|
|
// Rate3Feedback = _rfCalibrationDatas[2].Feedback,
|
|||
|
|
// Rate3Meter = _rfCalibrationDatas[2].Meter,
|
|||
|
|
|
|||
|
|
// Rate4Setpoint = _rfCalibrationDatas[3].Setpoint,
|
|||
|
|
// Rate4Feedback = _rfCalibrationDatas[3].Feedback,
|
|||
|
|
// Rate4Meter = _rfCalibrationDatas[3].Meter,
|
|||
|
|
|
|||
|
|
// Rate5Setpoint = _rfCalibrationDatas[4].Setpoint,
|
|||
|
|
// Rate5Feedback = _rfCalibrationDatas[4].Feedback,
|
|||
|
|
// Rate5Meter = _rfCalibrationDatas[4].Meter,
|
|||
|
|
|
|||
|
|
// Rate6Setpoint = _rfCalibrationDatas[5].Setpoint,
|
|||
|
|
// Rate6Feedback = _rfCalibrationDatas[5].Feedback,
|
|||
|
|
// Rate6Meter = _rfCalibrationDatas[5].Meter,
|
|||
|
|
|
|||
|
|
// Rate7Setpoint = _rfCalibrationDatas[6].Setpoint,
|
|||
|
|
// Rate7Feedback = _rfCalibrationDatas[6].Feedback,
|
|||
|
|
// Rate7Meter = _rfCalibrationDatas[6].Meter,
|
|||
|
|
|
|||
|
|
// Rate8Setpoint = _rfCalibrationDatas[7].Setpoint,
|
|||
|
|
// Rate8Feedback = _rfCalibrationDatas[7].Feedback,
|
|||
|
|
// Rate8Meter = _rfCalibrationDatas[7].Meter,
|
|||
|
|
|
|||
|
|
// Rate9Setpoint = _rfCalibrationDatas[8].Setpoint,
|
|||
|
|
// Rate9Feedback = _rfCalibrationDatas[8].Feedback,
|
|||
|
|
// Rate9Meter = _rfCalibrationDatas[8].Meter,
|
|||
|
|
|
|||
|
|
// Rate10Setpoint = _rfCalibrationDatas[9].Setpoint,
|
|||
|
|
// Rate10Feedback = _rfCalibrationDatas[9].Feedback,
|
|||
|
|
// Rate10Meter = _rfCalibrationDatas[9].Meter,
|
|||
|
|
//};
|
|||
|
|
//RFCalibrationDataRecorder.Add(data);
|
|||
|
|
|
|||
|
|
|
|||
|
|
for (int i = 0; i < _rfCalibrationDatas.Count; i++)
|
|||
|
|
{
|
|||
|
|
SC.SetItemValue($"{Module}.RF.Rate{i + 1}MeterPower", (double)_rfCalibrationDatas[i].Meter);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
InitializeCalalibration();
|
|||
|
|
|
|||
|
|
EV.PostInfoLog(Module, $"Save RF calibration data successed.");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
public void SaveRFCalibrationPoint(float setpoint, float meterValue)
|
|||
|
|
{
|
|||
|
|
if (_rfCalibrationDatas.Any(x => x.Setpoint == setpoint))
|
|||
|
|
{
|
|||
|
|
_rfCalibrationDatas.RemoveAll(x => x.Setpoint == setpoint);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
var data = new RFCalibrationItem()
|
|||
|
|
{
|
|||
|
|
Setpoint = setpoint,
|
|||
|
|
Meter = meterValue,
|
|||
|
|
Feedback = RFForwardPower,
|
|||
|
|
};
|
|||
|
|
_rfCalibrationDatas.Add(data);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private struct CalbrationParas
|
|||
|
|
{
|
|||
|
|
//y = a*x + b, x is setpoint
|
|||
|
|
public float paraA;
|
|||
|
|
public float paraB;
|
|||
|
|
public float upperLimit;
|
|||
|
|
public float lowerLimit;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
private class RFCalibrationItem
|
|||
|
|
{
|
|||
|
|
public float Setpoint { get; set; }
|
|||
|
|
public float Feedback { get; set; }
|
|||
|
|
public float Meter { get; set; }
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|