Fix ReadADC channel selection
parent
8b55b25028
commit
372c65ef1d
|
|
@ -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);
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue