analog.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431
  1. /* Copyright 2019 Drew Mills
  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 "analog.h"
  17. #include <ch.h>
  18. #include <hal.h>
  19. #if !HAL_USE_ADC
  20. # error "You need to set HAL_USE_ADC to TRUE in your halconf.h to use the ADC."
  21. #endif
  22. #if !RP_ADC_USE_ADC1 && !STM32_ADC_USE_ADC1 && !STM32_ADC_USE_ADC2 && !STM32_ADC_USE_ADC3 && !STM32_ADC_USE_ADC4 && !WB32_ADC_USE_ADC1 && !AT32_ADC_USE_ADC1
  23. # error "You need to set one of the 'xxx_ADC_USE_ADCx' settings to TRUE in your mcuconf.h to use the ADC."
  24. #endif
  25. #if STM32_ADC_DUAL_MODE
  26. # error "STM32 ADC Dual Mode is not supported at this time."
  27. #endif
  28. #if STM32_ADCV3_OVERSAMPLING
  29. // Apparently all ADCV3 chips that support oversampling (STM32L4xx, STM32L4xx+,
  30. // STM32G4xx, STM32WB[35]x) have errata like “Wrong ADC result if conversion
  31. // done late after calibration or previous conversion”; the workaround is to
  32. // perform a dummy conversion and discard its result. STM32G4xx chips also
  33. // have the “ADC channel 0 converted instead of the required ADC channel”
  34. // errata, one workaround for which is also to perform a dummy conversion.
  35. # define ADC_DUMMY_CONVERSIONS_AT_START 1
  36. #else
  37. # define ADC_DUMMY_CONVERSIONS_AT_START 0
  38. #endif
  39. // Otherwise assume V3
  40. #if defined(STM32F0XX) || defined(STM32L0XX)
  41. # define USE_ADCV1
  42. #elif defined(STM32F1XX) || defined(STM32F2XX) || defined(STM32F4XX) || defined(GD32VF103) || defined(WB32F3G71xx) || defined(WB32FQ95xx) || defined(AT32F415)
  43. # define USE_ADCV2
  44. #endif
  45. // BODGE to make v2 look like v1,3 and 4
  46. #if defined(USE_ADCV2) || defined(RP2040)
  47. # if !defined(ADC_SMPR_SMP_1P5) && defined(ADC_SAMPLE_3)
  48. # define ADC_SMPR_SMP_1P5 ADC_SAMPLE_3
  49. # define ADC_SMPR_SMP_7P5 ADC_SAMPLE_15
  50. # define ADC_SMPR_SMP_13P5 ADC_SAMPLE_28
  51. # define ADC_SMPR_SMP_28P5 ADC_SAMPLE_56
  52. # define ADC_SMPR_SMP_41P5 ADC_SAMPLE_84
  53. # define ADC_SMPR_SMP_55P5 ADC_SAMPLE_112
  54. # define ADC_SMPR_SMP_71P5 ADC_SAMPLE_144
  55. # define ADC_SMPR_SMP_239P5 ADC_SAMPLE_480
  56. # endif
  57. # if !defined(ADC_SMPR_SMP_1P5) && defined(ADC_SAMPLE_1P5)
  58. # define ADC_SMPR_SMP_1P5 ADC_SAMPLE_1P5
  59. # define ADC_SMPR_SMP_7P5 ADC_SAMPLE_7P5
  60. # define ADC_SMPR_SMP_13P5 ADC_SAMPLE_13P5
  61. # define ADC_SMPR_SMP_28P5 ADC_SAMPLE_28P5
  62. # define ADC_SMPR_SMP_41P5 ADC_SAMPLE_41P5
  63. # define ADC_SMPR_SMP_55P5 ADC_SAMPLE_55P5
  64. # define ADC_SMPR_SMP_71P5 ADC_SAMPLE_71P5
  65. # define ADC_SMPR_SMP_239P5 ADC_SAMPLE_239P5
  66. # endif
  67. // we still sample at 12bit, but scale down to the requested bit range
  68. # define ADC_CFGR1_RES_12BIT 12
  69. # define ADC_CFGR1_RES_10BIT 10
  70. # define ADC_CFGR1_RES_8BIT 8
  71. # define ADC_CFGR1_RES_6BIT 6
  72. #endif
  73. /* User configurable ADC options */
  74. #ifndef ADC_COUNT
  75. # if defined(RP2040) || defined(STM32F0XX) || defined(STM32F1XX) || defined(STM32F4XX) || defined(GD32VF103) || defined(WB32F3G71xx) || defined(WB32FQ95xx) || defined(AT32F415)
  76. # define ADC_COUNT 1
  77. # elif defined(STM32F3XX) || defined(STM32G4XX)
  78. # define ADC_COUNT 4
  79. # elif defined(STM32L4XX)
  80. # define ADC_COUNT 3
  81. # else
  82. # error "ADC_COUNT has not been set for this ARM microcontroller."
  83. # endif
  84. #endif
  85. #ifndef ADC_NUM_CHANNELS
  86. # define ADC_NUM_CHANNELS 1
  87. #elif ADC_NUM_CHANNELS != 1
  88. # error "The ARM ADC implementation currently only supports reading one channel at a time."
  89. #endif
  90. // Add dummy conversions as extra channels (this would work only on chips that
  91. // have multiple channel index fields instead of a channel mask, but all chips
  92. // that need that workaround are like that).
  93. #define ADC_TOTAL_CHANNELS (ADC_DUMMY_CONVERSIONS_AT_START + ADC_NUM_CHANNELS)
  94. #ifndef ADC_BUFFER_DEPTH
  95. # define ADC_BUFFER_DEPTH 1
  96. #endif
  97. // For more sampling rate options, look at hal_adc_lld.h in ChibiOS
  98. #if !defined(ADC_SAMPLING_RATE) && !defined(RP2040)
  99. # if defined(ADC_SMPR_SMP_1P5)
  100. # define ADC_SAMPLING_RATE ADC_SMPR_SMP_1P5
  101. # elif defined(ADC_SMPR_SMP_2P5) // STM32L4XX, STM32L4XXP, STM32G4XX, STM32WBXX
  102. # define ADC_SAMPLING_RATE ADC_SMPR_SMP_2P5
  103. # else
  104. # error "Cannot determine the default ADC_SAMPLING_RATE for this MCU."
  105. # endif
  106. #endif
  107. // Options are 12, 10, 8, and 6 bit.
  108. #ifndef ADC_RESOLUTION
  109. # ifdef ADC_CFGR_RES_10BITS // ADCv3, ADCv4
  110. # define ADC_RESOLUTION ADC_CFGR_RES_10BITS
  111. # else // ADCv1, ADCv5, or the bodge for ADCv2 above
  112. # define ADC_RESOLUTION ADC_CFGR1_RES_10BIT
  113. # endif
  114. #endif
  115. static ADCConfig adcCfg = {};
  116. static adcsample_t sampleBuffer[ADC_TOTAL_CHANNELS * ADC_BUFFER_DEPTH];
  117. // Initialize to max number of ADCs, set to empty object to initialize all to false.
  118. static bool adcInitialized[ADC_COUNT] = {};
  119. // TODO: add back TR handling???
  120. static ADCConversionGroup adcConversionGroup = {
  121. .circular = FALSE,
  122. .num_channels = (uint16_t)(ADC_TOTAL_CHANNELS),
  123. #if defined(USE_ADCV1)
  124. .cfgr1 = ADC_CFGR1_CONT | ADC_RESOLUTION,
  125. .smpr = ADC_SAMPLING_RATE,
  126. #elif defined(USE_ADCV2)
  127. # if !defined(STM32F1XX) && !defined(GD32VF103) && !defined(WB32F3G71xx) && !defined(WB32FQ95xx) && !defined(AT32F415)
  128. .cr2 = ADC_CR2_SWSTART, // F103 seem very unhappy with, F401 seems very unhappy without...
  129. # endif
  130. # if defined(AT32F415)
  131. .spt2 = ADC_SPT2_CSPT_AN0(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN1(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN2(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN3(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN4(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN5(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN6(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN7(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN8(ADC_SAMPLING_RATE) | ADC_SPT2_CSPT_AN9(ADC_SAMPLING_RATE),
  132. .spt1 = ADC_SPT1_CSPT_AN10(ADC_SAMPLING_RATE) | ADC_SPT1_CSPT_AN11(ADC_SAMPLING_RATE) | ADC_SPT1_CSPT_AN12(ADC_SAMPLING_RATE) | ADC_SPT1_CSPT_AN13(ADC_SAMPLING_RATE) | ADC_SPT1_CSPT_AN14(ADC_SAMPLING_RATE) | ADC_SPT1_CSPT_AN15(ADC_SAMPLING_RATE),
  133. # else
  134. .smpr2 = ADC_SMPR2_SMP_AN0(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN1(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN2(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN3(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN4(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN5(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN6(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN7(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN8(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN9(ADC_SAMPLING_RATE),
  135. .smpr1 = ADC_SMPR1_SMP_AN10(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN11(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN12(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN13(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN14(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN15(ADC_SAMPLING_RATE),
  136. # endif
  137. #elif defined(RP2040)
  138. // RP2040 does not have any extra config here
  139. #else
  140. .cfgr = ADC_CFGR_CONT | ADC_RESOLUTION,
  141. .smpr = {ADC_SMPR1_SMP_AN0(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN1(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN2(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN3(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN4(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN5(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN6(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN7(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN8(ADC_SAMPLING_RATE) | ADC_SMPR1_SMP_AN9(ADC_SAMPLING_RATE), ADC_SMPR2_SMP_AN10(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN11(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN12(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN13(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN14(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN15(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN16(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN17(ADC_SAMPLING_RATE) | ADC_SMPR2_SMP_AN18(ADC_SAMPLING_RATE)},
  142. #endif
  143. };
  144. // clang-format off
  145. __attribute__((weak)) adc_mux pinToMux(pin_t pin) {
  146. switch (pin) {
  147. #if defined(STM32F0XX)
  148. case A0: return TO_MUX( 0, 0 );
  149. case A1: return TO_MUX( 1, 0 );
  150. case A2: return TO_MUX( 2, 0 );
  151. case A3: return TO_MUX( 3, 0 );
  152. case A4: return TO_MUX( 4, 0 );
  153. case A5: return TO_MUX( 5, 0 );
  154. case A6: return TO_MUX( 6, 0 );
  155. case A7: return TO_MUX( 7, 0 );
  156. case B0: return TO_MUX( 8, 0 );
  157. case B1: return TO_MUX( 9, 0 );
  158. case C0: return TO_MUX( 10, 0 );
  159. case C1: return TO_MUX( 11, 0 );
  160. case C2: return TO_MUX( 12, 0 );
  161. case C3: return TO_MUX( 13, 0 );
  162. case C4: return TO_MUX( 14, 0 );
  163. case C5: return TO_MUX( 15, 0 );
  164. #elif defined(STM32F3XX)
  165. case A0: return TO_MUX( ADC_CHANNEL_IN1, 0 );
  166. case A1: return TO_MUX( ADC_CHANNEL_IN2, 0 );
  167. case A2: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  168. case A3: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  169. case A4: return TO_MUX( ADC_CHANNEL_IN1, 1 );
  170. case A5: return TO_MUX( ADC_CHANNEL_IN2, 1 );
  171. case A6: return TO_MUX( ADC_CHANNEL_IN3, 1 );
  172. case A7: return TO_MUX( ADC_CHANNEL_IN4, 1 );
  173. case B0: return TO_MUX( ADC_CHANNEL_IN12, 2 );
  174. case B1: return TO_MUX( ADC_CHANNEL_IN1, 2 );
  175. case B2: return TO_MUX( ADC_CHANNEL_IN12, 1 );
  176. case B12: return TO_MUX( ADC_CHANNEL_IN3, 3 );
  177. case B13: return TO_MUX( ADC_CHANNEL_IN5, 2 );
  178. case B14: return TO_MUX( ADC_CHANNEL_IN4, 3 );
  179. case B15: return TO_MUX( ADC_CHANNEL_IN5, 3 );
  180. case C0: return TO_MUX( ADC_CHANNEL_IN6, 0 ); // Can also be ADC2
  181. case C1: return TO_MUX( ADC_CHANNEL_IN7, 0 ); // Can also be ADC2
  182. case C2: return TO_MUX( ADC_CHANNEL_IN8, 0 ); // Can also be ADC2
  183. case C3: return TO_MUX( ADC_CHANNEL_IN9, 0 ); // Can also be ADC2
  184. case C4: return TO_MUX( ADC_CHANNEL_IN5, 1 );
  185. case C5: return TO_MUX( ADC_CHANNEL_IN11, 1 );
  186. case D8: return TO_MUX( ADC_CHANNEL_IN12, 3 );
  187. case D9: return TO_MUX( ADC_CHANNEL_IN13, 3 );
  188. case D10: return TO_MUX( ADC_CHANNEL_IN7, 2 ); // Can also be ADC4
  189. case D11: return TO_MUX( ADC_CHANNEL_IN8, 2 ); // Can also be ADC4
  190. case D12: return TO_MUX( ADC_CHANNEL_IN9, 2 ); // Can also be ADC4
  191. case D13: return TO_MUX( ADC_CHANNEL_IN10, 2 ); // Can also be ADC4
  192. case D14: return TO_MUX( ADC_CHANNEL_IN11, 2 ); // Can also be ADC4
  193. case E7: return TO_MUX( ADC_CHANNEL_IN13, 2 );
  194. case E8: return TO_MUX( ADC_CHANNEL_IN6, 2 ); // Can also be ADC4
  195. case E9: return TO_MUX( ADC_CHANNEL_IN2, 2 );
  196. case E10: return TO_MUX( ADC_CHANNEL_IN14, 2 );
  197. case E11: return TO_MUX( ADC_CHANNEL_IN15, 2 );
  198. case E12: return TO_MUX( ADC_CHANNEL_IN16, 2 );
  199. case E13: return TO_MUX( ADC_CHANNEL_IN3, 2 );
  200. case E14: return TO_MUX( ADC_CHANNEL_IN1, 3 );
  201. case E15: return TO_MUX( ADC_CHANNEL_IN2, 3 );
  202. case F2: return TO_MUX( ADC_CHANNEL_IN10, 0 ); // Can also be ADC2
  203. case F4: return TO_MUX( ADC_CHANNEL_IN5, 0 );
  204. #elif defined(STM32F4XX)
  205. case A0: return TO_MUX( ADC_CHANNEL_IN0, 0 );
  206. case A1: return TO_MUX( ADC_CHANNEL_IN1, 0 );
  207. case A2: return TO_MUX( ADC_CHANNEL_IN2, 0 );
  208. case A3: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  209. case A4: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  210. case A5: return TO_MUX( ADC_CHANNEL_IN5, 0 );
  211. case A6: return TO_MUX( ADC_CHANNEL_IN6, 0 );
  212. case A7: return TO_MUX( ADC_CHANNEL_IN7, 0 );
  213. case B0: return TO_MUX( ADC_CHANNEL_IN8, 0 );
  214. case B1: return TO_MUX( ADC_CHANNEL_IN9, 0 );
  215. case C0: return TO_MUX( ADC_CHANNEL_IN10, 0 );
  216. case C1: return TO_MUX( ADC_CHANNEL_IN11, 0 );
  217. case C2: return TO_MUX( ADC_CHANNEL_IN12, 0 );
  218. case C3: return TO_MUX( ADC_CHANNEL_IN13, 0 );
  219. case C4: return TO_MUX( ADC_CHANNEL_IN14, 0 );
  220. case C5: return TO_MUX( ADC_CHANNEL_IN15, 0 );
  221. # if STM32_ADC_USE_ADC3
  222. case F3: return TO_MUX( ADC_CHANNEL_IN9, 2 );
  223. case F4: return TO_MUX( ADC_CHANNEL_IN14, 2 );
  224. case F5: return TO_MUX( ADC_CHANNEL_IN15, 2 );
  225. case F6: return TO_MUX( ADC_CHANNEL_IN4, 2 );
  226. case F7: return TO_MUX( ADC_CHANNEL_IN5, 2 );
  227. case F8: return TO_MUX( ADC_CHANNEL_IN6, 2 );
  228. case F9: return TO_MUX( ADC_CHANNEL_IN7, 2 );
  229. case F10: return TO_MUX( ADC_CHANNEL_IN8, 2 );
  230. # endif
  231. #elif defined(STM32F1XX) || defined(GD32VF103) || defined(WB32F3G71xx) || defined(WB32FQ95xx) || defined(AT32F415)
  232. case A0: return TO_MUX( ADC_CHANNEL_IN0, 0 );
  233. case A1: return TO_MUX( ADC_CHANNEL_IN1, 0 );
  234. case A2: return TO_MUX( ADC_CHANNEL_IN2, 0 );
  235. case A3: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  236. case A4: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  237. case A5: return TO_MUX( ADC_CHANNEL_IN5, 0 );
  238. case A6: return TO_MUX( ADC_CHANNEL_IN6, 0 );
  239. case A7: return TO_MUX( ADC_CHANNEL_IN7, 0 );
  240. case B0: return TO_MUX( ADC_CHANNEL_IN8, 0 );
  241. case B1: return TO_MUX( ADC_CHANNEL_IN9, 0 );
  242. case C0: return TO_MUX( ADC_CHANNEL_IN10, 0 );
  243. case C1: return TO_MUX( ADC_CHANNEL_IN11, 0 );
  244. case C2: return TO_MUX( ADC_CHANNEL_IN12, 0 );
  245. case C3: return TO_MUX( ADC_CHANNEL_IN13, 0 );
  246. case C4: return TO_MUX( ADC_CHANNEL_IN14, 0 );
  247. case C5: return TO_MUX( ADC_CHANNEL_IN15, 0 );
  248. // STM32F103x[C-G] in 144-pin packages also have analog inputs on F6...F10, but they are on ADC3, and the
  249. // ChibiOS ADC driver for STM32F1xx currently supports only ADC1, therefore these pins are not usable.
  250. #elif defined(STM32L4XX)
  251. case A0: return TO_MUX( ADC_CHANNEL_IN5, 0 ); // Can also be ADC2 in some cases
  252. case A1: return TO_MUX( ADC_CHANNEL_IN6, 0 ); // Can also be ADC2 in some cases
  253. case A2: return TO_MUX( ADC_CHANNEL_IN7, 0 ); // Can also be ADC2
  254. case A3: return TO_MUX( ADC_CHANNEL_IN8, 0 ); // Can also be ADC2
  255. case A4: return TO_MUX( ADC_CHANNEL_IN9, 0 ); // Can also be ADC2
  256. case A5: return TO_MUX( ADC_CHANNEL_IN10, 0 ); // Can also be ADC2
  257. case A6: return TO_MUX( ADC_CHANNEL_IN11, 0 ); // Can also be ADC2
  258. case A7: return TO_MUX( ADC_CHANNEL_IN12, 0 ); // Can also be ADC2
  259. case B0: return TO_MUX( ADC_CHANNEL_IN15, 0 ); // Can also be ADC2
  260. case B1: return TO_MUX( ADC_CHANNEL_IN16, 0 ); // Can also be ADC2
  261. case C0: return TO_MUX( ADC_CHANNEL_IN1, 0 ); // Can also be ADC2 or ADC3
  262. case C1: return TO_MUX( ADC_CHANNEL_IN2, 0 ); // Can also be ADC2 or ADC3
  263. case C2: return TO_MUX( ADC_CHANNEL_IN3, 0 ); // Can also be ADC2 or ADC3
  264. case C3: return TO_MUX( ADC_CHANNEL_IN4, 0 ); // Can also be ADC2 or ADC3
  265. case C4: return TO_MUX( ADC_CHANNEL_IN13, 0 ); // Can also be ADC2
  266. case C5: return TO_MUX( ADC_CHANNEL_IN14, 0 ); // Can also be ADC2
  267. # if STM32_HAS_GPIOF && STM32_ADC_USE_ADC3
  268. case F3: return TO_MUX( ADC_CHANNEL_IN6, 2 );
  269. case F4: return TO_MUX( ADC_CHANNEL_IN7, 2 );
  270. case F5: return TO_MUX( ADC_CHANNEL_IN8, 2 );
  271. case F6: return TO_MUX( ADC_CHANNEL_IN9, 2 );
  272. case F7: return TO_MUX( ADC_CHANNEL_IN10, 2 );
  273. case F8: return TO_MUX( ADC_CHANNEL_IN11, 2 );
  274. case F9: return TO_MUX( ADC_CHANNEL_IN12, 2 );
  275. case F10: return TO_MUX( ADC_CHANNEL_IN13, 2 );
  276. # endif
  277. #elif defined(STM32G4XX)
  278. case A0: return TO_MUX( ADC_CHANNEL_IN1, 0 ); // Can also be ADC2
  279. case A1: return TO_MUX( ADC_CHANNEL_IN2, 0 ); // Can also be ADC2
  280. case A2: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  281. case A3: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  282. case A4: return TO_MUX( ADC_CHANNEL_IN17, 1 );
  283. case A5: return TO_MUX( ADC_CHANNEL_IN13, 1 );
  284. case A6: return TO_MUX( ADC_CHANNEL_IN3, 1 );
  285. case A7: return TO_MUX( ADC_CHANNEL_IN4, 1 );
  286. case B0: return TO_MUX( ADC_CHANNEL_IN15, 0 ); // Can also be ADC3
  287. case B1: return TO_MUX( ADC_CHANNEL_IN12, 0 ); // Can also be ADC3
  288. case B2: return TO_MUX( ADC_CHANNEL_IN12, 1 );
  289. case B11: return TO_MUX( ADC_CHANNEL_IN14, 0 ); // Can also be ADC2
  290. case B12: return TO_MUX( ADC_CHANNEL_IN11, 0 ); // Can also be ADC4
  291. case B13: return TO_MUX( ADC_CHANNEL_IN5, 2 );
  292. case B14: return TO_MUX( ADC_CHANNEL_IN5, 0 ); // Can also be ADC4
  293. case B15: return TO_MUX( ADC_CHANNEL_IN15, 1 ); // Can also be ADC4
  294. case C0: return TO_MUX( ADC_CHANNEL_IN6, 0 ); // Can also be ADC2
  295. case C1: return TO_MUX( ADC_CHANNEL_IN7, 0 ); // Can also be ADC2
  296. case C2: return TO_MUX( ADC_CHANNEL_IN8, 0 ); // Can also be ADC2
  297. case C3: return TO_MUX( ADC_CHANNEL_IN9, 0 ); // Can also be ADC2
  298. case C4: return TO_MUX( ADC_CHANNEL_IN5, 1 );
  299. case C5: return TO_MUX( ADC_CHANNEL_IN11, 1 );
  300. case D8: return TO_MUX( ADC_CHANNEL_IN12, 3 );
  301. case D9: return TO_MUX( ADC_CHANNEL_IN13, 3 );
  302. case D10: return TO_MUX( ADC_CHANNEL_IN7, 2 ); // Can also be ADC4
  303. case D11: return TO_MUX( ADC_CHANNEL_IN8, 2 ); // Can also be ADC4
  304. case D12: return TO_MUX( ADC_CHANNEL_IN9, 2 ); // Can also be ADC4
  305. case D13: return TO_MUX( ADC_CHANNEL_IN10, 2 ); // Can also be ADC4
  306. case D14: return TO_MUX( ADC_CHANNEL_IN11, 2 ); // Can also be ADC4
  307. case E5: return TO_MUX( ADC_CHANNEL_IN2, 3 );
  308. case E7: return TO_MUX( ADC_CHANNEL_IN4, 2 );
  309. case E8: return TO_MUX( ADC_CHANNEL_IN6, 2 ); // Can also be ADC4
  310. case E9: return TO_MUX( ADC_CHANNEL_IN2, 2 );
  311. case E10: return TO_MUX( ADC_CHANNEL_IN14, 2 ); // Can also be ADC4
  312. case E11: return TO_MUX( ADC_CHANNEL_IN15, 2 ); // Can also be ADC4
  313. case E12: return TO_MUX( ADC_CHANNEL_IN16, 2 ); // Can also be ADC4
  314. case E13: return TO_MUX( ADC_CHANNEL_IN3, 2 );
  315. case E14: return TO_MUX( ADC_CHANNEL_IN1, 3 );
  316. case F0: return TO_MUX( ADC_CHANNEL_IN10, 0 );
  317. case F1: return TO_MUX( ADC_CHANNEL_IN10, 1 );
  318. #elif defined(RP2040)
  319. case 26U: return TO_MUX(0, 0);
  320. case 27U: return TO_MUX(1, 0);
  321. case 28U: return TO_MUX(2, 0);
  322. case 29U: return TO_MUX(3, 0);
  323. #endif
  324. }
  325. // return an adc that would never be used so intToADCDriver will bail out
  326. return TO_MUX(0, 0xFF);
  327. }
  328. // clang-format on
  329. static inline ADCDriver* intToADCDriver(uint8_t adcInt) {
  330. switch (adcInt) {
  331. #if RP_ADC_USE_ADC1 || STM32_ADC_USE_ADC1 || WB32_ADC_USE_ADC1 || AT32_ADC_USE_ADC1
  332. case 0:
  333. return &ADCD1;
  334. #endif
  335. #if STM32_ADC_USE_ADC2
  336. case 1:
  337. return &ADCD2;
  338. #endif
  339. #if STM32_ADC_USE_ADC3
  340. case 2:
  341. return &ADCD3;
  342. #endif
  343. #if STM32_ADC_USE_ADC4
  344. case 3:
  345. return &ADCD4;
  346. #endif
  347. }
  348. return NULL;
  349. }
  350. static inline void manageAdcInitializationDriver(uint8_t adc, ADCDriver* adcDriver) {
  351. if (!adcInitialized[adc]) {
  352. adcStart(adcDriver, &adcCfg);
  353. adcInitialized[adc] = true;
  354. }
  355. }
  356. int16_t analogReadPin(pin_t pin) {
  357. palSetLineMode(pin, PAL_MODE_INPUT_ANALOG);
  358. return adc_read(pinToMux(pin));
  359. }
  360. int16_t analogReadPinAdc(pin_t pin, uint8_t adc) {
  361. palSetLineMode(pin, PAL_MODE_INPUT_ANALOG);
  362. adc_mux target = pinToMux(pin);
  363. target.adc = adc;
  364. return adc_read(target);
  365. }
  366. int16_t adc_read(adc_mux mux) {
  367. #if defined(USE_ADCV1)
  368. // TODO: fix previous assumption of only 1 input...
  369. adcConversionGroup.chselr = 1 << mux.input; /*no macro to convert N to ADC_CHSELR_CHSEL1*/
  370. #elif defined(USE_ADCV2)
  371. # if defined(AT32F415)
  372. adcConversionGroup.osq3 = ADC_OSQ3_OSN1_N(mux.input);
  373. # else
  374. adcConversionGroup.sqr3 = ADC_SQR3_SQ1_N(mux.input);
  375. # endif
  376. #elif defined(RP2040)
  377. adcConversionGroup.channel_mask = 1 << mux.input;
  378. #else
  379. adcConversionGroup.sqr[0] = ADC_SQR1_SQ1_N(mux.input)
  380. # if ADC_DUMMY_CONVERSIONS_AT_START >= 1
  381. | ADC_SQR1_SQ2_N(mux.input)
  382. # endif
  383. ;
  384. #endif
  385. ADCDriver* targetDriver = intToADCDriver(mux.adc);
  386. if (!targetDriver) {
  387. return 0;
  388. }
  389. manageAdcInitializationDriver(mux.adc, targetDriver);
  390. if (adcConvert(targetDriver, &adcConversionGroup, &sampleBuffer[0], ADC_BUFFER_DEPTH) != MSG_OK) {
  391. return 0;
  392. }
  393. #if defined(USE_ADCV2) || defined(RP2040)
  394. // fake 12-bit -> N-bit scale
  395. return (sampleBuffer[ADC_DUMMY_CONVERSIONS_AT_START]) >> (12 - ADC_RESOLUTION);
  396. #else
  397. // already handled as part of adcConvert
  398. return sampleBuffer[ADC_DUMMY_CONVERSIONS_AT_START];
  399. #endif
  400. }