tbf/TBF/BenchControl/TestMethods/Adjustment/AdjustmentSeq.cs

///
/// Copyright (c) 2013-2019 Sensus Slovensko a.s.
///
using System;
using System.Collections.Generic;
using System.Text;
using log4net;
using Config.Entities;
using TBF.BenchControl;
using TBF.Boxes;
using TBF.Resources;
using TBF.UiBridge;

namespace TBF.BenchControl.TestMethods.Adjustment
{
	public class AdjustmentSeq : Sequences.SequenceBase
    {
		private static readonly ILog log = LogManager.GetLogger(typeof(AdjustmentSeq));

		System.Windows.Forms.Form modelessDlg;
		/// 
		delegate void ErrorsFormDlgt(AdjustmentSeq myRef, IList<GenericDevices.IWaterMeter> waterMeters);
		/// 
		void OpenWMErrorsForm(AdjustmentSeq myRef, IList<GenericDevices.IWaterMeter> waterMeters)
		{
#pragma warning disable 162     /// Disables 'Unreachable code detected' warning

			if (Config.Data.WMsCount > 12)
			{
				myRef.modelessDlg = new WMErrorsForm24(waterMeters);
			}
			else if (Config.Data.WMsCount > 6)
			{
				myRef.modelessDlg = new WMErrorsForm12(waterMeters);
			}
			else
			{
				myRef.modelessDlg = new WMErrorsForm(waterMeters);
			}

#pragma warning restore 162     /// Disables 'Unreachable code detected' warning

			modelessDlg.Show();
		}

		/// <summary>
		/// Adjustment method sequence
		/// </summary>
		/// <param name="test">Test entity</param>
		/// <returns>
		///		Event.Done . . . . . . . OK
		///		Event.UiCmdStop  . . . . Stopped by the user using the on-screen button STOP
		///		Event.OpArgumentError  . Target flow is out of range
		///		Event.Error  . . . . . . Unspecified error
		/// </returns>
		public IList<Event> Execute(Test test, int repetitionNr, bool isLastRepetition, DebugMode mode)
		{
			float simulatedError = 4.5f;	/// %

            IList<Event> e;                 /// Events from currently running operations
            Event retVal = Event.Done;

            int rangeIx = 0;                   /// Default range, used for non-Elde flowmeters
            if (outPath.FlowMeter is Elde.FlowMeter.FlowMeter)
            {
                Elde.FlowMeter.FlowMeter eldeFM = outPath.FlowMeter as Elde.FlowMeter.FlowMeter;
                rangeIx = -1;                   /// Indicates invalid range
                for (int r = 0; r <= 5; r++)
                {
                    if (eldeFM.RangeEnabled(r) && eldeFM.GetTempLo(r) <= test.TempLimLo
                                               && eldeFM.GetTempHi(r) >= test.TempLimHi)
                    {
                        rangeIx = r;
                    }
                }

                if (rangeIx == -1)
                {
                    Bridge.OnError(this, Strings.Flow_meter_temperature_range_does_not_fit_this_test_conditions);
                    return new List<Event> { Event.ConfigurationError };
                }
            }

            Elde.ControlBoardDev cBrd = StateMachine.ControlBoard;
            checkUiOp = new Operations.CheckUIOp(true);     /// Runs in more then one state
            processDataLoggingOp = new TBF.BenchControl.Operations.ProcessDataLoggingOp(processDataLogger, this, false);

            IList<IOperation> readTempPressOps = new List<IOperation>();
            if (benchPath.TempMtrUp != null) readTempPressOps.Add(benchPath.TempMtrUp.ReadTempOp(ref TempUp));
            if (benchPath.TempMtrDown != null) readTempPressOps.Add(benchPath.TempMtrDown.ReadTempOp(ref TempDown));
            if (outPath.TempDiv != null) readTempPressOps.Add(outPath.TempDiv.ReadTempOp(ref TempDiv));
            if (benchPath.PressMtrUp != null) readTempPressOps.Add(benchPath.PressMtrUp.ReadPressureOp(ref PressUp));
            if (benchPath.PressMtrDown != null) readTempPressOps.Add(benchPath.PressMtrDown.ReadPressureOp(ref PressDown));
            if (benchPath.PressMtrDelta != null) readTempPressOps.Add(benchPath.PressMtrDelta.ReadPressureOp(ref PressDelta));
            if (heatMetersPath != null) readTempPressOps.Add(heatMetersPath.TMeterRefWarm1.ReadTempOp(ref TempRefHi1));
            if (heatMetersPath != null) readTempPressOps.Add(heatMetersPath.TMeterRefWarm2.ReadTempOp(ref TempRefHi2));
            if (heatMetersPath != null) readTempPressOps.Add(heatMetersPath.TMeterRefCold1.ReadTempOp(ref TempRefLo1));
            if (heatMetersPath != null) readTempPressOps.Add(heatMetersPath.TMeterRefCold2.ReadTempOp(ref TempRefLo2));

            LtrPerRefPulse = outPath.FlowMeter.LtrPerPulse;         /// [ltr/pulse], nominal flow in [m3/h]
            int totalPulses = (int)(test.Volume / LtrPerRefPulse + 0.5f);

            
            /// Read pressure and temperature once before calling Bridge.OnTestSelected(...)
            State.Create(string.Format("{0}({1}) : Measuring process data", test.Method, test.Name))
                 .AddOperation(checkUiOp)
                 .AddOperations(readTempPressOps)
                 .EnterState();
            do {
                e = StateMachine.WaitRunDevsRunOps();
                if (e.Contains(Event.Error)) { retVal = Event.Error; goto stopTest; }
                if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
            }
            while (e.Contains(Event.Busy));

            /// Start the test, initialize test results
            Bridge.OnTestSelected(this, new TestSelectedEventArgs(test, repetitionNr, inPath, benchPath, outPath, sensPath, heatMetersPath, totalPulses));
            string testName = Results.Utils.GetTestName(test.Name, test.Repeats, repetitionNr);
			TestStartTime = DateTime.Now;

			Bridge.OnTestProgress(this, new TestProgressEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));
			int flowSetTime0 = StateMachine.Time;

