Index: firmware/App/Modes/FPModes/FPOperationModes.c
===================================================================
diff -u -r886964fa2bf6a5bb61b33b8b5547f3d0c585b360 -rbf22769adf33cbf6bcd26bf01992234b082a38a1
--- firmware/App/Modes/FPModes/FPOperationModes.c	(.../FPOperationModes.c)	(revision 886964fa2bf6a5bb61b33b8b5547f3d0c585b360)
+++ firmware/App/Modes/FPModes/FPOperationModes.c	(.../FPOperationModes.c)	(revision bf22769adf33cbf6bcd26bf01992234b082a38a1)
@@ -586,7 +586,7 @@
                     testChangeSubMode = TRUE;
                 }
                 // request submode change only as the requested operation mode is current mode and requested sub mode is not current sub mode
-                else if ( currentSubMode != testRequestedSubMode )
+                else if ( currentSubMode != reqSubMode )
                 {
                     testRequestedSubMode = reqSubMode;
                     testChangeSubMode = TRUE;