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; }
|
||
}
|
||
}
|
||
|
||
|
||
}
|