Fix ReadADC channel selection

pull/269/head
Alex Voinea 2023-03-05 12:07:57 +01:00 committed by DRracer
parent 8b55b25028
commit 372c65ef1d
1 changed files with 2 additions and 2 deletions

View File

@ -14,12 +14,12 @@ void Init() {
uint16_t ReadADC(uint8_t channel) { uint16_t ReadADC(uint8_t channel) {
uint8_t admux = ADMUX; uint8_t admux = ADMUX;
admux &= ~0x1F; admux &= ~0x1F;
admux |= channel & 0x07; admux |= channel & 0x1F;
ADMUX = admux; ADMUX = admux;
uint8_t adcsrb = ADCSRB; uint8_t adcsrb = ADCSRB;
adcsrb &= ~(1 << MUX5); adcsrb &= ~(1 << MUX5);
adcsrb |= (channel & 0x08) << 1; adcsrb |= channel & 0x20;
ADCSRB = adcsrb; ADCSRB = adcsrb;
ADCSRA |= (1 << ADSC); ADCSRA |= (1 << ADSC);