logo

qmk_firmware

custom branch of QMK firmware git clone https://anongit.hacktivis.me/git/qmk_firmware.git

analog.c (21790B)


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