123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115 |
- #include <avr/io.h>
- #include <avr/pgmspace.h>
- #include <stdint.h>
- #include "analog.h"
- static uint8_t aref = ADC_REF_POWER;
- void analogReference(uint8_t mode) { aref = mode & (_BV(REFS1) | _BV(REFS0)); }
- int16_t analogReadPin(pin_t pin) { return adc_read(pinToMux(pin)); }
- uint8_t pinToMux(pin_t pin) {
- switch (pin) {
-
- #if defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
- case F0: return 0;
- case F1: return _BV(MUX0);
- case F2: return _BV(MUX1);
- case F3: return _BV(MUX1) | _BV(MUX0);
- case F4: return _BV(MUX2);
- case F5: return _BV(MUX2) | _BV(MUX0);
- case F6: return _BV(MUX2) | _BV(MUX1);
- case F7: return _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- default: return _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- #elif defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__)
- case F0: return 0;
- case F1: return _BV(MUX0);
- case F4: return _BV(MUX2);
- case F5: return _BV(MUX2) | _BV(MUX0);
- case F6: return _BV(MUX2) | _BV(MUX1);
- case F7: return _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- case D4: return _BV(MUX5);
- case D6: return _BV(MUX5) | _BV(MUX0);
- case D7: return _BV(MUX5) | _BV(MUX1);
- case B4: return _BV(MUX5) | _BV(MUX1) | _BV(MUX0);
- case B5: return _BV(MUX5) | _BV(MUX2);
- case B6: return _BV(MUX5) | _BV(MUX2) | _BV(MUX0);
- default: return _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- #elif defined(__AVR_ATmega32A__)
- case A0: return 0;
- case A1: return _BV(MUX0);
- case A2: return _BV(MUX1);
- case A3: return _BV(MUX1) | _BV(MUX0);
- case A4: return _BV(MUX2);
- case A5: return _BV(MUX2) | _BV(MUX0);
- case A6: return _BV(MUX2) | _BV(MUX1);
- case A7: return _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- default: return _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- #elif defined(__AVR_ATmega328P__) || defined(__AVR_ATmega328__)
- case C0: return 0;
- case C1: return _BV(MUX0);
- case C2: return _BV(MUX1);
- case C3: return _BV(MUX1) | _BV(MUX0);
- case C4: return _BV(MUX2);
- case C5: return _BV(MUX2) | _BV(MUX0);
-
- default: return _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0);
- #endif
-
- }
- return 0;
- }
- int16_t adc_read(uint8_t mux) {
- uint16_t low;
-
- ADCSRA = _BV(ADEN) | ADC_PRESCALER;
- #if defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__)
-
- ADCSRB = _BV(ADHSM) | (mux & _BV(MUX5));
- #elif defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
-
- ADCSRB = _BV(ADHSM);
- #endif
-
- #if defined(MUX4)
- ADMUX = aref | (mux & (_BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0)));
- #else
- ADMUX = aref | (mux & (_BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0)));
- #endif
-
- ADCSRA |= _BV(ADSC);
-
- while (ADCSRA & _BV(ADSC))
- ;
-
- low = ADCL;
-
- low |= (ADCH << 8);
-
- ADCSRA &= ~(1 << ADEN);
- return low;
- }
|