analog.c 5.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138
  1. /* Copyright 2015 Jack Humbert
  2. *
  3. * This program is free software: you can redistribute it and/or modify
  4. * it under the terms of the GNU General Public License as published by
  5. * the Free Software Foundation, either version 2 of the License, or
  6. * (at your option) any later version.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  15. */
  16. #include <avr/io.h>
  17. #include <avr/pgmspace.h>
  18. #include <stdint.h>
  19. #include "analog.h"
  20. static uint8_t aref = ADC_REF_POWER;
  21. void analogReference(uint8_t mode) { aref = mode & (_BV(REFS1) | _BV(REFS0)); }
  22. // Arduino compatible pin input
  23. int16_t analogRead(uint8_t pin) {
  24. #if defined(__AVR_ATmega32U4__)
  25. // clang-format off
  26. static const uint8_t PROGMEM pin_to_mux[] = {
  27. //A0 A1 A2 A3 A4 A5
  28. //F7 F6 F5 F4 F1 F0
  29. 0x07, 0x06, 0x05, 0x04, 0x01, 0x00,
  30. //A6 A7 A8 A9 A10 A11
  31. //D4 D7 B4 B5 B6 D6
  32. 0x20, 0x22, 0x23, 0x24, 0x25, 0x21
  33. };
  34. // clang-format on
  35. if (pin >= 12) return 0;
  36. return adc_read(pgm_read_byte(pin_to_mux + pin));
  37. #elif defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__) || defined(__AVR_ATmega328P__) || defined(__AVR_ATmega328__)
  38. if (pin >= 8) return 0;
  39. return adc_read(pin);
  40. #else
  41. return 0;
  42. #endif
  43. }
  44. int16_t analogReadPin(pin_t pin) { return adc_read(pinToMux(pin)); }
  45. uint8_t pinToMux(pin_t pin) {
  46. switch (pin) {
  47. // clang-format off
  48. #if defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
  49. case F0: return 0; // ADC0
  50. case F1: return _BV(MUX0); // ADC1
  51. case F2: return _BV(MUX1); // ADC2
  52. case F3: return _BV(MUX1) | _BV(MUX0); // ADC3
  53. case F4: return _BV(MUX2); // ADC4
  54. case F5: return _BV(MUX2) | _BV(MUX0); // ADC5
  55. case F6: return _BV(MUX2) | _BV(MUX1); // ADC6
  56. case F7: return _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // ADC7
  57. default: return _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // 0V
  58. #elif defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__)
  59. case F0: return 0; // ADC0
  60. case F1: return _BV(MUX0); // ADC1
  61. case F4: return _BV(MUX2); // ADC4
  62. case F5: return _BV(MUX2) | _BV(MUX0); // ADC5
  63. case F6: return _BV(MUX2) | _BV(MUX1); // ADC6
  64. case F7: return _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // ADC7
  65. case D4: return _BV(MUX5); // ADC8
  66. case D6: return _BV(MUX5) | _BV(MUX0); // ADC9
  67. case D7: return _BV(MUX5) | _BV(MUX1); // ADC10
  68. case B4: return _BV(MUX5) | _BV(MUX1) | _BV(MUX0); // ADC11
  69. case B5: return _BV(MUX5) | _BV(MUX2); // ADC12
  70. case B6: return _BV(MUX5) | _BV(MUX2) | _BV(MUX0); // ADC13
  71. default: return _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // 0V
  72. #elif defined(__AVR_ATmega32A__)
  73. case A0: return 0; // ADC0
  74. case A1: return _BV(MUX0); // ADC1
  75. case A2: return _BV(MUX1); // ADC2
  76. case A3: return _BV(MUX1) | _BV(MUX0); // ADC3
  77. case A4: return _BV(MUX2); // ADC4
  78. case A5: return _BV(MUX2) | _BV(MUX0); // ADC5
  79. case A6: return _BV(MUX2) | _BV(MUX1); // ADC6
  80. case A7: return _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // ADC7
  81. default: return _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // 0V
  82. #elif defined(__AVR_ATmega328P__) || defined(__AVR_ATmega328__)
  83. case C0: return 0; // ADC0
  84. case C1: return _BV(MUX0); // ADC1
  85. case C2: return _BV(MUX1); // ADC2
  86. case C3: return _BV(MUX1) | _BV(MUX0); // ADC3
  87. case C4: return _BV(MUX2); // ADC4
  88. case C5: return _BV(MUX2) | _BV(MUX0); // ADC5
  89. // ADC7:6 not present in DIP package and not shared by GPIO pins
  90. default: return _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0); // 0V
  91. #endif
  92. // clang-format on
  93. }
  94. return 0;
  95. }
  96. int16_t adc_read(uint8_t mux) {
  97. uint16_t low;
  98. // Enable ADC and configure prescaler
  99. ADCSRA = _BV(ADEN) | ADC_PRESCALER;
  100. #if defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__)
  101. // High speed mode and ADC8-13
  102. ADCSRB = _BV(ADHSM) | (mux & _BV(MUX5));
  103. #elif defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
  104. // High speed mode only
  105. ADCSRB = _BV(ADHSM);
  106. #endif
  107. // Configure mux input
  108. #if defined(MUX4)
  109. ADMUX = aref | (mux & (_BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0)));
  110. #else
  111. ADMUX = aref | (mux & (_BV(MUX3) | _BV(MUX2) | _BV(MUX1) | _BV(MUX0)));
  112. #endif
  113. // Start the conversion
  114. ADCSRA |= _BV(ADSC);
  115. // Wait for result
  116. while (ADCSRA & _BV(ADSC))
  117. ;
  118. // Must read LSB first
  119. low = ADCL;
  120. // Must read MSB only once!
  121. low |= (ADCH << 8);
  122. // turn off the ADC
  123. ADCSRA &= ~(1 << ADEN);
  124. return low;
  125. }