tbf/TBF/BenchControl/Elde/Diverter/Diverter.cs

///
/// Copyright (c) 2013-2018 Sensus Slovensko a.s.
///
using System;
using System.Collections.Generic;
using log4net;
using Dirichlet.Numerics;
using TBF.BenchControl.Generic;
using TBF.Resources;

namespace TBF.BenchControl.Elde.Diverter
{
    public class Diverter : ComponentBase, IDevice, GenericDevices.IDiverter, GenericDevices.ISequenceCondition
	{
		private static readonly ILog log = LogManager.GetLogger(typeof(Diverter));
        public override string ToString() { return string.Format("Diverter({0})", Cfg.ToString(1)); }


		/// <summary>
		/// Enumeration of balances via static fields and methods
		/// </summary>
		static int nextIdx = 0;
		public static new void ResetStaticProperties()
		{
			nextIdx = 0;
		}
		public static int DivertersCount { get { return nextIdx; } }
		public static GenericDevices.IDiverter[] Diverters;

		readonly int diverterNr0;				                    /// 0-based diverter number
        public int DiverterNr { get { return diverterNr0 + 1; } }   /// 1-based public diverter number

		readonly DiverterCfg diverterCfg;
		readonly ControlBoardDev controlBoard;
        readonly UInt128 mask;		    	    /// derived from bitPosition in the constructor
        public int AdcNr { get { return diverterCfg.AdcNr; } }

        readonly int flowMtrNr4Cmd;
        readonly IOperation diverterToTankOp;
        readonly IOperation diverterToSinkOp;


        public bool State { get { return (controlBoard.Route & mask) != 0; } }
        public int ThresholdGate { get { return diverterCfg.StartingLevel; } }
        public int ThresholdLo { get { return diverterCfg.ThresholdLo; } }
        public int ThresholdHi { get { return diverterCfg.ThresholdHi; } }


        /// <summary>
        /// For a given flow in [m3/h] returns a test time correction in [s]
        /// </summary>
        public double TestTimeCorrection(double flow)
        {
            return Config.Formulas.GetCorrection(flow, Corrections);
        }


		public Diverter()
		{
		}

		public Diverter(Generic.IComponentCfg cfg, IList<Generic.IComponent> components)
			: base(cfg)
		{
			diverterCfg = cfg as DiverterCfg;

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

			if (diverterCfg.BitPosition < 0 || diverterCfg.BitPosition >= 64) throw new ArgumentOutOfRangeException("position");
            this.mask = (((UInt128)1) << diverterCfg.BitPosition);



			diverterNr0 = nextIdx++;
			///
			if (Diverters == null || Diverters.Length < nextIdx)
			{
				GenericDevices.IDiverter[] divertersSoFar = Diverters;

				Diverters = new GenericDevices.IDiverter[nextIdx];

				if (divertersSoFar != null)
				{
					for (int i = 0; i < divertersSoFar.Length; i++) Diverters[i] = divertersSoFar[i];

				}

				Diverters[nextIdx - 1] = this;
			}

			/// Prepare arguments of SendCalibData()
			if (diverterCfg.AdcNr >= 0 && diverterCfg.AdcNr < controlBoard.RegValveCalib.GetLength(0))
			{
				controlBoard.RegValveCalib[diverterCfg.AdcNr, 0] = (uint)diverterCfg.AdcValueToSink;
				controlBoard.RegValveCalib[diverterCfg.AdcNr, 1] = (uint)diverterCfg.AdcValueToTank;
			}
			else
			{
				log.ErrorFormat("Unable to set {0} ADC levels: RegValveCalib array size={1}, diverter AdcNr={2}",
								Name, controlBoard.RegValveCalib.GetLength(0), diverterCfg.AdcNr);
			}


            int divNrFromName;
            if (!int.TryParse(Name.Substring(3), out divNrFromName))
            {
                divNrFromName = nextIdx;
            }
#if GENESIS || PETERSBURG_50 || PETERSBURG_200 || FUZHOU_50 || FUZHOU_150 || FUZHOU_300
            flowMtrNr4Cmd = divNrFromName + 1;
#elif BADGER_STREDNA_TRAT
            flowMtrNr4Cmd = (divNrFromName == 1) ? 1 : ((divNrFromName == 2) ? 9 : 20);
#elif BADGER_VELKA_TRAT
            flowMtrNr4Cmd = ((divNrFromName % 10) == 1) ? 0x11 : (((divNrFromName % 10) == 2) ? 0x22 : 0x33);
#elif FUZHOU_100
            flowMtrNr4Cmd = divNrFromName;
#elif CEVAK_200
			flowMtrNr4Cmd = (divNrFromName == 4) ? 5 : divNrFromName;
#elif DEWA_300
			flowMtrNr4Cmd = divNrFromName + 2;              /// Div1: 1,2,3, Div2: 4, Div3: 5, Div4: 6, Div5: 7
#elif TURA_IPERL
            flowMtrNr4Cmd = divNrFromName + 16 * divNrFromName;
#else
            flowMtrNr4Cmd = (divNrFromName == 1) ? 1 : 3;
#endif
            diverterToTankOp = new SwitchDiverterOp(controlBoard, true, flowMtrNr4Cmd);
            diverterToSinkOp = new SwitchDiverterOp(controlBoard, false, flowMtrNr4Cmd);


			log.Debug(this.ToString());
		}


