diff --git a/EnduranceTestBench/nehemis/processBoard.c b/EnduranceTestBench/nehemis/processBoard.c
index 7546bdb..dce81a0 100644
--- a/EnduranceTestBench/nehemis/processBoard.c
+++ b/EnduranceTestBench/nehemis/processBoard.c
@@ -179,7 +179,7 @@ void ProcessBoardRun(void)
 static void ProcessBoardGrundfosPumpHandler(void)
 {
     static uint32 pmpSpeed_u32    = 0uL;
-    static uint8 speed_u8         = 0u;
+    static uint8 speed_u8         = PU_PUMP_MIN_SPEED;
     static uint64 startTime_u64   = 0uLL;
     uint64 currentTimeMs_u64;
 
@@ -203,7 +203,7 @@ static void ProcessBoardGrundfosPumpHandler(void)
     	        speed_u8 -= 2u;
     	    }
     	}
-    	else if (speed_u8 < PU_PUMP_MAX_SPEED)
+    	else if (speed_u8 <= PU_PUMP_MAX_SPEED)
         {
             speed_u8 += 2u;
         }
@@ -212,11 +212,11 @@ static void ProcessBoardGrundfosPumpHandler(void)
             speed_u8 = PU_PUMP_MIN_SPEED;
         }
 
-        GrundfosPmpSetSpeed(speed_u8);
-
         startTime_u64 = currentTimeMs_u64;
     }
 
+    GrundfosPmpSetSpeed(speed_u8);
+
     /* Grundfos Pump feedback speed OUT */
     pmpSpeed_u32 = GrundfosPmpFeedback(PMP_ADC_CHANNEL);