diff --git a/src/main/fc/fc_msp.c b/src/main/fc/fc_msp.c
index 7b0bedf0aa..8c8166ce53 100755
--- a/src/main/fc/fc_msp.c
+++ b/src/main/fc/fc_msp.c
@@ -1883,9 +1883,9 @@ static bool processInCommand(uint8_t cmdMSP)
             currentProfile->pidProfile.dterm_notch_hz = read16();
             currentProfile->pidProfile.dterm_notch_cutoff = read16();
         }
-        if (dataSize > 13) {
-            serialize16(masterConfig.gyro_soft_notch_hz_2);
-            serialize16(masterConfig.gyro_soft_notch_cutoff_2);
+        if (currentPort->dataSize > 13) {
+            masterConfig.gyro_soft_notch_hz_2 = read16();
+            masterConfig.gyro_soft_notch_cutoff_2 = read16();
         }
         break;
     case MSP_SET_PID_ADVANCED: