2015-04-15 18:32:56 +00:00
///
/// Copyright (c) 2013-2015 Sensus Metering Systems
///
using System ;
2014-07-28 07:54:35 +00:00
using System.Collections.Generic ;
using System.Text ;
using log4net ;
using TBF.BenchControl ;
using TBF.Resources ;
2014-07-31 15:04:09 +00:00
using TBF.UiBridge ;
2014-07-28 07:54:35 +00:00
namespace TBF.BenchControl.TestMethods.CombinedWithDetection
{
public class CombinedWithDetectionSeq : Sequences . SequenceBase
{
private static readonly ILog log = LogManager . GetLogger ( typeof ( CombinedWithDetectionSeq ) ) ;
const int DetectionBufferSize = 9 ;
const int DetectionKernelSize = 5 ;
2015-12-04 16:17:20 +00:00
public IList < Event > Execute ( Config . Entities . Test test , CombinedWithDetTestParams testParams )
2014-07-28 07:54:35 +00:00
{
2015-12-04 16:17:20 +00:00
if ( test . Part < 1 | | test . Part > Config . Data . CompoundWMsCount )
2015-02-02 22:18:28 +00:00
{
2015-12-04 16:17:20 +00:00
UiBridge . Bridge . OnError ( this , string . Format ( "Test 'Part' should be 1 .. {0}" , Config . Data . CompoundWMsCount ) ) ;
2015-02-02 22:18:28 +00:00
IList < Event > retval = new List < Event > ( 1 ) ;
retval . Add ( Event . ConfigurationError ) ;
return retval ;
}
2014-07-28 07:54:35 +00:00
Elde . ControlBoardDev cBrd = StateMachine . ControlBoard ;
/// Specific for combined meters
2015-12-04 16:17:20 +00:00
int [ ] lastWMPulses = new int [ 2 * Config . Data . CompoundWMsCount ] ;
2014-07-28 07:54:35 +00:00
2014-09-26 15:48:55 +00:00
IList < Event > e = new List < Event > ( ) ; /// Events from currently running operations
2014-12-31 12:44:47 +00:00
2014-09-26 15:48:55 +00:00
checkUiOp = new Operations . CheckUIOp ( true ) ; /// Runs in more then one state
2014-07-28 07:54:35 +00:00
//--------------------------------
2015-04-28 13:27:47 +00:00
State . Create ( "CombinedWithDetection : stopTest diverter gate etc" )
2014-07-28 07:54:35 +00:00
. AddOperation ( checkUiOp )
. AddOperation ( cBrd . StopPreviousOp ( ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . PreviousStopped ) ) ;
2014-09-12 05:17:30 +00:00
ltrPerRefPulse = outPath . FlowMeter . LtrPerPulse ; /// [ltr/pulse], nominal flow in [m3/h]
/// Notes:
/// float timeHr = volumeLtr / (1000.0f * targetFlow);
/// float timeSec = 3600.0f * timeHr;
/// int refPulses = (int)(timeSec * (2000.0f * targetFlow / pOut.FlowMeter.NominalFlow));
2014-10-02 18:56:24 +00:00
int totalPulses = ( int ) ( test . Volume / ltrPerRefPulse + 0.5f ) ;
2014-09-12 05:17:30 +00:00
2014-09-09 14:18:23 +00:00
processDataLoggingOp = new TBF . BenchControl . Operations . ProcessDataLoggingOp ( processDataLogger , this ) ;
/// Meters path is required for the following:
2015-08-19 11:04:47 +00:00
readRegistersOp = new Operations . ReadMoreRegistersOp ( sensPath . RegisterReaders , ref WMPulses , ref WMRefPulses ) ;
2014-07-28 07:54:35 +00:00
int repetitionNr = 1 ; /// First test: repetitionNr=1
//====================================
// Transition or SetRoute - Start
//====================================
2015-05-22 08:29:56 +00:00
switch ( Transition ( transitionBefore , TransitionContext . BeforeTest ) )
2014-07-28 07:54:35 +00:00
{
2014-08-14 07:05:40 +00:00
case Event . Error : goto error ;
2015-04-28 13:27:47 +00:00
case Event . UiCmdStop : goto stopTest ;
2014-07-28 07:54:35 +00:00
}
//====================================
loop :
/// Start the test, initialize test results
Bridge . OnTestSelected ( this , new TestSelectedEventArgs ( test , repetitionNr , inPath , benchPath , outPath , sensPath , ( int ) totalPulses ) ) ;
2016-01-03 01:05:35 +00:00
string testName = Results . Utils . GetTestName ( test . Name , test . Repeats , repetitionNr ) ;
TestStartTime = DateTime . Now ;
2014-07-28 07:54:35 +00:00
2016-01-03 01:05:35 +00:00
Qrise = 0 ;
Qfall = 0 ;
2014-07-28 07:54:35 +00:00
if ( ! test . Emptying ) /// Do not skip emptying if test.Emptying==true
{
//--------------------------------
State . Create ( "CombinedWithDetection : Get the mass of water in the tank" )
. AddOperation ( checkUiOp )
2015-12-20 19:48:50 +00:00
. AddOperation ( outPath . Balance . ReadMassOp ( ref Mass ) )
2014-07-28 07:54:35 +00:00
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . BalanceDone ) ) ;
2015-12-20 19:48:50 +00:00
float estimatedEndMass = Mass . Val + test . Volume ;
2014-07-28 07:54:35 +00:00
if ( estimatedEndMass < outPath . Balance . Capacity * Constants . TankFullFactor )
{
goto switching_flow_detection ; /// Enough room in the tank -> skip emptying
}
}
// Empty the water tank
switch ( EmptyTheTank ( outPath . EmptyTankValve , outPath . Balance ) )
{
case Event . Error : goto error ;
2015-04-28 13:27:47 +00:00
case Event . UiCmdStop : goto stopTest ;
2014-07-28 07:54:35 +00:00
}
switching_flow_detection :
2016-01-03 01:05:35 +00:00
int flowDetectTime0 = StateMachine . Time ;
int flowDetectTime = 0 ;
2014-08-01 06:36:17 +00:00
float estFlowSetTime = 100.0f ;
2014-07-28 07:54:35 +00:00
/// Extract cameras from the current sensors path, add operations to the detection state
IList < IOperation > measureOperations = new List < IOperation > ( ) ;
for ( int i = 0 ; i < sensPath . RegisterReaders . Length ; i + + )
{
GenericDevices . ICameraRoi cameraRoi = sensPath . RegisterReaders [ i ] as GenericDevices . ICameraRoi ;
if ( cameraRoi ! = null ) measureOperations . Add ( cameraRoi . MeasureOp ( ) ) ;
}
//------------------------------------------------
Bridge . OnActivity ( this , Strings . Switching_flow_detection ) ;
//------------------------------------------------
State . Create ( "CombinedWithDetection : Start the pump" )
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
2015-01-17 03:52:42 +00:00
. AddOperation ( ( inPath . Pump is GenericDevices . IPumpFM ) ? ( inPath . Pump as GenericDevices . IPumpFM ) . TurnOnOp ( test . PumpPower ) : null )
2014-07-28 07:54:35 +00:00
. AddOperation ( cBrd . SetValvesOp ( inPath . Pump , null ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2014-08-01 06:36:17 +00:00
2016-01-03 01:05:35 +00:00
flowDetectTime = StateMachine . Time - flowDetectTime0 ;
float progress = Formulas . TestProgress ( flowDetectTime , estFlowSetTime , test . TstTime ) ;
Bridge . OnTestProgress ( this , GetTestProgressData ( test , repetitionNr , false , cBrd , flowDetectTime , progress ) ) ;
2014-08-01 06:36:17 +00:00
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . ValvesSet ) ) ;
//--------------------------------
State . Create ( "CombinedWithDetection : Set the initial flow" )
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
2015-12-20 19:48:50 +00:00
. AddOperation ( outPath . RegulValve . SetFlowAndMeasureOp ( outPath . FlowMeter , test . Qfrom , test . Qto , outPath . PidCoef , RefFlow , 600 , ( float ) test . TolerRed ) ) /// timeout = 10 min.
2014-07-28 07:54:35 +00:00
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2014-08-01 06:36:17 +00:00
2016-01-03 01:05:35 +00:00
flowDetectTime = StateMachine . Time - flowDetectTime0 ;
float progress = Formulas . TestProgress ( flowDetectTime , estFlowSetTime , test . TstTime ) ;
Bridge . OnTestProgress ( this , GetTestProgressData ( test , repetitionNr , false , cBrd , flowDetectTime , progress ) ) ;
2014-08-01 06:36:17 +00:00
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2015-01-12 04:56:19 +00:00
if ( e . Contains ( Event . RegulValveTimeOut ) )
{
Bridge . OnError ( this , Strings . Timeout ) ;
goto error ;
}
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . FlowReached ) ) ;
//--------------------------------
switch ( ReadRegistersTempPressAmbient ( measureOperations , false ) )
{
case Event . Error : goto error ;
2015-04-28 13:27:47 +00:00
case Event . UiCmdStop : goto stopTest ;
2014-07-28 07:54:35 +00:00
}
//====================================
// Find the switching flow
//====================================
/// Allocate detection buffers
float [ ] flowsForDetection = new float [ DetectionBufferSize ] ;
float [ ] pulseFreqsForDetection = new float [ DetectionBufferSize ] ;
/// Current values
2015-12-20 19:48:50 +00:00
flowsForDetection [ 0 ] = RefFlow . Val ;
2014-07-28 07:54:35 +00:00
pulseFreqsForDetection [ 0 ] = 0.0f ;
2014-08-01 06:36:17 +00:00
int startTime = StateMachine . Time ;
int lastTime = StateMachine . Time ;
2014-07-28 07:54:35 +00:00
/// Detection parameters
float rvPulse = ( testParams . TargetQ > ( test . Qfrom + test . Qto ) / 2.0f ) ? 0.05f : - 0.05f ; // rise or fall?
rvPulse * = ( 100.0f * testParams . RateOfChange ) ;
bool detected = false ;
bool targetReached = false ;
float detectedFlow = 0 ;
2014-08-01 08:54:38 +00:00
int detectionStartTime = StateMachine . Time ;
2014-07-28 07:54:35 +00:00
do
{
//--------------------------------
State . Create ( "CombinedWithDetection : Change the RV position" )
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
. AddOperation ( outPath . RegulValve . ChangeRegulValvePositionOp ( rvPulse ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2014-08-01 06:36:17 +00:00
2016-01-03 01:05:35 +00:00
flowDetectTime = StateMachine . Time - flowDetectTime0 ;
float progress = Formulas . TestProgress ( flowDetectTime , estFlowSetTime , test . TstTime ) ;
Bridge . OnTestProgress ( this , GetTestProgressData ( test , repetitionNr , false , cBrd , flowDetectTime , progress ) ) ;
2014-08-01 06:36:17 +00:00
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . PositionReached ) ) ;
// Last pulses are kept to calculate differences
2015-12-04 16:17:20 +00:00
for ( int i = 0 ; i < 2 * Config . Data . CompoundWMsCount ; i + + ) lastWMPulses [ i ] = WMPulses [ i ] ;
2014-07-28 07:54:35 +00:00
// Shift data in the detection buffers
for ( int i = DetectionBufferSize - 2 ; i > = 0 ; i - - )
{
flowsForDetection [ i + 1 ] = flowsForDetection [ i ] ;
pulseFreqsForDetection [ i + 1 ] = pulseFreqsForDetection [ i ] ;
}
switch ( ReadRegistersTempPressAmbient ( measureOperations , false ) )
{
case Event . Error : goto error ;
2015-04-28 13:27:47 +00:00
case Event . UiCmdStop : goto stopTest ;
2014-07-28 07:54:35 +00:00
}
2014-08-01 06:36:17 +00:00
int time = StateMachine . Time ;
2015-01-17 07:57:50 +00:00
int diff = WMPulses [ ( test . Part - 1 ) * 2 + 1 ] - lastWMPulses [ ( test . Part - 1 ) * 2 + 1 ] ;
2014-07-28 07:54:35 +00:00
flowsForDetection [ 0 ] = cBrd . ReferenceFreq * outPath . FlowMeter . NominalFlow / 2000.0f ;
pulseFreqsForDetection [ 0 ] = ( float ) diff / ( float ) ( time - lastTime ) ;
2014-08-01 06:36:17 +00:00
lastTime = StateMachine . Time ;
2014-07-28 07:54:35 +00:00
2014-08-01 08:54:38 +00:00
if ( StateMachine . Time - detectionStartTime > 15 )
{
if ( ( flowsForDetection [ 0 ] > 0 ) & & ( flowsForDetection [ DetectionBufferSize - 1 ] > 0 ) )
{
float [ ] flowBefore = new float [ DetectionKernelSize ] ;
float [ ] flowAfter = new float [ DetectionKernelSize ] ;
float [ ] freqBefore = new float [ DetectionKernelSize ] ;
float [ ] freqAfter = new float [ DetectionKernelSize ] ;
for ( int i = 0 ; i < DetectionKernelSize ; i + + )
{
flowBefore [ i ] = flowsForDetection [ DetectionBufferSize - DetectionKernelSize + i ] ;
freqBefore [ i ] = pulseFreqsForDetection [ DetectionBufferSize - DetectionKernelSize + i ] ;
flowAfter [ i ] = flowsForDetection [ i ] ;
freqAfter [ i ] = pulseFreqsForDetection [ i ] ;
}
Array . Sort ( flowBefore ) ;
Array . Sort ( flowAfter ) ;
Array . Sort ( freqBefore ) ;
Array . Sort ( freqAfter ) ;
flowBefore [ 0 ] = 0 ;
flowAfter [ 0 ] = 0 ;
//freqBefore[0] = 0;
//freqAfter[0] = 0;
flowBefore [ DetectionKernelSize - 1 ] = 0 ;
flowAfter [ DetectionKernelSize - 1 ] = 0 ;
//freqBefore[DetectionKernelSize - 1] = 0;
//freqAfter[DetectionKernelSize - 1] = 0;
float aveFlowBefore = 0 ;
float aveFlowAfter = 0 ;
float aveFreqBefore = 0 ;
float aveFreqAfter = 0 ;
foreach ( var f in flowBefore ) aveFlowBefore + = f ;
foreach ( var f in flowAfter ) aveFlowAfter + = f ;
foreach ( var f in freqBefore ) aveFreqBefore + = f ;
foreach ( var f in freqAfter ) aveFreqAfter + = f ;
aveFlowBefore / = ( float ) ( DetectionKernelSize - 2 ) ;
aveFlowAfter / = ( float ) ( DetectionKernelSize - 2 ) ;
aveFreqBefore / = ( float ) ( DetectionKernelSize ) ;
aveFreqAfter / = ( float ) ( DetectionKernelSize ) ;
UiBridge . Bridge . OnLog ( this , string . Format ( "time={0}, flow{1}, aveFlowB={2}, aveFlowA={3}, pulseFreq={4}, aveFreqB={5}, aveFreqA={6}\r\n" ,
time - startTime ,
flowsForDetection [ 0 ] . ToString ( "F2" ) ,
aveFlowBefore . ToString ( "F2" ) ,
aveFlowAfter . ToString ( "F2" ) ,
pulseFreqsForDetection [ 0 ] . ToString ( "F2" ) ,
aveFreqBefore . ToString ( "F2" ) ,
aveFreqAfter . ToString ( "F2" ) ) ) ;
//detectedFlow = (aveFlowBefore + aveFlowAfter) / 2.0f;
detectedFlow = aveFlowBefore ;
if ( rvPulse > 0 )
{
detected = ( aveFreqAfter < aveFreqBefore * ( 1.0f - testParams . DetectionThreshold ) ) ;
targetReached = ( ( aveFlowAfter + aveFlowBefore ) / 2.0f ) > testParams . TargetQ ;
}
else
{
detected = ( aveFreqAfter > aveFreqBefore * ( 1.0f + testParams . DetectionThreshold ) ) ;
targetReached = ( ( aveFlowAfter + aveFlowBefore ) / 2.0f ) < testParams . TargetQ ;
}
}
}
2014-07-28 07:54:35 +00:00
}
while ( ! detected & & ! targetReached ) ;
if ( rvPulse > 0 )
{
Qrise = detectedFlow ;
}
else
{
Qfall = detectedFlow ;
}
UiBridge . Bridge . OnLog ( this , string . Format ( "detected flow={0}\r\n" , detectedFlow . ToString ( "F2" ) ) ) ;
2016-01-03 01:05:35 +00:00
float qfrom_detected = detectedFlow + testParams . RelativeQfrom ;
float qto_detected = detectedFlow + testParams . RelativeQto ;
2014-07-28 07:54:35 +00:00
/// Update test results with the test flow determined from the detected switching flow
2016-01-03 01:05:35 +00:00
float Qave_lps = ( qfrom_detected + qto_detected ) / 7.2f ;
float testTimeFromDetectedFlow = test . Volume / Qave_lps ; /// Test volume wont be changed
2014-07-28 07:54:35 +00:00
2014-08-01 06:36:17 +00:00
float relativeQave = ( testParams . RelativeQfrom + testParams . RelativeQto ) / 2.0f ;
bool goBackToInitFlow = ( ( rvPulse > 0 ) & & ( relativeQave < 0 ) ) | |
( ( rvPulse < 0 ) & & ( relativeQave > 0 ) ) ;
2014-07-28 07:54:35 +00:00
2016-01-03 01:05:35 +00:00
int flowSetTime0 = StateMachine . Time ;
int flowSetTime = 0 ;
if ( goBackToInitFlow )
2014-08-01 06:36:17 +00:00
{
//--------------------------------
State . Create ( "CombinedWithDetection : Switching flow detected, going back" )
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
2015-12-20 19:48:50 +00:00
. AddOperation ( outPath . RegulValve . SetFlowOp ( outPath . FlowMeter , test . Qfrom , test . Qto , outPath . PidCoef , RefFlow , 600 ) ) /// timeout = 10 min.
2014-08-01 06:36:17 +00:00
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2016-01-03 01:05:35 +00:00
flowSetTime = StateMachine . Time - flowSetTime0 ;
2014-08-01 06:36:17 +00:00
float progress = Formulas . TestProgress ( flowSetTime , estFlowSetTime , test . TstTime ) ;
2016-01-03 01:05:35 +00:00
Bridge . OnTestProgress ( this , GetTestProgressData ( test , repetitionNr , false , cBrd , flowSetTime , progress ) ) ;
2014-08-01 06:36:17 +00:00
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2015-01-12 04:56:19 +00:00
if ( e . Contains ( Event . RegulValveTimeOut ) )
{
Bridge . OnError ( this , Strings . Timeout ) ;
goto error ;
}
}
2014-08-01 06:36:17 +00:00
while ( ! e . Contains ( Event . FlowReached ) ) ;
}
2014-07-28 07:54:35 +00:00
//--------------------------------
State . Create ( "CombinedWithDetection : Going to the test flow" )
//State.Create("set_RV_position",
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
2016-01-03 01:05:35 +00:00
. AddOperation ( outPath . RegulValve . SetFlowOp ( outPath . FlowMeter , qfrom_detected , qto_detected , outPath . PidCoef , RefFlow , 600 ) ) /// timeout = 10 sec.
2014-07-28 07:54:35 +00:00
//.AddOp(pOut.RegulValve.SetPositionOp(35.0f, 38.0f, uint.MaxValue))
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2014-08-01 06:36:17 +00:00
2016-01-03 01:05:35 +00:00
flowSetTime = StateMachine . Time - flowSetTime0 ;
float progress = Formulas . TestProgress ( flowSetTime , estFlowSetTime , testTimeFromDetectedFlow ) ;
Bridge . OnTestProgress ( this , GetTestProgressData ( test , repetitionNr , false , cBrd , flowSetTime , progress ) ) ;
2014-08-01 06:36:17 +00:00
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
//if (e.Contains(Event.FlowTimeOut)) goto do_detection;
}
while ( ! e . Contains ( Event . FlowReached ) ) ;
2014-12-31 12:44:47 +00:00
//start_measurement:
2014-07-28 07:54:35 +00:00
//------------------------------------------------
Bridge . OnActivity ( this , Strings . Measuring_the_weight ) ;
//------------------------------------------------
State . Create ( Strings . Measure_the_mass )
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
2014-07-31 20:17:38 +00:00
. AddOperation ( outPath . Balance . ReadStableMassOp ( ref startMass , 5 ) )
2014-07-28 07:54:35 +00:00
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . BalanceDone ) ) ;
2016-01-03 01:05:35 +00:00
StartMassRaw = startMass . Val ;
2015-12-20 19:48:50 +00:00
Mass . Val = startMass . Val ;
2014-07-28 07:54:35 +00:00
//------------------------------------------------
Bridge . OnActivity ( this , Strings . Test_in_progress ) ;
//------------------------------------------------
State . Create ( Strings . Start_the_test )
. AddOperation ( checkUiOp )
. AddOperations ( measureOperations )
2015-09-22 14:59:17 +00:00
. AddOperation ( cBrd . StartMeasurementOp ( outPath , Elde . TestMethods . Diverter | Elde . TestMethods . Synchro ,
2016-01-03 01:05:35 +00:00
qfrom_detected , qto_detected , totalPulses , ( float ) test . TolerRed ) )
2014-07-28 07:54:35 +00:00
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . MeasurementStarted ) ) ;
///
/// Measurement loop - preparation
///
queryEnd1 = cBrd . QueryMeasurementEndOp ( ) ;
queryEnd2 = cBrd . QueryMeasurementEndOp ( ) ;
2016-01-03 01:05:35 +00:00
ClearAllStatistics ( ) ;
int estimtdEndTime = StateMachine . Time + ( int ) test . TstTime ;
2014-07-28 07:54:35 +00:00
/// Measurement loop - begin
while ( true )
{
//--------------------------------
switch ( ReadRegistersTempPressAmbient ( measureOperations , true ) )
{
case Event . Error : goto error ;
2015-04-28 13:27:47 +00:00
case Event . UiCmdStop : goto stopTest ;
2014-07-28 07:54:35 +00:00
case Event . MeasurementCompleted : goto measurement_completed ;
}
2015-02-20 12:38:07 +00:00
int remainingTime = Math . Max ( estimtdEndTime - StateMachine . Time , 0 ) ;
2015-09-22 09:29:20 +00:00
if ( remainingTime > 60 )
{
2015-10-14 13:45:51 +00:00
Bridge . OnActivity ( this , string . Format ( "{0} ... {1} {2} {3} {4}" , Strings . Test_in_progress , remainingTime / 60 , "min" , remainingTime % 60 , Strings . sec ) ) ;
2015-09-22 09:29:20 +00:00
}
else
{
Bridge . OnActivity ( this , string . Format ( "{0} ... {1} s" , Strings . Test_in_progress , remainingTime ) ) ;
}
2015-02-20 12:38:07 +00:00
2016-01-03 01:05:35 +00:00
UpdateAllStatistics ( ) ;
CurrentMassRaw = Mass . Val ;
2014-07-28 07:54:35 +00:00
string logstr = string . Format ( "E={0} f={1} q={2}" , cBrd . EtPulses ( 0 ) , cBrd . ReferenceFreq ,
cBrd . ReferenceFlow * outPath . FlowMeter . NominalFlow ) ;
2015-12-04 16:17:20 +00:00
for ( int i = 0 ; i < Config . Data . CompoundWMsCount * 2 ; i + + )
2014-07-28 07:54:35 +00:00
{
logstr + = string . Format ( " M{0}=({1},{2})" , i + 1 , WMRefPulses [ i ] , WMPulses [ i ] ) ;
}
2015-01-15 02:01:32 +00:00
log . Debug ( logstr ) ;
2014-07-28 07:54:35 +00:00
2014-08-01 06:36:17 +00:00
float progress = Formulas . TestProgress ( cBrd . EtPulses ( 0 ) , totalPulses , estFlowSetTime , test . TstTime ) ;
2016-01-03 01:05:35 +00:00
TestProgressEventArgs data = GetTestProgressData ( test , repetitionNr , true , cBrd , cBrd . TTime , progress ) ;
/// TODO: Reimplement
//for (int i = 0; i < Config.Data.CompoundWMsCount; i++)
//{
// data.TestResult.CombinedMeters[i].VolumeMeter = data.TestResult.Meters[2 * i].VolumeMeter
// + data.TestResult.Meters[2 * i + 1].VolumeMeter;
// if (data.Volume.Valid)
// {
// data.TestResult.CombinedMeters[i].VolumeErrorPct =
// Formulas.ErrorFromVolumes(data.TestResult.CombinedMeters[i].VolumeMeter, data.Volume.Val);
// }
//}
2014-07-28 07:54:35 +00:00
Bridge . OnTestProgress ( this , data ) ;
}
/// Measurement loop - end
measurement_completed :
//------------------------------------------------
Bridge . OnActivity ( this , Strings . Measuring_the_weight ) ;
//------------------------------------------------
State . Create ( Strings . Measure_the_mass )
. AddOperation ( checkUiOp )
2014-07-31 20:17:38 +00:00
. AddOperation ( outPath . Balance . ReadStableMassOp ( ref endMass , 5 ) )
2014-07-28 07:54:35 +00:00
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . BalanceDone ) ) ;
///
2016-01-03 01:05:35 +00:00
EndMassRaw = endMass . Val ;
TestEndTime = DateTime . Now ;
2014-07-28 07:54:35 +00:00
//------------------------------------------------
Bridge . OnActivity ( this , Strings . Test_completed ) ;
//------------------------------------------------
State . Create ( Strings . Stop_the_pump )
. AddOperation ( checkUiOp )
2014-09-08 11:16:31 +00:00
. AddOperation ( ( inPath ! = null & & inPath . Pump is GenericDevices . IPumpFM ) ? ( inPath . Pump as GenericDevices . IPumpFM ) . TurnOffOp ( ) : null )
2014-07-28 07:54:35 +00:00
. AddOperation ( cBrd . SetValvesOp ( null , inPath . Pump ) )
. AddOperation ( cBrd . UpdateTankWeightOp ( ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . ValvesSet ) ) ;
//--------------------------------
State . Create ( "stop_diverter_gate_etc" )
. AddOperation ( checkUiOp )
. AddOperation ( cBrd . StopPreviousOp ( ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
2015-04-28 13:27:47 +00:00
if ( e . Contains ( Event . UiCmdStop ) ) goto stopTest ;
2014-07-28 07:54:35 +00:00
}
while ( ! e . Contains ( Event . PreviousStopped ) ) ;
2016-01-03 01:05:35 +00:00
/// Make sure the CycleBeginForm is closed so that water meter data (s/n) can be copied into results
2015-06-25 02:45:04 +00:00
if ( UIFlowControl . Stop = = WaitBeginFormClosed ( ) ) goto stopTest ;
2015-01-15 05:34:36 +00:00
2014-07-28 07:54:35 +00:00
///
2015-01-15 05:34:36 +00:00
/// Populate TestResult data entity with data
2014-07-28 07:54:35 +00:00
///
2016-01-03 01:05:35 +00:00
Results . Entities . TestRslt tstRslt = BatchRslts . GetTestRslt ( testName , test . Part ) ;
2015-02-02 17:09:05 +00:00
2016-01-03 01:05:35 +00:00
if ( tstRslt ! = null )
2014-07-28 07:54:35 +00:00
{
2016-01-03 01:05:35 +00:00
/// Auxiliary results
tstRslt . AmbientTempAve = AmbientTempStat . Average ;
tstRslt . AmbientPressAve = AmbientPressureStat . Average ;
tstRslt . AmbientHumiAve = AmbientHumidityStat . Average ;
tstRslt . PressUpAvrg = PressureUpStat . Average ;
tstRslt . PressUpStart = PressureUpStat . First ;
tstRslt . PressUpEnd = PressureUpStat . Last ;
tstRslt . PressUpMin = PressureUpStat . Min ;
tstRslt . PressUpMax = PressureUpStat . Max ;
tstRslt . PressDownAvrg = PressureDownStat . Average ;
tstRslt . PressDownStart = PressureDownStat . First ;
tstRslt . PressDownEnd = PressureDownStat . Last ;
tstRslt . PressDownMin = PressureDownStat . Min ;
tstRslt . PressDownMax = PressureDownStat . Max ;
tstRslt . TempInAvrg = TempInStat . Average ;
tstRslt . TempInStart = TempInStat . First ;
tstRslt . TempInEnd = TempInStat . Last ;
tstRslt . TempInMin = TempInStat . Min ;
tstRslt . TempInMax = TempInStat . Max ;
tstRslt . TempOutAvrg = TempOutStat . Average ;
tstRslt . TempOutStart = TempOutStat . First ;
tstRslt . TempOutEnd = TempOutStat . Last ;
tstRslt . TempOutMin = TempOutStat . Min ;
tstRslt . TempOutMax = TempOutStat . Max ;
tstRslt . TempDivAvrg = TempDivStat . Average ;
tstRslt . TempDivStart = TempDivStat . First ;
tstRslt . TempDivEnd = TempDivStat . Last ;
tstRslt . TempDivMin = TempDivStat . Min ;
tstRslt . TempDivMax = TempDivStat . Max ;
tstRslt . DensityIn = Formulas . WaterDensityFromTemp ( tstRslt . TempInAvrg ) ; /// [kg/m3]
tstRslt . DensityOut = Formulas . WaterDensityFromTemp ( tstRslt . TempOutAvrg ) ; /// [kg/m3]
tstRslt . DensityDiv = Formulas . WaterDensityFromTemp ( tstRslt . TempDivAvrg ) ; /// [kg/m3]
/// Main results
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 . MassStartRaw = startMass . Val ;
tstRslt . MassStart = Formulas . CorrectedValue ( tstRslt . MassStartRaw , outPath . Balance . Corrections ) ;
tstRslt . MassEndRaw = endMass . Val ;
tstRslt . MassEnd = Formulas . CorrectedValue ( tstRslt . MassEndRaw , outPath . Balance . Corrections ) ;
tstRslt . FlowMass = 3600.0 * ( tstRslt . MassEnd - tstRslt . MassStart ) / tstRslt . TestTime ; /// [kg/h]
tstRslt . FlowVolume = 3.6 * ltrPerRefPulse * cBrd . EtPulses ( 0 ) / tstRslt . TestTime ; /// [m3/h]
tstRslt . VolumeCTV = 1001.03 * ( tstRslt . MassEnd - tstRslt . MassStart ) / tstRslt . DensityOut ; /// [l] 1000.0f is because density is in [kg/m3]
tstRslt . VolumeMaster = ltrPerRefPulse * tstRslt . PulsesMaster ; /// [l] volume from the master flow meter
tstRslt . ConstMaster = ltrPerRefPulse * tstRslt . VolumeCTV / tstRslt . VolumeMaster ; /// Corrected master pulses per liter
tstRslt . ErrorMaster = Formulas . ErrorFromVolumes ( tstRslt . VolumeMaster , tstRslt . VolumeCTV ) ;
for ( int i = 0 ; i < BatchRslts . WMPositionsCount ; i + + )
2014-07-28 07:54:35 +00:00
{
2016-01-03 01:05:35 +00:00
Results . Entities . MeterTestRslt mainMeterRslt = BatchRslts . GetMeterTestRslt ( testName , i , Config . Entities . CompoundMeterId . CompoundMain ) ;
Results . Entities . MeterTestRslt auxMeterRslt = BatchRslts . GetMeterTestRslt ( testName , i , Config . Entities . CompoundMeterId . CompoundAux ) ;
for ( int isAux = 0 ; isAux < = 1 ; isAux + + ) /// 0=main, 1=aux
2014-07-28 07:54:35 +00:00
{
2016-01-03 01:05:35 +00:00
GenericDevices . IRegisterReader regReader = sensPath . RegisterReaders [ 2 * i + isAux ] ;
Results . Entities . MeterTestRslt meterRslt = ( isAux = = 0 ) ? mainMeterRslt : auxMeterRslt ;
if ( meterRslt ! = null & & regReader ! = null )
{
meterRslt . PulsesPerLiter = regReader . PulsesPerLtr ;
2014-07-28 07:54:35 +00:00
2016-01-03 01:05:35 +00:00
/// Optionally supress pulses from the large water meter
meterRslt . PulsesMeter = ( isAux = = 0 & & testParams . SupressTrills ) ? 0 : Convert . ToDouble ( WMPulses [ 2 * i + isAux ] ) ;
2014-07-28 07:54:35 +00:00
2016-01-03 01:05:35 +00:00
meterRslt . PulsesMaster = Convert . ToDouble ( WMRefPulses [ 2 * i + isAux ] ) ;
meterRslt . TestTime = cBrd . TTime ;
meterRslt . VolumeStart = 0 ;
meterRslt . VolumeEnd = 0 ;
meterRslt . VolumeRef = tstRslt . VolumeCTV ;
2014-07-28 07:54:35 +00:00
2016-01-03 01:05:35 +00:00
meterRslt . VolumeMeter = ( regReader . PulsesPerLtr < = float . Epsilon )
? 0 : meterRslt . PulsesMeter / meterRslt . PulsesPerLiter ;
2014-07-28 07:54:35 +00:00
2016-01-03 01:05:35 +00:00
if ( meterRslt . PulsesMaster ! = 0 )
{
meterRslt . VolumeMeter * = ( tstRslt . PulsesMaster / meterRslt . PulsesMaster ) ;
}
meterRslt . Error = Formulas . ErrorFromVolumes ( meterRslt . VolumeMeter , tstRslt . VolumeCTV ) ; /// Main/Aux meter error is not usedfor evaluation
}
}
Results . Entities . MeterTestRslt compoundMeterRslt = BatchRslts . GetMeterTestRslt ( testName , i , Config . Entities . CompoundMeterId . Compound ) ;
if ( compoundMeterRslt ! = null & & mainMeterRslt ! = null & & auxMeterRslt ! = null )
{
compoundMeterRslt . VolumeRef = tstRslt . VolumeCTV ;
compoundMeterRslt . VolumeMeter = mainMeterRslt . VolumeMeter + auxMeterRslt . VolumeMeter ;
compoundMeterRslt . PulsesMaster = tstRslt . PulsesMaster ;
compoundMeterRslt . TestTime = tstRslt . TestTime ;
compoundMeterRslt . Error = Formulas . ErrorFromVolumes ( compoundMeterRslt . VolumeMeter , compoundMeterRslt . VolumeRef ) ;
compoundMeterRslt . Passed = ( compoundMeterRslt . Error > = test . ErrLimLo + test . Uncertainty )
& & ( compoundMeterRslt . Error < = test . ErrLimHi - test . Uncertainty ) ;
mainMeterRslt . Passed = auxMeterRslt . Passed = compoundMeterRslt . Passed ;
mainMeterRslt . TestDone = auxMeterRslt . TestDone = compoundMeterRslt . TestDone = true ;
if ( Qrise ! = 0 ) BatchRslts . WaterMeters [ i ] . QRise = Qrise ;
if ( Qfall ! = 0 ) BatchRslts . WaterMeters [ i ] . QFall = Qfall ;
}
}
2014-07-28 07:54:35 +00:00
}
/// Add data - end
2016-01-03 01:05:35 +00:00
Bridge . OnTestCompleted ( this , new TestCompletedEventArgs ( testName ) ) ;
2014-07-28 07:54:35 +00:00
/// Append the results to the CSV-file
2016-01-03 01:05:35 +00:00
allResults . Info ( TestResult2CsvLine ( testName , test . Part ) ) ;
2014-07-28 07:54:35 +00:00
if ( + + repetitionNr < = test . Repeats )
{
goto loop ;
}
///----------------------///
/// Quit this sequence ///
///----------------------///
/// Stop the pump
State . Create ( "CombinedWithDetection : Test(s) completed -> Stopping the pump" )
. AddOperation ( checkUiOp )
. AddOperation ( cBrd . SetValvesOp ( null , inPath . Pump ) )
2014-09-08 11:16:31 +00:00
. AddOperation ( ( inPath ! = null & & inPath . Pump is GenericDevices . IPumpFM ) ? ( inPath . Pump as GenericDevices . IPumpFM ) . TurnOffOp ( ) : null )
2014-07-28 07:54:35 +00:00
. EnterState ( ) ;
do {
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
}
while ( ! e . Contains ( Event . ValvesSet ) | | ( ( inPath . Pump is GenericDevices . IPumpFM ) & & ! e . Contains ( Event . TurnPumpOnOffDone ) ) ) ;
/// Transition or SetRoute - End
2015-05-22 08:29:56 +00:00
switch ( Transition ( transitionAfter , TransitionContext . AfterTest ) )
2014-07-28 07:54:35 +00:00
{
2014-08-14 07:05:40 +00:00
case Event . Error : goto error ;
2015-04-28 13:27:47 +00:00
case Event . UiCmdStop : goto stopTest ;
2014-07-28 07:54:35 +00:00
}
/// Create the return value - a list with one event Event.Done - and return
2015-02-02 22:18:28 +00:00
IList < Event > retval1 = new List < Event > ( 1 ) ;
retval1 . Add ( Event . Done ) ;
return retval1 ;
2014-07-28 07:54:35 +00:00
//====================================
2015-04-28 13:27:47 +00:00
stopTest :
2014-07-28 07:54:35 +00:00
State . Create ( "CombinedWithDetection : User selected STOP -> Closing the valves" )
. AddOperation ( checkUiOp )
2014-09-08 11:16:31 +00:00
. AddOperation ( ( inPath ! = null & & inPath . Pump is GenericDevices . IPumpFM ) ? ( inPath . Pump as GenericDevices . IPumpFM ) . TurnOffOp ( ) : null )
2014-07-28 07:54:35 +00:00
. AddOperation ( cBrd . SetValvesOp ( StateMachine . DefaultValvesOpen , StateMachine . DefaultValvesClose ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
}
while ( ! e . Contains ( Event . ValvesSet ) ) ;
2015-02-02 22:18:28 +00:00
IList < Event > retval2 = new List < Event > ( 1 ) ;
2014-07-28 07:54:35 +00:00
retval2 . Add ( Event . UiCmdStop ) ;
return retval2 ;
//====================================
error :
State . Create ( "close_before_error" )
. AddOperation ( checkUiOp )
2014-09-08 11:16:31 +00:00
. AddOperation ( ( inPath ! = null & & inPath . Pump is GenericDevices . IPumpFM ) ? ( inPath . Pump as GenericDevices . IPumpFM ) . TurnOffOp ( ) : null )
2014-07-28 07:54:35 +00:00
. AddOperation ( cBrd . SetValvesOp ( StateMachine . DefaultValvesOpen , StateMachine . DefaultValvesClose ) )
. EnterState ( ) ;
do
{
e = StateMachine . WaitRunDevsRunOps ( ) ;
if ( e . Contains ( Event . Error ) ) goto error ;
}
while ( ! e . Contains ( Event . ValvesSet ) ) ;
2015-02-02 22:18:28 +00:00
IList < Event > retval3 = new List < Event > ( 1 ) ;
2014-07-28 07:54:35 +00:00
retval3 . Add ( Event . Error ) ;
return retval3 ;
}
}
}