From 372c65ef1dc63beb25b5a5c4ebe15128912e8bad Mon Sep 17 00:00:00 2001
From: Alex Voinea <voinea.dragos.alexandru@gmail.com>
Date: Sun, 5 Mar 2023 12:07:57 +0100
Subject: [PATCH] Fix ReadADC channel selection

---
 src/hal/adc.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/hal/adc.cpp b/src/hal/adc.cpp
index 2f2f313..e05354c 100644
--- a/src/hal/adc.cpp
+++ b/src/hal/adc.cpp
@@ -14,12 +14,12 @@ void Init() {
 uint16_t ReadADC(uint8_t channel) {
     uint8_t admux = ADMUX;
     admux &= ~0x1F;
-    admux |= channel & 0x07;
+    admux |= channel & 0x1F;
     ADMUX = admux;
 
     uint8_t adcsrb = ADCSRB;
     adcsrb &= ~(1 << MUX5);
-    adcsrb |= (channel & 0x08) << 1;
+    adcsrb |= channel & 0x20;
     ADCSRB = adcsrb;
 
     ADCSRA |= (1 << ADSC);