From 68776699e1866b345d1409da3e6148d8956715c4 Mon Sep 17 00:00:00 2001 From: EmanuelFeru Date: Tue, 30 Jun 2020 18:09:37 +0200 Subject: [PATCH] Updated Mid resting poti scaling Issue #74 --- Src/util.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/Src/util.c b/Src/util.c index f9bd78b..50334ee 100644 --- a/Src/util.c +++ b/Src/util.c @@ -705,14 +705,14 @@ void readCommand(void) { // ADC values range: 0-4095, see ADC-calibration in config.h #ifdef ADC1_MID_POT cmd1 = CLAMP((adc_buffer.l_tx2 - ADC1_MID_CAL) * INPUT_MAX / (ADC1_MAX_CAL - ADC1_MID_CAL), 0, INPUT_MAX) - -CLAMP((ADC1_MID_CAL - adc_buffer.l_tx2) * INPUT_MAX / (ADC1_MID_CAL - ADC1_MIN_CAL), 0, INPUT_MAX); // ADC1 + +CLAMP((ADC1_MID_CAL - adc_buffer.l_tx2) * INPUT_MIN / (ADC1_MID_CAL - ADC1_MIN_CAL), INPUT_MIN, 0); // ADC1 #else cmd1 = CLAMP((adc_buffer.l_tx2 - ADC1_MIN_CAL) * INPUT_MAX / (ADC1_MAX_CAL - ADC1_MIN_CAL), 0, INPUT_MAX); // ADC1 #endif #ifdef ADC2_MID_POT cmd2 = CLAMP((adc_buffer.l_rx2 - ADC2_MID_CAL) * INPUT_MAX / (ADC2_MAX_CAL - ADC2_MID_CAL), 0, INPUT_MAX) - -CLAMP((ADC2_MID_CAL - adc_buffer.l_rx2) * INPUT_MAX / (ADC2_MID_CAL - ADC2_MIN_CAL), 0, INPUT_MAX); // ADC2 + +CLAMP((ADC2_MID_CAL - adc_buffer.l_rx2) * INPUT_MIN / (ADC2_MID_CAL - ADC2_MIN_CAL), INPUT_MIN, 0); // ADC2 #else cmd2 = CLAMP((adc_buffer.l_rx2 - ADC2_MIN_CAL) * INPUT_MAX / (ADC2_MAX_CAL - ADC2_MIN_CAL), 0, INPUT_MAX); // ADC2 #endif