Vtx_power_level_adjustment via switch

iNavFlight · May 21, 2019 · 70e7aee · 70e7aee
1 parent 73846d5
commit 70e7aee
Show file tree

Hide file tree

Showing 2 changed files with 11 additions and 1 deletion.
diff --git a/src/main/fc/rc_adjustments.c b/src/main/fc/rc_adjustments.c
@@ -33,6 +33,7 @@
 #include "config/parameter_group_ids.h"
 
 #include "drivers/time.h"
+#include "drivers/vtx_common.h"
 
 #include "fc/config.h"
 #include "fc/controlrate_profile.h"
@@ -45,6 +46,7 @@
 #include "flight/pid.h"
 
 #include "io/beeper.h"
+#include "io/vtx.h"
 
 #include "sensors/boardalignment.h"
 
@@ -262,6 +264,10 @@ static const adjustmentConfig_t defaultAdjustmentConfigs[ADJUSTMENT_FUNCTION_COU
         .adjustmentFunction = ADJUSTMENT_FW_MIN_THROTTLE_DOWN_PITCH_ANGLE,
         .mode = ADJUSTMENT_MODE_STEP,
         .data = { .stepConfig = { .step = 5 }}
+	}, {
+		.adjustmentFunction = ADJUSTMENT_VTX_POWER_LEVEL,
+		.mode = ADJUSTMENT_MODE_STEP,
+		.data = { .stepConfig = { .step = 1 }}  
 #ifdef USE_INFLIGHT_PROFILE_ADJUSTMENT
     }, {
         .adjustmentFunction = ADJUSTMENT_PROFILE,
@@ -542,6 +548,9 @@ static void applyStepAdjustment(controlRateConfig_t *controlRateConfig, uint8_t
         case ADJUSTMENT_FW_MIN_THROTTLE_DOWN_PITCH_ANGLE:
             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);
+			break;
         default:
             break;
     };

diff --git a/src/main/fc/rc_adjustments.h b/src/main/fc/rc_adjustments.h
@@ -74,8 +74,9 @@ typedef enum {
     ADJUSTMENT_VEL_Z_I                  = 46,
     ADJUSTMENT_VEL_Z_D                  = 47,
     ADJUSTMENT_FW_MIN_THROTTLE_DOWN_PITCH_ANGLE = 48,
+    ADJUSTMENT_VTX_POWER_LEVEL = 49,
 #ifdef USE_INFLIGHT_PROFILE_ADJUSTMENT
-    ADJUSTMENT_PROFILE                  = 49,
+    ADJUSTMENT_PROFILE                  = 50,
 #endif
     ADJUSTMENT_FUNCTION_COUNT // must be last
 } adjustmentFunction_e;