Fix ADJUSTMENT_VTX_POWER_LEVEL

iNavFlight · May 24, 2019 · 716b731 · 716b731
1 parent cf873ce
commit 716b731
Showing 1 changed file with 7 additions and 2 deletions.
diff --git a/src/main/fc/rc_adjustments.c b/src/main/fc/rc_adjustments.c
@@ -267,7 +267,7 @@ static const adjustmentConfig_t defaultAdjustmentConfigs[ADJUSTMENT_FUNCTION_COU
     }, {
         .adjustmentFunction = ADJUSTMENT_VTX_POWER_LEVEL,
         .mode = ADJUSTMENT_MODE_STEP,
-        .data = { .stepConfig = { .step = 1 }}  
+        .data = { .stepConfig = { .step = 1 }}
 #ifdef USE_INFLIGHT_PROFILE_ADJUSTMENT
     }, {
         .adjustmentFunction = ADJUSTMENT_PROFILE,
@@ -549,7 +549,12 @@ static void applyStepAdjustment(controlRateConfig_t *controlRateConfig, uint8_t
             applyAdjustmentU16(ADJUSTMENT_FW_MIN_THROTTLE_DOWN_PITCH_ANGLE, &mixerConfigMutable()->fwMinThrottleDownPitchAngle, delta, 0, FW_MIN_THROTTLE_DOWN_PITCH_ANGLE_MAX);
             break;
         case ADJUSTMENT_VTX_POWER_LEVEL:
-            applyAdjustmentU8(ADJUSTMENT_VTX_POWER_LEVEL, &vtxSettingsConfigMutable()->power, delta, VTX_SETTINGS_MIN_POWER, VTX_SETTINGS_MAX_POWER);
+            {
+                vtxDeviceCapability_t vtxDeviceCapability;
+                if (vtxCommonGetDeviceCapability(vtxCommonDevice(), &vtxDeviceCapability)) {
+                    applyAdjustmentU8(ADJUSTMENT_VTX_POWER_LEVEL, &vtxSettingsConfigMutable()->power, delta, VTX_SETTINGS_MIN_POWER, vtxDeviceCapability.powerCount);
+                }
+            }
             break;
         default:
             break;