1057 lines
37 KiB
C#
1057 lines
37 KiB
C#
///
|
|
/// Copyright (c) 2015-2020 Sensus Slovensko a.s.
|
|
///
|
|
using System;
|
|
using System.IO;
|
|
using System.IO.Ports;
|
|
using log4net;
|
|
using Config.Entities;
|
|
using TBF.BenchControl.Generic;
|
|
using TBF.BenchControl.Output;
|
|
|
|
namespace TBF.BenchControl.TestMethods.iPerlCommunication.iPerlHead
|
|
{
|
|
/// <summary>
|
|
/// This component = instance of this class is a placeholder for a combined main watermeter
|
|
/// </summary>
|
|
public class IperlHead : ComponentBase, IDevice, GenericDevices.IDatastreamReader, GenericDevices.IHasTestName, IOperation
|
|
{
|
|
private static readonly ILog log = LogManager.GetLogger(typeof(IperlHead));
|
|
public override string ToString() { return string.Format("iPerl({0})", Cfg.ToString(1)); }
|
|
|
|
#if TURA_SPECIAL
|
|
public const int MaxOptoDataCount = 250000;
|
|
#else
|
|
public const int MaxOptoDataCount = 40000;
|
|
#endif
|
|
public const int StartOptoDataCount = MaxOptoDataCount / 2;
|
|
public const int EndOptoDataCount = MaxOptoDataCount - StartOptoDataCount;
|
|
|
|
|
|
readonly IperlHeadCfg iperlHeadCfg;
|
|
|
|
public int RfidComPortNr { get { return iperlHeadCfg.RfidComPortNr; } }
|
|
public int MuxBoardNrOrGroup14 { get { return iperlHeadCfg.MuxBoardNr; } }
|
|
public int Group { get { return iperlHeadCfg.Group; } }
|
|
|
|
public int Position
|
|
{
|
|
get
|
|
{
|
|
int firstDigitPos = Name.IndexOfAny(new char[] { '1', '2', '3', '4', '5', '6', '7', '8', '9', '0' });
|
|
int position;
|
|
return (firstDigitPos < 0) ? 0 : (int.TryParse(Name.Substring(firstDigitPos), out position) ? position : 0);
|
|
}
|
|
}
|
|
public Config.Entities.RegisterReaderType RegisterReaderType { get { return Config.Entities.RegisterReaderType.DataStream; } }
|
|
public double PulsesPerLtr { get { return 1000.0; } }
|
|
public double LtrsPerPulse { get { return 1 / PulsesPerLtr; } }
|
|
|
|
public double CalibTarget { get { return iperlHeadCfg.ProcParams.CalibTarget; } }
|
|
public double CalibTargetQ2 { get { return iperlHeadCfg.ProcParams.CalibTargetQ2; } }
|
|
public ushort FactorLimitLo { get { return (ushort)iperlHeadCfg.ProcParams.FactorLimitLo; } }
|
|
public ushort FactorLimitHi { get { return (ushort)iperlHeadCfg.ProcParams.FactorLimitHi; } }
|
|
public Counting InitFlowDir { get { return (iperlHeadCfg != null && iperlHeadCfg.ProcParams != null) ? iperlHeadCfg.ProcParams.Counting : Counting.Arbitrary; } }
|
|
public int WMType_ID { get { return iperlHeadCfg.ProcParams.WMType_ID; } } /// Required by Oracle DB
|
|
public int Q2PreCorrectionLR { get { return iperlHeadCfg.ProcParams.InitQ2CorrLR; } } /// Used by InitOrReadQ2Corrections activity
|
|
public int Q2PreCorrectionRL { get { return iperlHeadCfg.ProcParams.InitQ2CorrRL; } } /// Required by Oracle DB
|
|
|
|
|
|
/// Properties set by the Begin and the End form
|
|
public string SerialNr
|
|
{
|
|
get
|
|
{
|
|
if (ConfigStruct != null) return configStruct.GetPcbNrString();
|
|
else return string.Empty;
|
|
}
|
|
set { }
|
|
}
|
|
|
|
public bool Disabled
|
|
{
|
|
get { return disabled; }
|
|
set { disabled = value; }
|
|
}
|
|
bool disabled;
|
|
|
|
public bool CommFailed
|
|
{
|
|
get { return commFailed; }
|
|
set { commFailed = value; }
|
|
}
|
|
bool commFailed;
|
|
|
|
public int ResultCode
|
|
{
|
|
get { return resultCode; }
|
|
}
|
|
int resultCode;
|
|
|
|
|
|
/// <summary>
|
|
/// Passed to OptoTelegramRaw.UpdateFromString(...)
|
|
/// </summary>
|
|
Int64 volumeRawExtLast;
|
|
Int64 timestampExtLast;
|
|
|
|
FlowDirectionDetection flowDirectionDetection;
|
|
|
|
public bool PositiveCounting;
|
|
|
|
|
|
/// <summary> ConfigStruct of the water meter obtained or updated by iPerlCommunication </summary>
|
|
public ConfigStruct ConfigStruct
|
|
{
|
|
get { return configStruct; }
|
|
set { configStruct = value; }
|
|
}
|
|
ConfigStruct configStruct;
|
|
|
|
/// <summary> CalibrationStruct of the water meter obtained or updated by iPerlCommunication </summary>
|
|
public CalibrationStruct CalibrationStruct
|
|
{
|
|
get { return calibrationStruct; }
|
|
set { calibrationStruct = value; }
|
|
}
|
|
CalibrationStruct calibrationStruct;
|
|
|
|
/// <summary> CalibrationStruct of the water meter obtained or updated by iPerlCommunication </summary>
|
|
public CalibrationStructV4 CalibrationStructV4
|
|
{
|
|
get { return calibrationStructV4; }
|
|
set { calibrationStructV4 = value; }
|
|
}
|
|
CalibrationStructV4 calibrationStructV4;
|
|
|
|
public ushort OrigCalibFactor;
|
|
public ushort CalibFactor
|
|
{
|
|
get
|
|
{
|
|
return (CalibrationStruct != null) ? CalibrationStruct.Calibration
|
|
: ((CalibrationStructV4 != null) ? CalibrationStructV4.Calibration
|
|
: (ushort)0);
|
|
}
|
|
}
|
|
|
|
public ushort OrigCalibFactorLNA;
|
|
public ushort CalibFactorLNA { get { return (CalibrationStructV4 != null) ? CalibrationStructV4.CalibrationLNA : (ushort)0; } }
|
|
|
|
|
|
public double Q2ErrWOCorrection;
|
|
public int Q2CorrRL;
|
|
public int Q2CorrLR;
|
|
|
|
public double Diff2Hz8Hz;
|
|
public bool Hz2CorrectionDone;
|
|
public int Hz2Correction;
|
|
|
|
public string FWVersion
|
|
{
|
|
get
|
|
{
|
|
return (CalibrationStruct != null) ? CalibrationStruct.FWVersionStr()
|
|
: ((CalibrationStructV4 != null) ? CalibrationStructV4.FWVersionStr()
|
|
: string.Empty);
|
|
}
|
|
}
|
|
|
|
|
|
/// <summary> Result of the last test used to calculate Q2 correction factors, etc </summary>
|
|
public Results.Entities.MeterTestRslt LastTestResult;
|
|
public Results.Entities.MeterTestRslt LastTestResult2;
|
|
|
|
|
|
///
|
|
/// Required for IRegisterReader interface
|
|
///
|
|
public int WMPulses { get { return wmPulses; } }
|
|
public int WMRefPulses { get { return wmRefPulses; } }
|
|
public double WMVolume { get { return wmVolume; } }
|
|
public double BeginWMState { get { return beginWMState; } }
|
|
public double EndWMState { get { return endWMState; } }
|
|
public double WMTestTime { get { return wmTestTime; } }
|
|
|
|
double beginWMState;
|
|
double endWMState;
|
|
double wmVolume;
|
|
int wmPulses;
|
|
int wmRefPulses;
|
|
double wmTestTime;
|
|
|
|
|
|
/// <summary>
|
|
/// New calibration factor calculated from the original factor (argument)
|
|
/// and results of any test(s).
|
|
/// Uses also: this.CalibTarget, this.VolumeLtrStart, this.VolumeLtrEnd
|
|
/// Side effects: this.OrigCalibFactor, this.PositiveCounting
|
|
/// </summary>
|
|
/// <param name="adjustTestResult">Test result for calculations</param>
|
|
/// <param name="originalCalibrationFactor">Original calibration factor</param>
|
|
/// <param name="factorLimitLo">Lower limit for the calibration factor</param>
|
|
/// <param name="factorLimitHi">Upper limit for the calibration factor</param>
|
|
/// <returns>New calibration factor or 0 (= Out of range)</returns>
|
|
public UInt16 CalculateNewCalibFactor(Results.Entities.MeterTestRslt adjustTestResult, UInt16 originalCalibrationFactor, UInt16 factorLimitLo, UInt16 factorLimitHi)
|
|
{
|
|
double meterVolume = adjustTestResult.VolumeMeter;
|
|
double targetVolume = adjustTestResult.VolumeRef * (1.0f + CalibTarget / 100.0f);
|
|
|
|
OrigCalibFactor = originalCalibrationFactor;
|
|
|
|
if (meterVolume > 1E-2)
|
|
{
|
|
PositiveCounting = volumeLtrEnd > volumeLtrStart;
|
|
|
|
UInt16 newFactor = (UInt16)((double)originalCalibrationFactor * targetVolume / meterVolume + 0.5);
|
|
log.InfoFormat("Calibration factor: orig={0} new={1} V_iperl={2} V_ref={3} V_target={4}",
|
|
originalCalibrationFactor,
|
|
newFactor,
|
|
meterVolume.ToString("F3"),
|
|
adjustTestResult.VolumeRef.ToString("F3"),
|
|
targetVolume.ToString("F3"));
|
|
|
|
|
|
if (newFactor < factorLimitLo || newFactor > factorLimitHi) return 0;
|
|
|
|
return newFactor;
|
|
}
|
|
else
|
|
{
|
|
log.ErrorFormat("Calibration factor: orig={0} new={0} (unchanged!) V_iperl={1}",
|
|
originalCalibrationFactor,
|
|
meterVolume.ToString("F3"));
|
|
return originalCalibrationFactor; /// Too small volume in the denominator -> no correction at all
|
|
}
|
|
}
|
|
|
|
|
|
/// <summary>
|
|
/// Q2 correction factor calculated from the last test (Q2).
|
|
/// This factor should be used only for R800 meters.
|
|
/// </summary>
|
|
/// <param name="q2TestResult">A test result from which to calculate the factor</param>
|
|
/// <param name="nominalFlow">Nominal flow in m3/h</param>
|
|
/// <param name="currentFactor">0 or the current Q2 correction factor when updating the factor</param>
|
|
/// <returns>Calculated Q2 correction factor</returns>
|
|
public double CalculateQ2CorrectionFactor(Results.Entities.MeterTestRslt q2adjResult, double calibTarget, double nominalFlow, int currentFactor = 0)
|
|
{
|
|
double nominalTestFlowLph = Config.Units.ConvertTo(Config.Unit.lph, nominalFlow);
|
|
double volumeRefShiftedToTarget = q2adjResult.VolumeRef * (1.0 + calibTarget / 100.0);
|
|
double q2adjErrorShiftedToTarget = Config.Formulas.ErrorFromVolumes(q2adjResult.VolumeMeter, volumeRefShiftedToTarget);
|
|
|
|
double A = 16.0 / ScalingFactor(); /// Raw units per ml: DN15=16, DN20=8, DN25=4, DN32=2, DN40=1
|
|
const double B = 8.0; /// Raw units per minute, 8
|
|
const double C = B * 60.0; /// Raw units per hour, 480
|
|
double D = C / A; /// ml correction per hour
|
|
double F = D / (nominalTestFlowLph * 10.0); /// Error corrected with 8 Raw Units per minute [%]
|
|
double G = F / B; /// Error corrected with 1 Raw Unit per minute [%]
|
|
|
|
double q2CorrectionFactor = (double)currentFactor - (q2adjErrorShiftedToTarget / G) * (volumeRefShiftedToTarget / q2adjResult.VolumeMeter);
|
|
|
|
log.WarnFormat("CalculateQ2CorrectionFactor() : Pos={0}, PCB#={1}, Error={2}%, CalTarget={3}%, Q2CorrFactor={4}",
|
|
Name,
|
|
SerialNr,
|
|
q2adjResult.Error.ToString("F2"),
|
|
calibTarget.ToString("F1"),
|
|
q2CorrectionFactor.ToString("F1"));
|
|
|
|
return q2CorrectionFactor;
|
|
}
|
|
|
|
|
|
/// <summary>
|
|
/// 2 Hz correction factor calculated from two Q3 tests - done at 2Hz and at 8Hz.
|
|
/// This factors should be used only for DN32 and DN40 meters.
|
|
/// </summary>
|
|
/// <param name="resultAt2Hz">Test result @2Hz from which to calculate the factor</param>
|
|
/// <param name="resultAt8Hz">Test result @8Hz from which to calculate the factor</param>
|
|
/// <param name="hz2CorrectionFactor">The calculated Q2 correction factor</param>
|
|
/// <returns>true = OK, false = failed</returns>
|
|
public bool Calculate2HzCorrectionFactor(Results.Entities.MeterTestRslt resultAt2Hz,
|
|
Results.Entities.MeterTestRslt resultAt8Hz,
|
|
out double diff2Hz8Hz, out int hz2CorrectionFactor)
|
|
{
|
|
hz2CorrectionFactor = 0;
|
|
diff2Hz8Hz = 0;
|
|
|
|
if ((resultAt2Hz == null) || (resultAt8Hz == null))
|
|
{
|
|
return false; /// Test result @2Hz and/or @8Hz is missing ==> water meter failed
|
|
}
|
|
|
|
diff2Hz8Hz = resultAt2Hz.Error - resultAt8Hz.Error;
|
|
|
|
if (Math.Abs(diff2Hz8Hz) > 2.5) return false; /// Difference of errors > 2.5 % ==> water meter failed
|
|
|
|
hz2CorrectionFactor = -1 * (int)Math.Round(10 * diff2Hz8Hz);
|
|
|
|
log.WarnFormat("2Hz correction: Pos={0}, PCB#={1}, corrFactor={2}, erro@2Hz={3}%, erro@8Hz={4}%",
|
|
Name,
|
|
SerialNr,
|
|
hz2CorrectionFactor,
|
|
resultAt2Hz.Error.ToString("F2"),
|
|
resultAt8Hz.Error.ToString("F2"));
|
|
|
|
return true;
|
|
}
|
|
|
|
|
|
/// <summary> Name set by the test, to be used as a part of the opto-data log file name </summary>
|
|
public string TestName { set { testName = value; } }
|
|
public int TestRepeats { set { testRepeats = value; } }
|
|
public int RepetitionNr { set { repetitionNr = value; } }
|
|
///
|
|
string testName;
|
|
int testRepeats;
|
|
int repetitionNr;
|
|
|
|
/// <summary> Name set by the test, to be used as a part of the opto-data log file name </summary>
|
|
public string BenchName;
|
|
|
|
///
|
|
/// Volume of water from the opto telegram
|
|
///
|
|
private Int64 lastVolumeRaw; /// Last read raw volume
|
|
private double volumeLtr;
|
|
private double volumeLtr0;
|
|
|
|
public double VolumeLtrStart { get { return volumeLtrStart; } } /// Test start volume for metrology
|
|
public double VolumeLtrEnd { get { return volumeLtrEnd; } } /// Test end volume for metrology
|
|
double volumeLtrStart; /// Test start volume for metrology
|
|
double volumeLtrEnd; /// Test end volume for metrology
|
|
double volumeLtrEnd1; /// auxiliary buffer1 to keep the end volume before test stops
|
|
double volumeLtrEnd2; /// auxiliary buffer2 to keep the end volume before test stops
|
|
double volumeLtrEnd3; /// auxiliary buffer3 to keep the end volume before test stops
|
|
|
|
///
|
|
/// Timestamp from the opto telegram
|
|
///
|
|
private Int64 lastTimestamp;
|
|
private double timestampSec;
|
|
private double timestampSec0;
|
|
|
|
public bool NoSamples { get { return (timestampSecEnd - timestampSecStart) < float.Epsilon; } }
|
|
public double TimestampSecStart { get { return timestampSecStart; } }
|
|
public double TimestampSecEnd { get { return timestampSecEnd; } }
|
|
double timestampSecStart;
|
|
double timestampSecEnd;
|
|
double timestampSecEnd1;
|
|
double timestampSecEnd2;
|
|
double timestampSecEnd3;
|
|
|
|
int endTelegramIdx1;
|
|
int endTelegramIdx2;
|
|
int endTelegramIdx3;
|
|
|
|
int currentTelegramIx;
|
|
bool startSampleAcquired;
|
|
public int TestStartTelegramIx;
|
|
public int TestEndTelegramIx;
|
|
|
|
|
|
OptoTelegramRaw[] optoData;
|
|
int optoDataCount;
|
|
string optoDataLogFileName;
|
|
///
|
|
OptoTelegramRaw toBeFlushed;
|
|
|
|
///
|
|
/// Opto serial port and worker thread related private variables
|
|
///
|
|
private SerialPort optoSerialPort;
|
|
|
|
|
|
public IperlHead()
|
|
{
|
|
}
|
|
|
|
public IperlHead(Generic.IComponentCfg cfg)
|
|
: base(cfg)
|
|
{
|
|
flowDirectionDetection = new FlowDirectionDetection();
|
|
|
|
ClearData();
|
|
|
|
iperlHeadCfg = cfg as IperlHeadCfg;
|
|
|
|
log.Debug(this.ToString());
|
|
}
|
|
|
|
|
|
public void Initialize()
|
|
{
|
|
ClearData();
|
|
optoSerialPortParsingEnabled = false;
|
|
|
|
/// Allocate memory for opto-data from iPerl
|
|
optoData = new OptoTelegramRaw[MaxOptoDataCount];
|
|
for (int i = 0; i < MaxOptoDataCount; i++) optoData[i] = new OptoTelegramRaw();
|
|
|
|
toBeFlushed = new OptoTelegramRaw();
|
|
|
|
synchronized = false;
|
|
synchronized2 = false;
|
|
partOfTelegram = string.Empty;
|
|
|
|
if (DebugLevel == DebugMode.Normal)
|
|
{
|
|
/// Prepare serial port
|
|
optoSerialPort = new SerialPort(string.Format("COM{0}", iperlHeadCfg.OptoComPortNr),
|
|
9600, Parity.None, 8, StopBits.One);
|
|
optoSerialPort.Handshake = Handshake.None;
|
|
|
|
optoSerialPort.Open();
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Clear data related to a specific water meter
|
|
/// </summary>
|
|
public void ClearData()
|
|
{
|
|
resultCode = 0;
|
|
|
|
disabled = false;
|
|
commFailed = false;
|
|
|
|
configStruct = null;
|
|
calibrationStruct = null;
|
|
calibrationStructV4 = null;
|
|
|
|
LastTestResult = null;
|
|
LastTestResult2 = null;
|
|
|
|
OrigCalibFactor = 0;
|
|
OrigCalibFactorLNA = 0;
|
|
Q2ErrWOCorrection = 0;
|
|
Q2CorrRL = 0;
|
|
Q2CorrLR = 0;
|
|
|
|
optoDataCount = 0;
|
|
|
|
currentFlowDir = InitFlowDir;
|
|
if (flowDirectionDetection != null) flowDirectionDetection.ClearFifo(); /// Clear FIFO for flow direction detection
|
|
}
|
|
|
|
|
|
Counting currentFlowDir;
|
|
///
|
|
public OptoHeadState CheckFlowDirection()
|
|
{
|
|
return (flowDirectionDetection != null) ? flowDirectionDetection.CheckFlowDirection(currentFlowDir, Name) : OptoHeadState.DirNok;
|
|
}
|
|
///
|
|
public void ChangeFlowDirection()
|
|
{
|
|
switch (InitFlowDir)
|
|
{
|
|
case Counting.Positive:
|
|
currentFlowDir = Counting.Negative;
|
|
break;
|
|
|
|
case Counting.Negative:
|
|
currentFlowDir = Counting.Positive;
|
|
break;
|
|
|
|
case Counting.Arbitrary:
|
|
default:
|
|
currentFlowDir = Counting.Arbitrary;
|
|
break;
|
|
}
|
|
|
|
if (flowDirectionDetection != null) flowDirectionDetection.ClearFifo(); /// Clear FIFO for flow direction detection
|
|
}
|
|
|
|
|
|
public void RunDeviceBefore()
|
|
{
|
|
if (DebugLevel == DebugMode.Normal)
|
|
{
|
|
try
|
|
{
|
|
ReadOptoData(optoSerialPortParsingEnabled ? OptoState.Read : OptoState.Flush);
|
|
}
|
|
catch (Exception e)
|
|
{
|
|
DebugLevel = DebugMode.FailureDuringOperation;
|
|
|
|
log.FatalFormat("Opto-data serial port failure : {0}", e.Message);
|
|
if (e.InnerException != null)
|
|
{
|
|
log.FatalFormat("InnerMessage : {0}", e.InnerException.Message);
|
|
}
|
|
}
|
|
}
|
|
else if (DebugLevel == DebugMode.FailureDuringOperation)
|
|
{
|
|
}
|
|
}
|
|
|
|
public void RunDeviceAfter() { }
|
|
|
|
public void StopDevice()
|
|
{
|
|
try
|
|
{
|
|
if (DebugLevel == DebugMode.Normal && optoSerialPort != null)
|
|
{
|
|
optoSerialPort.Close();
|
|
optoSerialPort = null;
|
|
}
|
|
}
|
|
catch
|
|
{
|
|
}
|
|
}
|
|
|
|
public void StopDevice2() { }
|
|
|
|
/// <summary>
|
|
/// Events: Event.ReadRegisterDone, Event.Error
|
|
/// </summary>
|
|
/// <returns>ReadWaterMeter instance reference casted to IOperaton</returns>
|
|
public IOperation ReadRegisterOp()
|
|
{
|
|
return this;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Clear data/counters related to a specific tests
|
|
/// </summary>
|
|
public void Clear()
|
|
{
|
|
resultCode = 0;
|
|
|
|
volumeLtr = 0;
|
|
volumeLtr0 = 0;
|
|
timestampSec = 0;
|
|
timestampSec0 = 0;
|
|
|
|
ReadPulses();
|
|
}
|
|
|
|
public void TestCompleted()
|
|
{
|
|
/// TODO: Implement
|
|
}
|
|
|
|
|
|
int timeFromStart; /// [s] Time from test start to determine when the test start sample should be taken
|
|
|
|
/// <summary>Start this operation</summary>
|
|
public void Start()
|
|
{
|
|
Clear();
|
|
|
|
/// Reset opto data, etc.
|
|
timeFromStart = 0;
|
|
optoDataCount = 0;
|
|
currentTelegramIx = -1;
|
|
startSampleAcquired = false;
|
|
TestStartTelegramIx = 0;
|
|
endTelegramIdx1 = 0;
|
|
endTelegramIdx2 = 0;
|
|
endTelegramIdx3 = 0;
|
|
TestEndTelegramIx = 0;
|
|
|
|
/// File name is: PCB_AA_BB_HH_MI_SS..txt
|
|
string wmPosition = Name.Substring(5); /// WMPosition is extracted from a component name in form 'iPerl#'
|
|
if (wmPosition.Length == 1) wmPosition = "0" + wmPosition;
|
|
|
|
if (StateMachine.Procedure != null && Sequences.ProcessData.CompleteTestInfos == null)
|
|
{
|
|
Sequences.ProcessData.CompleteTestInfos = Results.Output.SensusTestInfo.CreateFromProcedure(StateMachine.Procedure);
|
|
}
|
|
|
|
Results.Output.SensusTestInfo[] testInfos = Sequences.ProcessData.CompleteTestInfos;
|
|
optoDataLogFileName = null;
|
|
///
|
|
if (testInfos != null)
|
|
{
|
|
string fullTestName = Results.Utils.GetTestName(testName, testRepeats, repetitionNr);
|
|
foreach (var ti in testInfos)
|
|
{
|
|
if ((ti.PruefungsNrOpto != 0) && (ti.TestName == fullTestName))
|
|
{
|
|
optoDataLogFileName = string.Format("{0}_{1}_{2}_{3}.txt",
|
|
(ConfigStruct != null) ? ConfigStruct.GetPcbNrString() : "UnknownPcbNr",
|
|
wmPosition,
|
|
string.IsNullOrEmpty(ti.QBezeichnungOpto) ? ti.PruefungsNrOpto.ToString("D2") : ti.QBezeichnungOpto,
|
|
StateMachine.CycleStartTimeStamp.ToString("HH_mm_ss"));
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
StartParsingOptoSerialPort();
|
|
}
|
|
|
|
/// <summary>Run this operation</summary>
|
|
/// <returns>eventDone</returns>
|
|
public Event Run()
|
|
{
|
|
timeFromStart += StateMachine.Period;
|
|
ReadPulses();
|
|
|
|
if (!startSampleAcquired && (timeFromStart >= 8) && (currentTelegramIx >= 0))
|
|
{
|
|
/// Take the test start sample
|
|
startSampleAcquired = true;
|
|
volumeLtrStart = volumeLtr;
|
|
timestampSecStart = timestampSec;
|
|
TestStartTelegramIx = currentTelegramIx;
|
|
}
|
|
else if (startSampleAcquired)
|
|
{
|
|
/// Shift data in pipelines
|
|
volumeLtrEnd = volumeLtrEnd3;
|
|
volumeLtrEnd3 = volumeLtrEnd2;
|
|
volumeLtrEnd2 = volumeLtrEnd1;
|
|
volumeLtrEnd1 = volumeLtr;
|
|
|
|
timestampSecEnd = timestampSecEnd3;
|
|
timestampSecEnd3 = timestampSecEnd2;
|
|
timestampSecEnd2 = timestampSecEnd1;
|
|
timestampSecEnd1 = timestampSec;
|
|
|
|
TestEndTelegramIx = endTelegramIdx3;
|
|
endTelegramIdx3 = endTelegramIdx2;
|
|
endTelegramIdx2 = endTelegramIdx1;
|
|
endTelegramIdx1 = currentTelegramIx;
|
|
}
|
|
|
|
return Event.ReadRegisterDone;
|
|
}
|
|
|
|
/// <summary>Stop this operation</summary>
|
|
public void Stop()
|
|
{
|
|
int startIx = OptoTelegramRaw.BufferIdx(TestStartTelegramIx);
|
|
int endIx = OptoTelegramRaw.BufferIdx(TestEndTelegramIx);
|
|
|
|
log.WarnFormat("IperlHeadd.Stop() startIx={0} endIx={1} optoData.Len={2} filename={3}", startIx, endIx, optoData.Length, !string.IsNullOrEmpty(optoDataLogFileName) ? optoDataLogFileName : "<null>");
|
|
|
|
if ((startIx > 0) && (startIx < StartOptoDataCount) && (optoData[startIx].Flags == OptoTelegramFlags.OK))
|
|
{
|
|
optoData[startIx].Flags = OptoTelegramFlags.OK_TestStart;
|
|
OptoTelegramRaw.TestStartTimestampDec = optoData[startIx].TimestampDec();
|
|
}
|
|
|
|
if ((endIx > 0) && (optoData[endIx].Flags == OptoTelegramFlags.OK))
|
|
{
|
|
optoData[endIx].Flags = OptoTelegramFlags.OK_TestEnd;
|
|
}
|
|
|
|
StopParsingOptoSerialPort();
|
|
if (optoDataCount <= MaxOptoDataCount)
|
|
{
|
|
OptoTelegramRaw.FIRFilterFlow(optoData, 0, optoDataCount - 1);
|
|
}
|
|
else
|
|
{
|
|
OptoTelegramRaw.FIRFilterFlow(optoData, 0, StartOptoDataCount - 1);
|
|
OptoTelegramRaw.FIRFilterFlow(optoData, (optoDataCount - EndOptoDataCount), optoDataCount - 1);
|
|
}
|
|
SaveOptoData();
|
|
|
|
if (TestStartTelegramIx == 0 || optoDataCount < 100)
|
|
{
|
|
resultCode |= (int)Results.Entities.ResultCode.MissingOptoData;
|
|
}
|
|
else if (volumeLtrEnd == volumeLtrStart)
|
|
{
|
|
resultCode |= (int)Results.Entities.ResultCode.OptoDataWithZeroFlow;
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Save opto data to a file.
|
|
/// </summary>
|
|
void SaveOptoData()
|
|
{
|
|
if (!string.IsNullOrEmpty(optoDataLogFileName))
|
|
{
|
|
string directory = Path.Combine("C:\\TBF\\ProcessData", StateMachine.CycleStartTimeStamp.ToString("yy"),
|
|
StateMachine.CycleStartTimeStamp.ToString("MM"),
|
|
StateMachine.CycleStartTimeStamp.ToString("dd"));
|
|
string fullFileName = Path.Combine(directory, optoDataLogFileName);
|
|
|
|
log.WarnFormat("Saving {0} opto data to {1}", Name, fullFileName);
|
|
|
|
try
|
|
{
|
|
Directory.CreateDirectory(directory);
|
|
|
|
double scalFact = ScalingFactor();
|
|
|
|
using (TextWriter optoLogFile = new StreamWriter(fullFileName))
|
|
{
|
|
if (optoDataCount <= MaxOptoDataCount)
|
|
{
|
|
/// Telegrams are stored continuously, save them.
|
|
optoLogFile.WriteLine(optoData[0].ToString(scalFact, null));
|
|
for (int i = 1; i < optoDataCount; i++)
|
|
{
|
|
optoLogFile.WriteLine(optoData[i].ToString(scalFact, optoData[i - 1]));
|
|
}
|
|
}
|
|
else /// if (optoDataCount > MaxOptoDataCount)
|
|
{
|
|
/// Buffer overflow
|
|
/// First part of the buffer is saved as is
|
|
optoLogFile.WriteLine(optoData[0].ToString(scalFact, null));
|
|
for (int i = 1; i < StartOptoDataCount; i++)
|
|
{
|
|
optoLogFile.WriteLine(optoData[i].ToString(scalFact, optoData[i - 1]));
|
|
}
|
|
|
|
optoLogFile.WriteLine(" ...");
|
|
|
|
/// Second part of the buffer is an overflowed circular buffer
|
|
optoLogFile.WriteLine(optoData[OptoTelegramRaw.BufferIdx(optoDataCount)].ToString(scalFact, null));
|
|
for (int i = optoDataCount - EndOptoDataCount + 1; i < optoDataCount; i++)
|
|
{
|
|
optoLogFile.WriteLine(optoData[OptoTelegramRaw.BufferIdx(i)]
|
|
.ToString(scalFact, optoData[OptoTelegramRaw.BufferIdx(i - 1)]));
|
|
}
|
|
}
|
|
|
|
log.WarnFormat("{0} opto data successfully saved: {1} lines", Name, optoDataCount);
|
|
|
|
optoLogFile.Close();
|
|
}
|
|
}
|
|
catch (Exception exc)
|
|
{
|
|
File.Delete(fullFileName);
|
|
log.ErrorFormat(string.Format("Error writing into file {0}", fullFileName));
|
|
log.ErrorFormat(string.Format("Exception message: {0}", exc.Message));
|
|
}
|
|
}
|
|
}
|
|
|
|
void ReadPulses()
|
|
{
|
|
beginWMState = volumeLtr0;
|
|
endWMState = volumeLtr;
|
|
wmVolume = Math.Abs(endWMState - beginWMState);
|
|
wmPulses = (int)(wmVolume * (double)PulsesPerLtr + 0.5);
|
|
wmRefPulses = StateMachine.ControlBoard.EtPulses(0);
|
|
wmTestTime = timestampSec - timestampSec0;
|
|
}
|
|
|
|
|
|
bool optoSerialPortParsingEnabled;
|
|
|
|
/// <summary> Flush internal buffers and start parsing the opto serial port data </summary>
|
|
void StartParsingOptoSerialPort()
|
|
{
|
|
optoSerialPortParsingEnabled = true;
|
|
}
|
|
|
|
/// <summary> Stop parsig the opto serial port data </summary>
|
|
void StopParsingOptoSerialPort()
|
|
{
|
|
optoSerialPortParsingEnabled = false;
|
|
}
|
|
|
|
///
|
|
/// Variables storing the context of serial port data parsing (ReadOptoSerialPort(...))
|
|
///
|
|
bool synchronized;
|
|
bool synchronized2;
|
|
string partOfTelegram;
|
|
|
|
/// <summary>
|
|
/// 9600 Bd, 8 data bits, 1 stop bit, no parity
|
|
///
|
|
/// Telegram description:
|
|
///
|
|
/// AAAAAA[tab]BBBB[tab]CCCC[tab]DDDDDD[tab]EEEE[tab]FFFFFFFF[tab]GG[cr][lf] (42 bytes)
|
|
///
|
|
/// Example:
|
|
/// FFFFFE 51EA 0000 65324E 0087 F6319DFF 86
|
|
/// FFDD3A 51F9 0000 65324E 0088 F631A60B 45
|
|
/// ...
|
|
/// </summary>
|
|
/// <param name="optoState">OptoState.Read or OptoState.Flush</param>
|
|
void ReadOptoData(OptoState optoState)
|
|
{
|
|
int nrBytes = optoSerialPort.BytesToRead;
|
|
if (nrBytes > 0)
|
|
{
|
|
char[] buffer = new char[nrBytes];
|
|
optoSerialPort.Read(buffer, 0, nrBytes);
|
|
string received = new string(buffer);
|
|
|
|
string allRcvd = partOfTelegram + received;
|
|
|
|
while (true)
|
|
{
|
|
int pos = allRcvd.IndexOf("\r\n");
|
|
|
|
if (pos < 0)
|
|
{
|
|
/// No CR+LF found, wait for more characters in the next invocation
|
|
partOfTelegram = allRcvd;
|
|
return;
|
|
}
|
|
else
|
|
{
|
|
/// CR+LF found
|
|
if (optoState == OptoState.Read)
|
|
{
|
|
int bufferIx = OptoTelegramRaw.BufferIdx(optoDataCount);
|
|
|
|
if (pos < OptoTelegramRaw.Length - 2)
|
|
{
|
|
/// CR+LF found too early, truncate the beginning incl CR+LF and keep scanning in this loop
|
|
allRcvd = allRcvd.Substring(pos + 2);
|
|
if (synchronized)
|
|
{
|
|
optoData[bufferIx].Counter = optoDataCount;
|
|
optoData[bufferIx].SetFlags(OptoTelegramFlags.SyncError);
|
|
}
|
|
synchronized = true;
|
|
}
|
|
else if (optoData[bufferIx].UpdateFromString(allRcvd.Substring(pos - OptoTelegramRaw.Length + 2), optoDataCount, ref volumeRawExtLast, ref timestampExtLast))
|
|
{
|
|
/// CR+LF was found && (pos >= OptoTelegramRaw.Length - 2) && the telegram is OK
|
|
flowDirectionDetection.WriteToFifo(volumeRawExtLast, timestampExtLast);
|
|
OptoTelegramRreceived(optoDataCount, synchronized2, volumeRawExtLast, timestampExtLast);
|
|
synchronized2 = synchronized;
|
|
allRcvd = allRcvd.Substring(pos + 2);
|
|
}
|
|
else
|
|
{
|
|
/// CR+LF was found && (pos >= OptoTelegramRaw.Length - 2) but the telgram was not OK
|
|
optoData[bufferIx].Counter = optoDataCount;
|
|
optoDataCount++;
|
|
allRcvd = allRcvd.Substring(pos + 2);
|
|
}
|
|
|
|
optoDataCount++;
|
|
}
|
|
else /// optoState == OptoState.Flush
|
|
{
|
|
if (pos < OptoTelegramRaw.Length - 2)
|
|
{
|
|
/// CR+LF found too early, truncate the beginning incl CR+LF and keep scanning in this loop
|
|
allRcvd = allRcvd.Substring(pos + 2);
|
|
synchronized = true;
|
|
}
|
|
// CR+LF found and (pos >= OptoTelegram.Length - 2)
|
|
else if (toBeFlushed.UpdateFromString(allRcvd.Substring(pos - OptoTelegramRaw.Length + 2), 0, ref volumeRawExtLast, ref timestampExtLast))
|
|
{
|
|
flowDirectionDetection.WriteToFifo(volumeRawExtLast, timestampExtLast);
|
|
synchronized2 = synchronized;
|
|
allRcvd = allRcvd.Substring(pos + 2);
|
|
}
|
|
else
|
|
{
|
|
allRcvd = allRcvd.Substring(pos + 2);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
//OnOptoReceived(this, new OptoReceivedEventArgs(s));
|
|
}
|
|
else
|
|
{
|
|
//OnOptoReceived(this, new OptoReceivedEventArgs("."));
|
|
}
|
|
}
|
|
|
|
|
|
void OptoTelegramRreceived(int currentIx, bool async, Int64 volumeRawExt, Int64 timestampRawExt)
|
|
{
|
|
currentTelegramIx = currentIx;
|
|
|
|
lastVolumeRaw = volumeRawExt;
|
|
lastTimestamp = timestampRawExt;
|
|
|
|
if (volumeLtr == 0 && volumeLtr0 == 0)
|
|
{
|
|
volumeLtr = (double)lastVolumeRaw * ScalingFactor() / 16000.0;
|
|
volumeLtr0 = volumeLtr;
|
|
}
|
|
else
|
|
{
|
|
volumeLtr = (double)lastVolumeRaw * ScalingFactor() / 16000.0;
|
|
}
|
|
|
|
if (timestampSec == 0 && timestampSec0 == 0)
|
|
{
|
|
timestampSec = (double)lastTimestamp / 8192.0;
|
|
timestampSec0 = timestampSec;
|
|
}
|
|
else
|
|
{
|
|
timestampSec = (double)lastTimestamp / 8192.0;
|
|
}
|
|
}
|
|
|
|
|
|
/// <summary>
|
|
/// Called from the state machine when a test is selected and UI needs to be updated.
|
|
/// </summary>
|
|
public void OnOptoReceived(object sender, OptoReceivedEventArgs args)
|
|
{
|
|
if (OptoReceivedHandler == null) return;
|
|
try { OptoReceivedHandler(sender, args); }
|
|
catch (Exception) { }
|
|
}
|
|
|
|
public event EventHandler<OptoReceivedEventArgs> OptoReceivedHandler;
|
|
|
|
|
|
/// <summary>
|
|
/// Compares CalibrationStruct.MeterType with iPerlCfg.MeterType.
|
|
/// iPerlCfg.MeterType == MeterType.AutoDetect disables type checking
|
|
/// CalibrationStruct == null disables type checking ...
|
|
/// ... so that failed RFID communication does not cause type verification failure)
|
|
/// </summary>
|
|
/// <returns>true when type is OK</returns>
|
|
public bool VerifyIPerlType()
|
|
{
|
|
if (iperlHeadCfg.MeterType == MeterType.AutoDetect || CalibrationStruct == null)
|
|
{
|
|
return true;
|
|
}
|
|
|
|
return iperlHeadCfg.MeterType == CalibrationStruct.MeterType;
|
|
}
|
|
|
|
public static double UnitVolume(VolumeUnits units)
|
|
{
|
|
switch (units)
|
|
{
|
|
default:
|
|
case VolumeUnits.m3: return Config.Units.ConvertFrom(Config.Unit.m3, 1.0); /// 1 liter
|
|
case VolumeUnits.UK_gallon: return Config.Units.ConvertFrom(Config.Unit.UKgal, 1.0); /// 1 imperial gallon
|
|
case VolumeUnits.US_gallon: return Config.Units.ConvertFrom(Config.Unit.USgal, 1.0); /// 1 US gallon
|
|
}
|
|
}
|
|
|
|
public double ScalingFactor()
|
|
{
|
|
if ((iperlHeadCfg.MeterType == MeterType.AutoDetect) && (CalibrationStruct != null))
|
|
{
|
|
return IperlHead.ScalingFactor(CalibrationStruct.MeterType);
|
|
}
|
|
else if (iperlHeadCfg.MeterType != MeterType.AutoDetect)
|
|
{
|
|
return IperlHead.ScalingFactor(iperlHeadCfg.MeterType);
|
|
}
|
|
else
|
|
{
|
|
return IperlHead.ScalingFactor(MeterType.DN20);
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Scaling factor:
|
|
/// 0, 1 (DN15, Coax) . . . . 1
|
|
/// 2 (DN20) . . . . . . . . 2
|
|
/// 3 (DN25) . . . . . . . . 4
|
|
/// 4, 5 (DN26, DN32) . . . . 8
|
|
/// 6 (DN40) . . . . . . . . 16
|
|
/// </summary>
|
|
/// <param name="meterType">MeterType (0..6)</param>
|
|
/// <returns>Scaling factor</returns>
|
|
public static double ScalingFactor(MeterType meterType)
|
|
{
|
|
switch (meterType)
|
|
{
|
|
default:
|
|
case MeterType.DN15:
|
|
case MeterType.CoaxManifold: return 1.0;
|
|
case MeterType.DN20: return 2.0;
|
|
case MeterType.DN25: return 4.0;
|
|
case MeterType.DN26:
|
|
case MeterType.DN32: return 8.0;
|
|
case MeterType.DN40: return 16.0;
|
|
}
|
|
}
|
|
|
|
|
|
public void WriteBinary(BinaryWriter writer)
|
|
{
|
|
writer.Write(disabled);
|
|
writer.Write(commFailed);
|
|
writer.Write(resultCode);
|
|
writer.Write(PositiveCounting);
|
|
|
|
if (configStruct != null)
|
|
{
|
|
writer.Write(true);
|
|
configStruct.WriteBinary(writer);
|
|
}
|
|
else writer.Write(false);
|
|
|
|
if (calibrationStruct != null)
|
|
{
|
|
writer.Write(true);
|
|
calibrationStruct.WriteBinary(writer);
|
|
}
|
|
else writer.Write(false);
|
|
|
|
if (calibrationStructV4 != null)
|
|
{
|
|
writer.Write(true);
|
|
calibrationStructV4.WriteBinary(writer);
|
|
}
|
|
else writer.Write(false);
|
|
|
|
writer.Write(OrigCalibFactor);
|
|
writer.Write(OrigCalibFactorLNA);
|
|
writer.Write(Q2ErrWOCorrection);
|
|
writer.Write(Q2CorrRL);
|
|
writer.Write(Q2CorrLR);
|
|
writer.Write(Diff2Hz8Hz);
|
|
writer.Write(Hz2CorrectionDone);
|
|
writer.Write(Hz2Correction);
|
|
|
|
if (LastTestResult != null)
|
|
{
|
|
writer.Write(true);
|
|
LastTestResult.WriteBinary(writer);
|
|
}
|
|
else writer.Write(false);
|
|
|
|
if (LastTestResult2 != null)
|
|
{
|
|
writer.Write(true);
|
|
LastTestResult2.WriteBinary(writer);
|
|
}
|
|
else writer.Write(false);
|
|
}
|
|
|
|
public void ReadBinary(BinaryReader reader)
|
|
{
|
|
disabled = reader.ReadBoolean();
|
|
commFailed = reader.ReadBoolean();
|
|
resultCode = reader.ReadInt32();
|
|
PositiveCounting = reader.ReadBoolean();
|
|
|
|
if (reader.ReadBoolean()) (configStruct = new ConfigStruct()).ReadBinary(reader);
|
|
if (reader.ReadBoolean()) (calibrationStruct = new CalibrationStruct()).ReadBinary(reader);
|
|
if (reader.ReadBoolean()) (calibrationStructV4 = new CalibrationStructV4()).ReadBinary(reader);
|
|
|
|
OrigCalibFactor = reader.ReadUInt16();
|
|
OrigCalibFactorLNA = reader.ReadUInt16();
|
|
Q2ErrWOCorrection = reader.ReadDouble();
|
|
Q2CorrRL = reader.ReadInt32();
|
|
Q2CorrLR = reader.ReadInt32();
|
|
Diff2Hz8Hz = reader.ReadDouble();
|
|
Hz2CorrectionDone = reader.ReadBoolean();
|
|
Hz2Correction = reader.ReadInt32();
|
|
|
|
if (reader.ReadBoolean()) (LastTestResult = new Results.Entities.MeterTestRslt()).ReadBinary(reader, null);
|
|
if (reader.ReadBoolean()) (LastTestResult2 = new Results.Entities.MeterTestRslt()).ReadBinary(reader, null);
|
|
}
|
|
}
|
|
}
|