analog.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422
  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
  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)
  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)
  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)
  128. .cr2 = ADC_CR2_SWSTART, // F103 seem very unhappy with, F401 seems very unhappy without...
  129. # endif
  130. .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),
  131. .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),
  132. #elif defined(RP2040)
  133. // RP2040 does not have any extra config here
  134. #else
  135. .cfgr = ADC_CFGR_CONT | ADC_RESOLUTION,
  136. .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)},
  137. #endif
  138. };
  139. // clang-format off
  140. __attribute__((weak)) adc_mux pinToMux(pin_t pin) {
  141. switch (pin) {
  142. #if defined(STM32F0XX)
  143. case A0: return TO_MUX( 0, 0 );
  144. case A1: return TO_MUX( 1, 0 );
  145. case A2: return TO_MUX( 2, 0 );
  146. case A3: return TO_MUX( 3, 0 );
  147. case A4: return TO_MUX( 4, 0 );
  148. case A5: return TO_MUX( 5, 0 );
  149. case A6: return TO_MUX( 6, 0 );
  150. case A7: return TO_MUX( 7, 0 );
  151. case B0: return TO_MUX( 8, 0 );
  152. case B1: return TO_MUX( 9, 0 );
  153. case C0: return TO_MUX( 10, 0 );
  154. case C1: return TO_MUX( 11, 0 );
  155. case C2: return TO_MUX( 12, 0 );
  156. case C3: return TO_MUX( 13, 0 );
  157. case C4: return TO_MUX( 14, 0 );
  158. case C5: return TO_MUX( 15, 0 );
  159. #elif defined(STM32F3XX)
  160. case A0: return TO_MUX( ADC_CHANNEL_IN1, 0 );
  161. case A1: return TO_MUX( ADC_CHANNEL_IN2, 0 );
  162. case A2: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  163. case A3: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  164. case A4: return TO_MUX( ADC_CHANNEL_IN1, 1 );
  165. case A5: return TO_MUX( ADC_CHANNEL_IN2, 1 );
  166. case A6: return TO_MUX( ADC_CHANNEL_IN3, 1 );
  167. case A7: return TO_MUX( ADC_CHANNEL_IN4, 1 );
  168. case B0: return TO_MUX( ADC_CHANNEL_IN12, 2 );
  169. case B1: return TO_MUX( ADC_CHANNEL_IN1, 2 );
  170. case B2: return TO_MUX( ADC_CHANNEL_IN12, 1 );
  171. case B12: return TO_MUX( ADC_CHANNEL_IN3, 3 );
  172. case B13: return TO_MUX( ADC_CHANNEL_IN5, 2 );
  173. case B14: return TO_MUX( ADC_CHANNEL_IN4, 3 );
  174. case B15: return TO_MUX( ADC_CHANNEL_IN5, 3 );
  175. case C0: return TO_MUX( ADC_CHANNEL_IN6, 0 ); // Can also be ADC2
  176. case C1: return TO_MUX( ADC_CHANNEL_IN7, 0 ); // Can also be ADC2
  177. case C2: return TO_MUX( ADC_CHANNEL_IN8, 0 ); // Can also be ADC2
  178. case C3: return TO_MUX( ADC_CHANNEL_IN9, 0 ); // Can also be ADC2
  179. case C4: return TO_MUX( ADC_CHANNEL_IN5, 1 );
  180. case C5: return TO_MUX( ADC_CHANNEL_IN11, 1 );
  181. case D8: return TO_MUX( ADC_CHANNEL_IN12, 3 );
  182. case D9: return TO_MUX( ADC_CHANNEL_IN13, 3 );
  183. case D10: return TO_MUX( ADC_CHANNEL_IN7, 2 ); // Can also be ADC4
  184. case D11: return TO_MUX( ADC_CHANNEL_IN8, 2 ); // Can also be ADC4
  185. case D12: return TO_MUX( ADC_CHANNEL_IN9, 2 ); // Can also be ADC4
  186. case D13: return TO_MUX( ADC_CHANNEL_IN10, 2 ); // Can also be ADC4
  187. case D14: return TO_MUX( ADC_CHANNEL_IN11, 2 ); // Can also be ADC4
  188. case E7: return TO_MUX( ADC_CHANNEL_IN13, 2 );
  189. case E8: return TO_MUX( ADC_CHANNEL_IN6, 2 ); // Can also be ADC4
  190. case E9: return TO_MUX( ADC_CHANNEL_IN2, 2 );
  191. case E10: return TO_MUX( ADC_CHANNEL_IN14, 2 );
  192. case E11: return TO_MUX( ADC_CHANNEL_IN15, 2 );
  193. case E12: return TO_MUX( ADC_CHANNEL_IN16, 2 );
  194. case E13: return TO_MUX( ADC_CHANNEL_IN3, 2 );
  195. case E14: return TO_MUX( ADC_CHANNEL_IN1, 3 );
  196. case E15: return TO_MUX( ADC_CHANNEL_IN2, 3 );
  197. case F2: return TO_MUX( ADC_CHANNEL_IN10, 0 ); // Can also be ADC2
  198. case F4: return TO_MUX( ADC_CHANNEL_IN5, 0 );
  199. #elif defined(STM32F4XX)
  200. case A0: return TO_MUX( ADC_CHANNEL_IN0, 0 );
  201. case A1: return TO_MUX( ADC_CHANNEL_IN1, 0 );
  202. case A2: return TO_MUX( ADC_CHANNEL_IN2, 0 );
  203. case A3: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  204. case A4: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  205. case A5: return TO_MUX( ADC_CHANNEL_IN5, 0 );
  206. case A6: return TO_MUX( ADC_CHANNEL_IN6, 0 );
  207. case A7: return TO_MUX( ADC_CHANNEL_IN7, 0 );
  208. case B0: return TO_MUX( ADC_CHANNEL_IN8, 0 );
  209. case B1: return TO_MUX( ADC_CHANNEL_IN9, 0 );
  210. case C0: return TO_MUX( ADC_CHANNEL_IN10, 0 );
  211. case C1: return TO_MUX( ADC_CHANNEL_IN11, 0 );
  212. case C2: return TO_MUX( ADC_CHANNEL_IN12, 0 );
  213. case C3: return TO_MUX( ADC_CHANNEL_IN13, 0 );
  214. case C4: return TO_MUX( ADC_CHANNEL_IN14, 0 );
  215. case C5: return TO_MUX( ADC_CHANNEL_IN15, 0 );
  216. # if STM32_ADC_USE_ADC3
  217. case F3: return TO_MUX( ADC_CHANNEL_IN9, 2 );
  218. case F4: return TO_MUX( ADC_CHANNEL_IN14, 2 );
  219. case F5: return TO_MUX( ADC_CHANNEL_IN15, 2 );
  220. case F6: return TO_MUX( ADC_CHANNEL_IN4, 2 );
  221. case F7: return TO_MUX( ADC_CHANNEL_IN5, 2 );
  222. case F8: return TO_MUX( ADC_CHANNEL_IN6, 2 );
  223. case F9: return TO_MUX( ADC_CHANNEL_IN7, 2 );
  224. case F10: return TO_MUX( ADC_CHANNEL_IN8, 2 );
  225. # endif
  226. #elif defined(STM32F1XX) || defined(GD32VF103) || defined(WB32F3G71xx) || defined(WB32FQ95xx)
  227. case A0: return TO_MUX( ADC_CHANNEL_IN0, 0 );
  228. case A1: return TO_MUX( ADC_CHANNEL_IN1, 0 );
  229. case A2: return TO_MUX( ADC_CHANNEL_IN2, 0 );
  230. case A3: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  231. case A4: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  232. case A5: return TO_MUX( ADC_CHANNEL_IN5, 0 );
  233. case A6: return TO_MUX( ADC_CHANNEL_IN6, 0 );
  234. case A7: return TO_MUX( ADC_CHANNEL_IN7, 0 );
  235. case B0: return TO_MUX( ADC_CHANNEL_IN8, 0 );
  236. case B1: return TO_MUX( ADC_CHANNEL_IN9, 0 );
  237. case C0: return TO_MUX( ADC_CHANNEL_IN10, 0 );
  238. case C1: return TO_MUX( ADC_CHANNEL_IN11, 0 );
  239. case C2: return TO_MUX( ADC_CHANNEL_IN12, 0 );
  240. case C3: return TO_MUX( ADC_CHANNEL_IN13, 0 );
  241. case C4: return TO_MUX( ADC_CHANNEL_IN14, 0 );
  242. case C5: return TO_MUX( ADC_CHANNEL_IN15, 0 );
  243. // STM32F103x[C-G] in 144-pin packages also have analog inputs on F6...F10, but they are on ADC3, and the
  244. // ChibiOS ADC driver for STM32F1xx currently supports only ADC1, therefore these pins are not usable.
  245. #elif defined(STM32L4XX)
  246. case A0: return TO_MUX( ADC_CHANNEL_IN5, 0 ); // Can also be ADC2 in some cases
  247. case A1: return TO_MUX( ADC_CHANNEL_IN6, 0 ); // Can also be ADC2 in some cases
  248. case A2: return TO_MUX( ADC_CHANNEL_IN7, 0 ); // Can also be ADC2
  249. case A3: return TO_MUX( ADC_CHANNEL_IN8, 0 ); // Can also be ADC2
  250. case A4: return TO_MUX( ADC_CHANNEL_IN9, 0 ); // Can also be ADC2
  251. case A5: return TO_MUX( ADC_CHANNEL_IN10, 0 ); // Can also be ADC2
  252. case A6: return TO_MUX( ADC_CHANNEL_IN11, 0 ); // Can also be ADC2
  253. case A7: return TO_MUX( ADC_CHANNEL_IN12, 0 ); // Can also be ADC2
  254. case B0: return TO_MUX( ADC_CHANNEL_IN15, 0 ); // Can also be ADC2
  255. case B1: return TO_MUX( ADC_CHANNEL_IN16, 0 ); // Can also be ADC2
  256. case C0: return TO_MUX( ADC_CHANNEL_IN1, 0 ); // Can also be ADC2 or ADC3
  257. case C1: return TO_MUX( ADC_CHANNEL_IN2, 0 ); // Can also be ADC2 or ADC3
  258. case C2: return TO_MUX( ADC_CHANNEL_IN3, 0 ); // Can also be ADC2 or ADC3
  259. case C3: return TO_MUX( ADC_CHANNEL_IN4, 0 ); // Can also be ADC2 or ADC3
  260. case C4: return TO_MUX( ADC_CHANNEL_IN13, 0 ); // Can also be ADC2
  261. case C5: return TO_MUX( ADC_CHANNEL_IN14, 0 ); // Can also be ADC2
  262. # if STM32_HAS_GPIOF && STM32_ADC_USE_ADC3
  263. case F3: return TO_MUX( ADC_CHANNEL_IN6, 2 );
  264. case F4: return TO_MUX( ADC_CHANNEL_IN7, 2 );
  265. case F5: return TO_MUX( ADC_CHANNEL_IN8, 2 );
  266. case F6: return TO_MUX( ADC_CHANNEL_IN9, 2 );
  267. case F7: return TO_MUX( ADC_CHANNEL_IN10, 2 );
  268. case F8: return TO_MUX( ADC_CHANNEL_IN11, 2 );
  269. case F9: return TO_MUX( ADC_CHANNEL_IN12, 2 );
  270. case F10: return TO_MUX( ADC_CHANNEL_IN13, 2 );
  271. # endif
  272. #elif defined(STM32G4XX)
  273. case A0: return TO_MUX( ADC_CHANNEL_IN1, 0 ); // Can also be ADC2
  274. case A1: return TO_MUX( ADC_CHANNEL_IN2, 0 ); // Can also be ADC2
  275. case A2: return TO_MUX( ADC_CHANNEL_IN3, 0 );
  276. case A3: return TO_MUX( ADC_CHANNEL_IN4, 0 );
  277. case A4: return TO_MUX( ADC_CHANNEL_IN17, 1 );
  278. case A5: return TO_MUX( ADC_CHANNEL_IN13, 1 );
  279. case A6: return TO_MUX( ADC_CHANNEL_IN3, 1 );
  280. case A7: return TO_MUX( ADC_CHANNEL_IN4, 1 );
  281. case B0: return TO_MUX( ADC_CHANNEL_IN15, 0 ); // Can also be ADC3
  282. case B1: return TO_MUX( ADC_CHANNEL_IN12, 0 ); // Can also be ADC3
  283. case B2: return TO_MUX( ADC_CHANNEL_IN12, 1 );
  284. case B11: return TO_MUX( ADC_CHANNEL_IN14, 0 ); // Can also be ADC2
  285. case B12: return TO_MUX( ADC_CHANNEL_IN11, 0 ); // Can also be ADC4
  286. case B13: return TO_MUX( ADC_CHANNEL_IN5, 2 );
  287. case B14: return TO_MUX( ADC_CHANNEL_IN5, 0 ); // Can also be ADC4
  288. case B15: return TO_MUX( ADC_CHANNEL_IN15, 1 ); // Can also be ADC4
  289. case C0: return TO_MUX( ADC_CHANNEL_IN6, 0 ); // Can also be ADC2
  290. case C1: return TO_MUX( ADC_CHANNEL_IN7, 0 ); // Can also be ADC2
  291. case C2: return TO_MUX( ADC_CHANNEL_IN8, 0 ); // Can also be ADC2
  292. case C3: return TO_MUX( ADC_CHANNEL_IN9, 0 ); // Can also be ADC2
  293. case C4: return TO_MUX( ADC_CHANNEL_IN5, 1 );
  294. case C5: return TO_MUX( ADC_CHANNEL_IN11, 1 );
  295. case D8: return TO_MUX( ADC_CHANNEL_IN12, 3 );
  296. case D9: return TO_MUX( ADC_CHANNEL_IN13, 3 );
  297. case D10: return TO_MUX( ADC_CHANNEL_IN7, 2 ); // Can also be ADC4
  298. case D11: return TO_MUX( ADC_CHANNEL_IN8, 2 ); // Can also be ADC4
  299. case D12: return TO_MUX( ADC_CHANNEL_IN9, 2 ); // Can also be ADC4
  300. case D13: return TO_MUX( ADC_CHANNEL_IN10, 2 ); // Can also be ADC4
  301. case D14: return TO_MUX( ADC_CHANNEL_IN11, 2 ); // Can also be ADC4
  302. case E5: return TO_MUX( ADC_CHANNEL_IN2, 3 );
  303. case E7: return TO_MUX( ADC_CHANNEL_IN4, 2 );
  304. case E8: return TO_MUX( ADC_CHANNEL_IN6, 2 ); // Can also be ADC4
  305. case E9: return TO_MUX( ADC_CHANNEL_IN2, 2 );
  306. case E10: return TO_MUX( ADC_CHANNEL_IN14, 2 ); // Can also be ADC4
  307. case E11: return TO_MUX( ADC_CHANNEL_IN15, 2 ); // Can also be ADC4
  308. case E12: return TO_MUX( ADC_CHANNEL_IN16, 2 ); // Can also be ADC4
  309. case E13: return TO_MUX( ADC_CHANNEL_IN3, 2 );
  310. case E14: return TO_MUX( ADC_CHANNEL_IN1, 3 );
  311. case F0: return TO_MUX( ADC_CHANNEL_IN10, 0 );
  312. case F1: return TO_MUX( ADC_CHANNEL_IN10, 1 );
  313. #elif defined(RP2040)
  314. case 26U: return TO_MUX(0, 0);
  315. case 27U: return TO_MUX(1, 0);
  316. case 28U: return TO_MUX(2, 0);
  317. case 29U: return TO_MUX(3, 0);
  318. #endif
  319. }
  320. // return an adc that would never be used so intToADCDriver will bail out
  321. return TO_MUX(0, 0xFF);
  322. }
  323. // clang-format on
  324. static inline ADCDriver* intToADCDriver(uint8_t adcInt) {
  325. switch (adcInt) {
  326. #if RP_ADC_USE_ADC1 || STM32_ADC_USE_ADC1 || WB32_ADC_USE_ADC1
  327. case 0:
  328. return &ADCD1;
  329. #endif
  330. #if STM32_ADC_USE_ADC2
  331. case 1:
  332. return &ADCD2;
  333. #endif
  334. #if STM32_ADC_USE_ADC3
  335. case 2:
  336. return &ADCD3;
  337. #endif
  338. #if STM32_ADC_USE_ADC4
  339. case 3:
  340. return &ADCD4;
  341. #endif
  342. }
  343. return NULL;
  344. }
  345. static inline void manageAdcInitializationDriver(uint8_t adc, ADCDriver* adcDriver) {
  346. if (!adcInitialized[adc]) {
  347. adcStart(adcDriver, &adcCfg);
  348. adcInitialized[adc] = true;
  349. }
  350. }
  351. int16_t analogReadPin(pin_t pin) {
  352. palSetLineMode(pin, PAL_MODE_INPUT_ANALOG);
  353. return adc_read(pinToMux(pin));
  354. }
  355. int16_t analogReadPinAdc(pin_t pin, uint8_t adc) {
  356. palSetLineMode(pin, PAL_MODE_INPUT_ANALOG);
  357. adc_mux target = pinToMux(pin);
  358. target.adc = adc;
  359. return adc_read(target);
  360. }
  361. int16_t adc_read(adc_mux mux) {
  362. #if defined(USE_ADCV1)
  363. // TODO: fix previous assumption of only 1 input...
  364. adcConversionGroup.chselr = 1 << mux.input; /*no macro to convert N to ADC_CHSELR_CHSEL1*/
  365. #elif defined(USE_ADCV2)
  366. adcConversionGroup.sqr3 = ADC_SQR3_SQ1_N(mux.input);
  367. #elif defined(RP2040)
  368. adcConversionGroup.channel_mask = 1 << mux.input;
  369. #else
  370. adcConversionGroup.sqr[0] = ADC_SQR1_SQ1_N(mux.input)
  371. # if ADC_DUMMY_CONVERSIONS_AT_START >= 1
  372. | ADC_SQR1_SQ2_N(mux.input)
  373. # endif
  374. ;
  375. #endif
  376. ADCDriver* targetDriver = intToADCDriver(mux.adc);
  377. if (!targetDriver) {
  378. return 0;
  379. }
  380. manageAdcInitializationDriver(mux.adc, targetDriver);
  381. if (adcConvert(targetDriver, &adcConversionGroup, &sampleBuffer[0], ADC_BUFFER_DEPTH) != MSG_OK) {
  382. return 0;
  383. }
  384. #if defined(USE_ADCV2) || defined(RP2040)
  385. // fake 12-bit -> N-bit scale
  386. return (sampleBuffer[ADC_DUMMY_CONVERSIONS_AT_START]) >> (12 - ADC_RESOLUTION);
  387. #else
  388. // already handled as part of adcConvert
  389. return sampleBuffer[ADC_DUMMY_CONVERSIONS_AT_START];
  390. #endif
  391. }