Index: firmware/App/Modes/ModePreTreat.c
===================================================================
diff -u -rd558c3058a027d8f4407c7bb882505e30225a7f9 -rb36fc8801adfc9d2f402450abffe721e71f9a5e5
--- firmware/App/Modes/ModePreTreat.c	(.../ModePreTreat.c)	(revision d558c3058a027d8f4407c7bb882505e30225a7f9)
+++ firmware/App/Modes/ModePreTreat.c	(.../ModePreTreat.c)	(revision b36fc8801adfc9d2f402450abffe721e71f9a5e5)
@@ -7,8 +7,8 @@
 *
 * @file    ModePreTreat.c
 *
-* @author  (last)      Sean Nash
-* @date    (last)      26-Apr-2022
+* @author  (last)      Dara Navaei
+* @date    (last)      16-Jun-2022
 *
 * @author  (original)  Dara Navaei
 * @date    (original)  05-Nov-2019
@@ -1134,7 +1134,7 @@
         }
         else if ( dgCmdResp.rejectCode != DG_CMD_REQUEST_REJECT_REASON_NONE )
         {
-            // TODO - s/w fault
+            SET_ALARM_WITH_2_U32_DATA( ALARM_ID_HD_SOFTWARE_FAULT, SW_FAULT_ID_DG_INVALID_FILL_COMMAND_REJECTED, dgCmdResp.rejectCode )
         }
     }
 
@@ -1171,10 +1171,13 @@
                 state = PRE_TREATMENT_RESERVOIR_MGMT_WAIT_FOR_RESERVOIR_SWITCH_STATE;
                 reservoirFilledStatus[ DG_RESERVOIR_1 ] = TRUE;
             }
-            else if ( ( TRUE == reservoirFilledStatus[ DG_RESERVOIR_1 ] ) && ( FALSE == reservoirFilledStatus[ DG_RESERVOIR_2 ] ) )
+            else
             {
-                reservoirFilledStatus[ DG_RESERVOIR_2 ] = TRUE;
-                state = PRE_TREATMENT_RESERVOIR_MGMT_COMPLETE_STATE;
+                if ( FALSE == reservoirFilledStatus[ DG_RESERVOIR_2 ] )
+                {
+                    reservoirFilledStatus[ DG_RESERVOIR_2 ] = TRUE;
+                    state = PRE_TREATMENT_RESERVOIR_MGMT_COMPLETE_STATE;
+                }
             }
         }
         else
@@ -1195,7 +1198,7 @@
                     cmdSetDGActiveReservoir( DG_RESERVOIR_1 );
                 }
             }
-            else if ( ( TRUE == reservoirFlushedStatus[ DG_RESERVOIR_1 ] ) && ( FALSE == reservoirFlushedStatus[ DG_RESERVOIR_2 ] ) )
+            else
             {
                 reservoirFlushedStatus[ DG_RESERVOIR_2 ] = TRUE;
                 cmdSetDGActiveReservoir( DG_RESERVOIR_2 );