            //------------------------------------------------
            Bridge.OnActivity(this, Strings.Starting_the_pump);
            //------------------------------------------------
            if (inPath.Pump is GenericDevices.IPumpFM) (inPath.Pump as GenericDevices.IPumpFM).TurnOn(test.PumpPower);
            ///
            State.Create(string.Format("{0}({1}) : Starting the pump", test.Method, test.Name))
                 .AddOperation(checkUiOp)
                 .AddOperations(readTempPressOps)
                 //.AddOperation(new Operations.SetAllRegulValvesOp(inPath.RegulValves, inPath.RegulValvesPct, 60))
                 .AddOperation(inPath.Pump != null ? cBrd.SetValvesOp(inPath.Pump, null) : null)
                 .EnterState();
            do {
                e = StateMachine.WaitRunDevsRunOps();
                Bridge.OnProcessData(this, new ProcessDataEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));
                Bridge.OnTestProgress(this, new TestProgressEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));

                if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
                if (e.Contains(Event.Error)) { retVal = Event.Error; goto stopTest; }

            }
            while (e.Contains(Event.ValvesBusy) /* || !e.Contains(Event.AllPositionsReached)*/);


            if (test.TimePump2StartV > 0)
            {
                State.Create(string.Format("{0}({1}) : Waiting after the pump started", test.Method, test.Name))
                     .AddOperation(checkUiOp)
                     .AddOperations(readTempPressOps)
                     .AddOperation(new Operations.TimerOp(test.TimePump2StartV))
                     .EnterState();
                do {
                    e = StateMachine.WaitRunDevsRunOps();
                    Bridge.OnProcessData(this, new ProcessDataEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));
                    Bridge.OnTestProgress(this, new TestProgressEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));

                    if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
                }
                while (!e.Contains(Event.TimerExpired));
            }


            if (benchPath.StopBFValve != null)
            {
                State.Create(string.Format("{0}({1}) : Opening the stop backflow valve", test.Method, test.Name))
                     .AddOperation(checkUiOp)
                     .AddOperations(readTempPressOps)
                     .AddOperation(StateMachine.ControlBoard.SetValvesOp(benchPath.StopBFValve, null))
                     .EnterState();
                do {
                    e = StateMachine.WaitRunDevsRunOps();
                    if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
                    if (e.Contains(Event.Error)) { retVal = Event.Error; goto stopTest; }
                }
                while (!e.Contains(Event.ValvesSet));
            }


            if (test.TimeBeforeFlow > 0)
            {
                State.Create(string.Format("{0}({1}) : Waiting before flow setting process starts", test.Method, test.Name))
                     .AddOperation(checkUiOp)
                     .AddOperations(readTempPressOps)
                     .AddOperation(new Operations.TimerOp(test.TimeBeforeFlow))
                     .EnterState();
                do {
                    e = StateMachine.WaitRunDevsRunOps();
                    Bridge.OnProcessData(this, new ProcessDataEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));
                    Bridge.OnTestProgress(this, new TestProgressEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));

                    if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
                }
                while (!e.Contains(Event.TimerExpired));
            }


        setting_flow:

            //------------------------------------------------
            Bridge.OnActivity(this, Strings.Setting_the_flow);
            //------------------------------------------------
            State.Create(string.Format("{0}({1}) : Setting the flow", test.Method, test.Name))
				 .AddOperation(checkUiOp)
                 .AddOperations(readTempPressOps)
                 .AddOperation(outPath.RegulValve.SetFlowOp(outPath.FlowMeter, test.Qfrom, test.Qto, outPath.PidCoef, RefFlow, FlowSettingTimeoutSec))
				 .EnterState();
			do {
				e = StateMachine.WaitRunDevsRunOps();
				Bridge.OnProcessData(this, new ProcessDataEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));
				Bridge.OnTestProgress(this, new TestProgressEventArgs(test, repetitionNr, Config.Entities.Progress.FlowSetting));

				if (e.Contains(Event.OpArgumentError)) { retVal = Event.OpArgumentError; goto stopTest; }
				if (TestAndLogUiCmdStop(test,e))		 { retVal = Event.UiCmdStop; goto stopTest; }
				if (e.Contains(Event.RegulValveTimeOut))
				{
					Bridge.OnError(this, Strings.Flow_adjustment_failed);
                    retVal = Event.UiCmdStop;
					goto stopTest;
				}
				if (e.Contains(Event.Next)) goto flow_set;
			}
			while (!e.Contains(Event.FlowReached));

		flow_set:

			int flowSetTime = StateMachine.Time - flowSetTime0;

			if (test.DoControlWaterTemp && benchPath.TempMtrUp != null && benchPath.TempMtrDown != null)
			{
				//---------------------------------------------------
				Bridge.OnActivity(this, Strings.Setting_temperature);
				//---------------------------------------------------

				State.Create(string.Format("{0}({1}) : Wait until the water temperature is within limits", test.Method, test.Name))
					 .AddOperation(checkUiOp)
                     .AddOperations(readTempPressOps)
					 .EnterState();
				do {
					e = StateMachine.WaitRunDevsRunOps();
					if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
					if (e.Contains(Event.Next)) goto temperature_set;

                    if ((test.TempLimLo <= TempUp.Val) && (TempUp.Val <= test.TempLimHi) &&
                        (test.TempLimLo <= TempDown.Val) && (TempDown.Val <= test.TempLimHi))
					{
						goto temperature_set;
					}
				}
				while (true);
			}

		temperature_set:

			/// Show the modeless dialog with error indication
			Program.MainWnd.Invoke(new ErrorsFormDlgt(OpenWMErrorsForm), new object[] { this, WaterMeters });

		loop:
            int time = StateMachine.Time;
            double currentFlow = RefFlow.Val;


			///
			/// Prepare cameras, ROI-s and measurementOperations
			///

			/// Find ROI-s
            int[] filters = new int[] { 0, 0, 0, 0, 0, 0, 0, 0 };
            IList<GenericDevices.IRoi> rois = new List<GenericDevices.IRoi>();
			foreach (var rr in sensPath.RegisterReaders)
			{
                TBF.BenchControl.Elde.RegisterReader.RegisterReader regr = rr as TBF.BenchControl.Elde.RegisterReader.RegisterReader;
                if (regr != null)
                {
                    if (regr.Position >= 1 && regr.Position <= 8) { filters[regr.Position - 1] = regr.Filter; }
                }

				GenericDevices.IRoi roi = rr as GenericDevices.IRoi;
				if (roi != null && roi.Detected)
				{
					rois.Add(roi);
				}
			}

			/// Find cameras
			IList<GenericDevices.ICamera> cameras = new List<GenericDevices.ICamera>();
			foreach (var roi in rois)
			{
				if (roi.Camera != null && !cameras.Contains(roi.Camera))
				{
					roi.Camera.ClearRoiParams();
					cameras.Add(roi.Camera);
				}
			}

			/// Register ROI-parameters to cameras
			foreach (var roi in rois) roi.RegisterRoiToCamera();

			/// Prepare measurementOperations
			IList<IOperation> measureOperations = new List<IOperation>();
			foreach (var camera in cameras) measureOperations.Add(camera.MeasurementOp());



			//------------------------------------------------
			Bridge.OnActivity(this, Strings.Test_in_progress);
			//------------------------------------------------
			if (mode == Config.Entities.DebugMode.Simulate)
			{
				/// TODO: Reimplement
				//tstRslt = MakeSimulated(test, 1, simulatedError);
				simulatedError *= 0.6f;

				State.Create(string.Format("{0}({1}) : Simulating the test", test.Method, test.Name))
					 .AddOperation(checkUiOp)
                     .AddOperations(readTempPressOps)
                     .AddOperation(new Operations.TimerOp(5))
					 .EnterState();
				do {
					e = StateMachine.WaitRunDevsRunOps();
					if (e.Contains(Event.Error)) { retVal = Event.Error; goto stopTest; }
					if (TestAndLogUiCmdStop(test,e)) { retVal = Event.UiCmdStop; goto stopTest; }
				}
				while (!e.Contains(Event.TimerExpired));
			}
			else
			{
                State.Create(string.Format("{0}({1}) : Starting the test", test.Method, test.Name))
					 .AddOperation(checkUiOp)
                     .AddOperations(readTempPressOps)
                     .AddOperations(measureOperations)
					 .AddOperation(cBrd.StartMeasurementOp(outPath, Elde.TestMethods.Synchro, test.Qfrom, test.Qto, totalPulses, filters))
					 .EnterState();
				do {
					e = StateMachine.WaitRunDevsRunOps();
					if (e.Contains(Event.Error)) { retVal = Event.Error; goto stopTest; }
					if (TestAndLogUiCmdStop(test,e)) { retVal = Event.UiCmdStop; goto stopTest; }
				}
				while (!e.Contains(Event.MeasurementStarted));

				/// Measurement loop - preparation
				readRegistersOp = new Operations.ReadMoreRegistersOp(sensPath.RegisterReaders);
				queryEnd1 = cBrd.QueryMeasurementEndOp();
				queryEnd2 = cBrd.QueryMeasurementEndOp();

                StartNewStatistics(StateMachine.Time, BatchRslts.Batch.BatchNr, test.Name, repetitionNr, 0);

				/// Measurement loop - begin
				while (true)
				{
					//--------------------------------
					switch (ReadRegistersTempPressAmbient(measureOperations, true))
					{
						case Event.Error:       { retVal = Event.Error;     goto stopTest; }
						case Event.UiCmdStop:   { retVal = Event.UiCmdStop; goto stopTest; }
						case Event.MeasurementCompleted: goto one_test_completed;
					}

					RefFreq.Val = cBrd.ReferenceFreq;
					RefFlow.Val = cBrd.ReferenceFlow;
					UpdateAllStatistics(StateMachine.Time);

					Bridge.OnProcessData(this, new ProcessDataEventArgs(test, repetitionNr, Config.Entities.Progress.Test));
					Bridge.OnTestProgress(this, new TestProgressEventArgs(test, repetitionNr, Config.Entities.Progress.Test));
				}
			/// Measurement loop - end

			one_test_completed:

				//------------------------------------------------
				Bridge.OnActivity(this, Strings.Adjustment_in_progress);
				//------------------------------------------------

				TestEndTime = DateTime.Now;

				/// Make sure the CycleBeginForm is closed so that water meter data (s/n) can be copied into results
				if (UIFlowControl.Stop == WaitBeginFormClosed()) goto stopTest;

				///
				/// Populate TestResult data entity with data
				/// 
				Results.Entities.TestRslt tstRslt = BatchRslts.GetTestRslt(testName, test.Part);

				if (tstRslt != null)
				{
                    UpdateTempPressDensAmb(tstRslt);

					/// Main results
                    tstRslt.MethodClass  = TbfComponents.FindComponent(test.Method).ClassName;
                    tstRslt.StartTime    = TestStartTime;
					tstRslt.EndTime      = TestEndTime;
					tstRslt.FlowSetTime  = flowSetTime;
					tstRslt.TestTime     = cBrd.TTime;							/// [s] measurement time
					tstRslt.PulsesMaster = Convert.ToDouble(cBrd.EtPulses(0));  /// Pulses of the master flow meter (test total)
					tstRslt.MassStart    = 0;
					tstRslt.MassEnd      = 0;
					tstRslt.FlowMass     = 0;                                                           /// [kg/h]
					tstRslt.FlowVolume   = 3.6 * LtrPerRefPulse * cBrd.EtPulses(0) / tstRslt.TestTime;	/// [m3/h]
                    tstRslt.Buoyancy     = Config.Formulas.Buoyancy();
					tstRslt.VolumeMaster = LtrPerRefPulse * tstRslt.PulsesMaster;                                   /// [l] volume from the master flow meter
                    tstRslt.ConstMasterRaw  = outPath.FlowMeter.LtrPerPulse;                                        /// Uncorrected master flowmeter coefficient
                    tstRslt.ConstMasterCorr = outPath.FlowMeter.LtrPerPulseCorrected(tstRslt.FlowVolume, rangeIx);  /// Corrected master pulses per liter
                    tstRslt.ConstMaster     = tstRslt.ConstMasterCorr;                                              /// Corrected master pulses per liter
					tstRslt.VolumeCTV    = tstRslt.ConstMaster * tstRslt.PulsesMaster;					            /// [l] 1000.0f is because density is in [kg/m3]
					tstRslt.ErrorMaster  = 0.0f;														            /// Cannot be determined without the collected water mass measurement

					tstRslt.FlowMean = (float)RefFlowStat.Average;
					tstRslt.FlowStart = (float)RefFlowStat.First;
					tstRslt.FlowEnd = (float)RefFlowStat.Last;
					tstRslt.FlowMin = (float)RefFlowStat.Min;
                    tstRslt.FlowMax = (float)RefFlowStat.Max;

                    tstRslt.DiverterStart = 0;
                    tstRslt.DiverterEnd = 0;
                    tstRslt.ErrorFlagsMd = (ErrorFlagsComp != null) ? (sbyte)ErrorFlagsComp.Mode : (sbyte)0;
                    tstRslt.ErrorFlags = (ErrorFlagsComp != null) ? ErrorFlagsComp.GetErrorFlags(tstRslt, false, false, 0, 0) : 0;

                    for (int i = 0; i < BatchRslts.WMPositionsCount; i++)
                    {
                        if (!test.IsPartCompatible(Utils.PartNr(i + 1, BatchRslts.Batch.Compound))) continue;

                        Results.Entities.MeterTestRslt meterRslt = BatchRslts.GetMeterTestRslt(testName, i, CompoundMeterId.Single);
						GenericDevices.IRegisterReader regReader = sensPath.RegisterReaders[i];

						if (meterRslt != null && regReader != null)
						{
                            meterRslt.RegReaderType = (int)regReader.RegisterReaderType;
                            meterRslt.PulsesPerLiter = regReader.PulsesPerLtr;
							meterRslt.PulsesMeter    = Convert.ToDouble(regReader.WMPulses);
							meterRslt.PulsesMaster   = Convert.ToDouble(regReader.WMRefPulses);
							meterRslt.VolumeStart    = 0;												/// liter
							meterRslt.VolumeEnd      = 0;												/// liter
							meterRslt.VolumeMeter    = meterRslt.PulsesMeter * regReader.LtrsPerPulse;	/// liter
							meterRslt.VolumeRef      = meterRslt.PulsesMaster * tstRslt.ConstMaster;	/// liter
							meterRslt.TestTime       = cBrd.ImpulseTime(i + 1);
                            meterRslt.Error          = Config.Formulas.ErrorFromVolumes(meterRslt.VolumeMeter, meterRslt.VolumeRef);
							meterRslt.Passed         = (meterRslt.Error >= test.GetErrLimLo(tstRslt.VolumeCTV, tstRslt.TestTime) + test.Uncertainty)
                                                    && (meterRslt.Error <= test.GetErrLimHi(tstRslt.VolumeCTV, tstRslt.TestTime) - test.Uncertainty);
							meterRslt.TestDone       = true;
                            tstRslt.TestDone         = true;
                        }
					}

					tstRslt.Components = Results.Entities.Components
						.UpdateList(BatchRslts.ComponentsList,
									new Results.Entities.Components((BenchInfo != null) ? BenchInfo.TestBenchId : 1,
																	(BenchInfo != null) ? BenchInfo.TestBenchName : "testbench",
																	inPath.Pump != null ? inPath.Pump.Name : string.Empty,
																	outPath.FlowMeter != null ? outPath.FlowMeter.Name : string.Empty,
																	outPath.Scale != null ? outPath.Scale.Name : string.Empty,
																	outPath.RegulValve != null ? outPath.RegulValve.Name : string.Empty,
																	outPath.Diverter != null ? outPath.Diverter.Name : string.Empty));

                    /// Update water meter error flags
                    if (ErrorFlagsComp != null)
                    {
                        for (int i = 0; i < BatchRslts.WMPositionsCount; i++)
                        {
                            if (BatchRslts.WaterMeters[i] != null)
                            {
                                BatchRslts.WaterMeters[i].ErrorFlags = ErrorFlagsComp.GetWMtrErrorFlags(BatchRslts.WaterMeters[i].MeterTestRslts);
                            }
                        }
                    }

					/// Update results
					Bridge.OnTestCompleted(this, new TestCompletedEventArgs(testName, tstRslt));
				}
				/// Add data - end
			}


			/// Update modeless dialog error information
			Bridge.OnAdjustmentInProgress(this, new AdjustmentInProgressEventArgs(testName));

			/// Test 'Quit'
			if ((modelessDlg is GenericDevices.IHasCompleted) && !(modelessDlg as GenericDevices.IHasCompleted).Completed)
			{
				goto loop;			/// Modeless dilaog not closed, keep looping
			}
			modelessDlg = null;		/// Modeless dialog is closed now

			/// Append the results to the CSV-file
			allResults.Info(TestResult2CsvLine(testName, test.Part));

		stopTest:

			///
			///  Quit this sequence
			///
			if (isLastRepetition || retVal == Event.UiCmdStop || retVal == Event.OpArgumentError
								 || retVal == Event.Error || retVal == Event.ConfigurationError)
			{
                State.Create(string.Format("{0}({1}) : Stopping diverter, gate, etc.", test.Method, test.Name))
                     .AddOperation(checkUiOp)
                     .AddOperation(cBrd.StopPreviousOp())
                     .EnterState();
                do {
                    e = StateMachine.WaitRunDevsRunOps();
                    if (TestAndLogUiCmdStop(test, e)) { retVal = Event.UiCmdStop; goto stopTest; }
                }
                while (!e.Contains(Event.PreviousStopped));
            }

    stopTestWOStoppingDivGateEtc:

			return new List<Event> { retVal };
		}
    }
}