		///
		/// IDevice interface implementation
		///
		public void Initialize() { }
		public void RunDeviceBefore()
		{
			int adcValue = (int)StateMachine.ControlBoard.AnalogInputRaw(diverterCfg.AdcNr, 0);
			Handlers.OnAdcChanged(this, new CmdResponseArgs(CfgChangeCmd.GetAdc, diverterCfg.BitPosition, adcValue));
		}
		public void RunDeviceAfter() { }
		public void StopDevice() { }
		public void StopDevice2() { }


        ///
        /// ISequenceCondition interface implementation
        ///
        public int ConditionsCount { get { return 2; } }

        /// Returned strings are added to the combo-box
        public string ConditionName(int i)
        {
            if (i == 0) return string.Format("{0} {1}", Name, Strings.Start);
            else        return string.Format("{0} {1}", Name, Strings.End);
        }

        public IOperation ConditionOp(int i)
        {
            if (i == 0) return diverterToTankOp;
            else        return diverterToSinkOp;
        }


		#region Configuration Change Handling

		public static void OnCfgChange(object sender, CfgChangeArgs args)
		{
			if (CfgChangeHandler == null) return;
			try { CfgChangeHandler(sender, args); }
			catch (Exception e) { log.Error("CfgChangeHandler(...) failed", e); }
		}

		public static event EventHandler<CfgChangeArgs> CfgChangeHandler;

		public override void StartChangeHandler()
		{
			CfgChangeHandler += delegate(object sender, CfgChangeArgs args)
			{
				DiverterCfg tmpcfg = args.Cfg as DiverterCfg;
				if (tmpcfg != null && tmpcfg.Name.Equals(Name))
                {
                    if (args.Command == CfgChangeCmd.CfgChange)
					{
					}
					else if (args.Command == CfgChangeCmd.GetAdc1 || args.Command == CfgChangeCmd.GetAdc2)
					{
						int adcValue = (int)controlBoard.AnalogInputRaw(diverterCfg.AdcNr, 0);
						DiverterCfgCtrl.OnCmdResponse(this, new CmdResponseArgs(args.Command, diverterCfg.BitPosition, adcValue));
					}
					else if (args.Command == CfgChangeCmd.DivToTank)
					{
						controlBoard.DiverterToTank(flowMtrNr4Cmd);
					}
					else if (args.Command == CfgChangeCmd.DivToSink)
					{
						controlBoard.DiverterToSink(flowMtrNr4Cmd);
					}
					else if (args.Command == CfgChangeCmd.ReadDivTransition)
					{
                        controlBoard.ReadDiverterTransition(flowMtrNr4Cmd);
					}
				}
			};
		}

		#endregion Configuration Change Handling
	}
}