Fix port addressing for joystick analog read
This commit is contained in:
parent
b030c45705
commit
d88bdc6a1b
3 changed files with 12 additions and 31 deletions
|
@ -46,7 +46,6 @@ int16_t analogRead(uint8_t pin) {
|
|||
#endif
|
||||
}
|
||||
|
||||
<<<<<<< HEAD
|
||||
int16_t analogReadPin(pin_t pin) { return adc_read(pinToMux(pin)); }
|
||||
|
||||
uint8_t pinToMux(pin_t pin) {
|
||||
|
@ -95,36 +94,13 @@ uint8_t pinToMux(pin_t pin) {
|
|||
case C5: return _BV(MUX2) | _BV(MUX0); // ADC5
|
||||
// ADC7:6 not present in DIP package and not shared by GPIO pins
|
||||
default: return _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // 0V
|
||||
=======
|
||||
// Mux input
|
||||
int16_t adc_read(uint8_t mux)
|
||||
{
|
||||
#if defined(__AVR_AT90USB162__)
|
||||
return 0;
|
||||
#else
|
||||
uint16_t res = 0;
|
||||
|
||||
ADCSRA = (1<<ADEN) | ADC_PRESCALER; // enable ADC
|
||||
|
||||
#ifndef __AVR_ATmega32A__
|
||||
ADCSRB = (1<<ADHSM) | (mux & 0x20); // high speed mode
|
||||
#endif
|
||||
ADMUX = aref | (mux & 0x1F); // configure mux input
|
||||
ADCSRA |= (1<<ADSC); // start the conversion
|
||||
while (ADCSRA & (1<<ADSC)) ; // wait for result
|
||||
res = ADCL; // must read LSB first
|
||||
res |= (ADCH << 8) | res;
|
||||
|
||||
ADCSRA &= ~(1<<ADEN);//turn off the ADC
|
||||
return res;
|
||||
>>>>>>> 5939a4430... Add save and restore of each pin used in reading joystick (AVR).
|
||||
#endif
|
||||
// clang-format on
|
||||
}
|
||||
}
|
||||
|
||||
int16_t adc_read(uint8_t mux) {
|
||||
uint8_t low;
|
||||
uint16_t low;
|
||||
|
||||
// Enable ADC and configure prescaler
|
||||
ADCSRA = _BV(ADEN) | ADC_PRESCALER;
|
||||
|
@ -152,5 +128,10 @@ int16_t adc_read(uint8_t mux) {
|
|||
// Must read LSB first
|
||||
low = ADCL;
|
||||
// Must read MSB only once!
|
||||
return (ADCH << 8) | low;
|
||||
low |= (ADCH << 8);
|
||||
|
||||
//turn off the ADC
|
||||
ADCSRA &= ~(1<<ADEN);
|
||||
|
||||
return low;
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue