tbf/TBF/BenchControl/Elde/FlowMeterDewa/FlowMeter.cs

///
/// Copyright (c) 2019 Sensus Slovensko a.s.
///
using System;
using System.Collections.Generic;
using log4net;
using TBF.Boxes;
using TBF.BenchControl.GenericDevices;

namespace TBF.BenchControl.Elde.FlowMeterDewa
{
	public class FlowMeter : ComponentBase, IFlowMeter
	{
		private static readonly ILog log = LogManager.GetLogger(typeof(FlowMeter));
        public override string ToString() { return string.Format("{0}({1})", ClassName, Cfg.ToString(-1)); }

		readonly FlowMeterCfg flowMeterCfg;
        readonly ControlBoardDev controlBoard;
        readonly IFlowMeter flowMeter1;
        readonly IFlowMeter flowMeter2;
        readonly IFlowMeter flowMeter3;
        double nominalFlow;
        double ltrPerPulse;
        int flowMetersCount;
        int flowMetersBitfield;

        public int Idx1 { get { return flowMetersBitfield; } }
        public double NominalFlow { get { return nominalFlow; } }
        public double LtrPerPulse { get { return ltrPerPulse; } }

        double[] refFreq;   /// 0..sum, 1..I11, 2..I12, 3..I13
        int[] refPulses;

        public double LtrPerPulseCorrected(double flow, int rangeIx)
        {
            log.DebugFormat("LtrPerPulseCorrected({0}, {1}) started", flow, rangeIx);

            refFreq[0] = controlBoard.ReferenceFreqs(0);
            refFreq[1] = controlBoard.ReferenceFreqs(1);
            refFreq[2] = controlBoard.ReferenceFreqs(2);
            refFreq[3] = controlBoard.ReferenceFreqs(3);
            log.DebugFormat("refFreq[] = ({0}, {1}, {2}, {3})", refFreq[0], refFreq[1], refFreq[2], refFreq[3]);

            refFreq[1] = refFreq[0] - refFreq[2] - refFreq[3];

            refPulses[0] = controlBoard.EtPulses(0);
            refPulses[2] = controlBoard.EtPulses2;
            refPulses[3] = controlBoard.EtPulses3;
            refPulses[1] = refPulses[0] - refPulses[2] - refPulses[3];

            log.DebugFormat("refPulses[] = ({0}, {1}, {2}, {3})", refPulses[0], refPulses[1], refPulses[2], refPulses[3]);

            double flow1, flow2, flow3;
            double contribution1, contribution2, contribution3;
            if (refPulses[0] != 0)
            {
                /// Division by zero prevented inside this 'if'
                double ltrPerPulseCorrected = 0;
                if (flowMeter1 != null)
                {
                    double ratio = (double)refPulses[flowMeter1.Idx1] / (double)refPulses[0];
                    flow1 = flow * ratio;
                    contribution1 = flowMeter1.LtrPerPulseCorrected(flow1, rangeIx) * ratio;
                    ltrPerPulseCorrected += contribution1;
                    log.DebugFormat("flowmeter1 = {0}, flow1 = {1}, contribution1 = {2}", flowMeter1.Name, flow1, contribution1);
                }
                if (flowMeter2 != null)
                {
                    double ratio = (double)refPulses[flowMeter2.Idx1] / (double)refPulses[0];
                    flow2 = flow * ratio;
                    contribution2 = flowMeter2.LtrPerPulseCorrected(flow2, rangeIx) * ratio;
                    ltrPerPulseCorrected += contribution2;
                    log.DebugFormat("flowmeter2 = {0}, flow2 = {1}, contribution2 = {2}", flowMeter2.Name, flow2, contribution2);
                }
                if (flowMeter3 != null)
                {
                    double ratio = (double)refPulses[flowMeter3.Idx1] / (double)refPulses[0];
                    flow3 = flow * ratio;
                    contribution3 = flowMeter3.LtrPerPulseCorrected(flow3, rangeIx) * ratio;
                    ltrPerPulseCorrected += contribution3;
                    log.DebugFormat("flowmeter3 = {0}, flow3 = {1}, contribution3 = {2}", flowMeter3.Name, flow3, contribution3);
                }

                log.DebugFormat("LtrPerPulseCorrected() returns {0}", ltrPerPulseCorrected);
                return ltrPerPulseCorrected;
            }
            else
            {
                log.DebugFormat("LtrPerPulseCorrected() returns 1");
                return 1;
            }
        }


        public bool RangeEnabled(int ix) { return flowMeterCfg.RangeEnabled(ix); }
        public double GetTempLo(int ix) { return flowMeterCfg.GetTempLo(ix); }
        public double GetTempHi(int ix) { return flowMeterCfg.GetTempHi(ix); }
        public double GetPressLo(int ix) { return flowMeterCfg.GetPressLo(ix); }
        public double GetPressHi(int ix) { return flowMeterCfg.GetPressHi(ix); }


		public FlowMeter() { }

		public FlowMeter(Generic.IComponentCfg cfg, IList<Generic.IComponent> components)
			: base(cfg)
		{
			flowMeterCfg = cfg as FlowMeterCfg;

			controlBoard = (ControlBoardDev)TbfComponents.FindComponent(cfg.ParentName, components);
			if (controlBoard == null) throw new Exception("Cannot find " + Name + " parent");

            if (!string.IsNullOrEmpty(flowMeterCfg.Flowmeter1)) flowMeter1 = TbfComponents.FindComponent(flowMeterCfg.Flowmeter1, components) as IFlowMeter;
            if (!string.IsNullOrEmpty(flowMeterCfg.Flowmeter2)) flowMeter2 = TbfComponents.FindComponent(flowMeterCfg.Flowmeter2, components) as IFlowMeter;
            if (!string.IsNullOrEmpty(flowMeterCfg.Flowmeter3)) flowMeter3 = TbfComponents.FindComponent(flowMeterCfg.Flowmeter3, components) as IFlowMeter;
		}

        public override void Initialize()
        {
            refFreq = new double[4];
            refPulses = new int[4];

            nominalFlow = 0;
            flowMetersCount = 0;
            flowMetersBitfield = 0;
            if (flowMeter1 != null) { nominalFlow += flowMeter1.NominalFlow; flowMetersBitfield |= (8 << flowMeter1.Idx1); flowMetersCount++; }
            if (flowMeter2 != null) { nominalFlow += flowMeter2.NominalFlow; flowMetersBitfield |= (8 << flowMeter2.Idx1); flowMetersCount++; }
            if (flowMeter3 != null) { nominalFlow += flowMeter3.NominalFlow; flowMetersBitfield |= (8 << flowMeter3.Idx1); flowMetersCount++; }
            if (flowMetersCount == 0) throw new Exception("Missing flowmeters");
            ltrPerPulse = nominalFlow / (flowMetersCount * 7200.0);     /// Nominal freq. is flowMetersCount * 2000 Hz (2000, 4000 or 6000 Hz)

            log.FatalFormat("{0} initialized: {1}", Name, this);
        }


        public double ReadFlow()      { return controlBoard.ReferenceFlow; }
        public double ReadFrequency() { return controlBoard.ReferenceFreq; }

		/// <summary>
		/// Events:  FlowDone, Error
		/// </summary>
		/// <param name="flow">Reference to a variable for the flow in Bar</param>
		/// <returns>ReadFlowOp instance reference casted to IOperaton</returns>
		public IOperation ReadFlowOp(ref DoubleBox flow)
		{
			return new ReadFlowOp(this, controlBoard, ref flow);
		}

		/// <summary>
		/// Events:  flowDone, Error
		/// </summary>
		/// <param name="flow">Reference to a variable for the flow in Bar</param>
		/// <param name="flowDone">Event returned when measurement done</param>
		/// <returns>ReadFlowOp instance reference casted to IOperaton</returns>
		public IOperation ReadFlowOp(ref DoubleBox flow, Event flowDone)
		{
			return new ReadFlowOp(this, controlBoard, ref flow, flowDone);
		}
	}
}