drv_adc.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393
  1. /*
  2. * Copyright (c) 2006-2025, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2018-12-05 zylx first version
  9. * 2018-12-12 greedyhao Porting for stm32f7xx
  10. * 2019-02-01 yuneizhilin fix the stm32_adc_init function initialization issue
  11. * 2020-06-17 thread-liu Porting for stm32mp1xx
  12. * 2020-10-14 Dozingfiretruck Porting for stm32wbxx
  13. * 2022-05-22 Stanley Lwin Add stm32_adc_get_vref
  14. * 2022-12-26 wdfk-prog Change the order of configuration channels and calibration functions
  15. */
  16. #include <board.h>
  17. #include <rtthread.h>
  18. #if defined(BSP_USING_ADC1) || defined(BSP_USING_ADC2) || defined(BSP_USING_ADC3)
  19. #include "drv_config.h"
  20. //#define DRV_DEBUG
  21. #define LOG_TAG "drv.adc"
  22. #include <drv_log.h>
  23. static ADC_HandleTypeDef adc_config[] =
  24. {
  25. #ifdef BSP_USING_ADC1
  26. ADC1_CONFIG,
  27. #endif
  28. #ifdef BSP_USING_ADC2
  29. ADC2_CONFIG,
  30. #endif
  31. #ifdef BSP_USING_ADC3
  32. ADC3_CONFIG,
  33. #endif
  34. };
  35. struct stm32_adc
  36. {
  37. ADC_HandleTypeDef ADC_Handler;
  38. struct rt_adc_device stm32_adc_device;
  39. };
  40. static struct stm32_adc stm32_adc_obj[sizeof(adc_config) / sizeof(adc_config[0])];
  41. static rt_err_t stm32_adc_get_channel(rt_int8_t rt_channel, uint32_t *stm32_channel)
  42. {
  43. switch (rt_channel)
  44. {
  45. case 0:
  46. *stm32_channel = ADC_CHANNEL_0;
  47. break;
  48. case 1:
  49. *stm32_channel = ADC_CHANNEL_1;
  50. break;
  51. case 2:
  52. *stm32_channel = ADC_CHANNEL_2;
  53. break;
  54. case 3:
  55. *stm32_channel = ADC_CHANNEL_3;
  56. break;
  57. case 4:
  58. *stm32_channel = ADC_CHANNEL_4;
  59. break;
  60. case 5:
  61. *stm32_channel = ADC_CHANNEL_5;
  62. break;
  63. case 6:
  64. *stm32_channel = ADC_CHANNEL_6;
  65. break;
  66. case 7:
  67. *stm32_channel = ADC_CHANNEL_7;
  68. break;
  69. case 8:
  70. *stm32_channel = ADC_CHANNEL_8;
  71. break;
  72. case 9:
  73. *stm32_channel = ADC_CHANNEL_9;
  74. break;
  75. case 10:
  76. *stm32_channel = ADC_CHANNEL_10;
  77. break;
  78. case 11:
  79. *stm32_channel = ADC_CHANNEL_11;
  80. break;
  81. case 12:
  82. *stm32_channel = ADC_CHANNEL_12;
  83. break;
  84. case 13:
  85. *stm32_channel = ADC_CHANNEL_13;
  86. break;
  87. case 14:
  88. *stm32_channel = ADC_CHANNEL_14;
  89. break;
  90. case 15:
  91. *stm32_channel = ADC_CHANNEL_15;
  92. break;
  93. #ifdef ADC_CHANNEL_16
  94. case 16:
  95. *stm32_channel = ADC_CHANNEL_16;
  96. break;
  97. #endif /* ADC_CHANNEL_16 */
  98. case 17:
  99. *stm32_channel = ADC_CHANNEL_17;
  100. break;
  101. #ifdef ADC_CHANNEL_18
  102. case 18:
  103. *stm32_channel = ADC_CHANNEL_18;
  104. break;
  105. #endif /* ADC_CHANNEL_18 */
  106. #ifdef ADC_CHANNEL_19
  107. case 19:
  108. *stm32_channel = ADC_CHANNEL_19;
  109. break;
  110. #endif /* ADC_CHANNEL_19 */
  111. #ifdef ADC_CHANNEL_VREFINT
  112. case RT_ADC_INTERN_CH_VREF:
  113. *stm32_channel = ADC_CHANNEL_VREFINT;
  114. break;
  115. #endif /* ADC_CHANNEL_VREFINT */
  116. #ifdef ADC_CHANNEL_VBAT
  117. case RT_ADC_INTERN_CH_VBAT:
  118. *stm32_channel = ADC_CHANNEL_VBAT;
  119. break;
  120. #endif /* ADC_CHANNEL_VBAT */
  121. #ifdef ADC_CHANNEL_TEMPSENSOR
  122. case RT_ADC_INTERN_CH_TEMPER:
  123. *stm32_channel = ADC_CHANNEL_TEMPSENSOR;
  124. break;
  125. #endif /* ADC_CHANNEL_TEMPSENSOR */
  126. default:
  127. return -RT_EINVAL;
  128. }
  129. return RT_EOK;
  130. }
  131. static rt_err_t stm32_adc_enabled(struct rt_adc_device *device, rt_int8_t channel, rt_bool_t enabled)
  132. {
  133. ADC_HandleTypeDef *stm32_adc_handler;
  134. RT_ASSERT(device != RT_NULL);
  135. stm32_adc_handler = device->parent.user_data;
  136. if (enabled)
  137. {
  138. ADC_ChannelConfTypeDef ADC_ChanConf;
  139. rt_memset(&ADC_ChanConf, 0, sizeof(ADC_ChanConf));
  140. if(stm32_adc_get_channel(channel, &ADC_ChanConf.Channel) != RT_EOK)
  141. {
  142. LOG_E("ADC channel illegal: %d", channel);
  143. return -RT_EINVAL;
  144. }
  145. #if defined(SOC_SERIES_STM32MP1) || defined (SOC_SERIES_STM32H7) || defined (SOC_SERIES_STM32WB) || defined(SOC_SERIES_STM32U5)
  146. ADC_ChanConf.Rank = ADC_REGULAR_RANK_1;
  147. #else
  148. ADC_ChanConf.Rank = 1;
  149. #endif
  150. #if defined(SOC_SERIES_STM32F0)
  151. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_71CYCLES_5;
  152. #elif defined(SOC_SERIES_STM32F1)
  153. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_55CYCLES_5;
  154. #elif defined(SOC_SERIES_STM32F2) || defined(SOC_SERIES_STM32F4) || defined(SOC_SERIES_STM32F7)
  155. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_112CYCLES;
  156. #elif defined(SOC_SERIES_STM32L4)
  157. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_247CYCLES_5;
  158. #elif defined(SOC_SERIES_STM32MP1)
  159. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_810CYCLES_5;
  160. #elif defined(SOC_SERIES_STM32H7)
  161. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_810CYCLES_5;
  162. #elif defined(SOC_SERIES_STM32U5)
  163. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_814CYCLES;
  164. #elif defined (SOC_SERIES_STM32WB)
  165. ADC_ChanConf.SamplingTime = ADC_SAMPLETIME_2CYCLES_5;
  166. #endif
  167. #if defined(SOC_SERIES_STM32F2) || defined(SOC_SERIES_STM32F4) || defined(SOC_SERIES_STM32F7) || defined(SOC_SERIES_STM32L4) || defined (SOC_SERIES_STM32WB)
  168. ADC_ChanConf.Offset = 0;
  169. #endif
  170. #if defined(SOC_SERIES_STM32L4)
  171. ADC_ChanConf.OffsetNumber = ADC_OFFSET_NONE;
  172. ADC_ChanConf.SingleDiff = LL_ADC_SINGLE_ENDED;
  173. #elif defined(SOC_SERIES_STM32MP1) || defined(SOC_SERIES_STM32H7) || defined (SOC_SERIES_STM32WB) || defined(SOC_SERIES_STM32U5)
  174. ADC_ChanConf.OffsetNumber = ADC_OFFSET_NONE; /* ADC channel affected to offset number */
  175. ADC_ChanConf.Offset = 0;
  176. ADC_ChanConf.SingleDiff = ADC_SINGLE_ENDED; /* ADC channel differential mode */
  177. #endif
  178. /* enable the analog power domain before configuring channel */
  179. #if defined(SOC_SERIES_STM32U5)
  180. __HAL_RCC_PWR_CLK_ENABLE();
  181. HAL_PWREx_EnableVddA();
  182. #endif /* defined(SOC_SERIES_STM32U5) */
  183. if(HAL_ADC_ConfigChannel(stm32_adc_handler, &ADC_ChanConf) != HAL_OK)
  184. {
  185. LOG_E("Failed to configure ADC channel %d", channel);
  186. return -RT_ERROR;
  187. }
  188. /* perform an automatic ADC calibration to improve the conversion accuracy */
  189. #if defined(SOC_SERIES_STM32L4) || defined (SOC_SERIES_STM32WB)
  190. if (HAL_ADCEx_Calibration_Start(stm32_adc_handler, ADC_ChanConf.SingleDiff) != HAL_OK)
  191. {
  192. LOG_E("ADC calibration error!\n");
  193. return -RT_ERROR;
  194. }
  195. #elif defined(SOC_SERIES_STM32MP1) || defined(SOC_SERIES_STM32H7) || defined(SOC_SERIES_STM32U5)
  196. /* Run the ADC linear calibration in single-ended mode */
  197. if (HAL_ADCEx_Calibration_Start(stm32_adc_handler, ADC_CALIB_OFFSET_LINEARITY, ADC_ChanConf.SingleDiff) != HAL_OK)
  198. {
  199. LOG_E("ADC open linear calibration error!\n");
  200. /* Calibration Error */
  201. return -RT_ERROR;
  202. }
  203. #endif
  204. }
  205. else
  206. {
  207. if (HAL_ADC_Stop(stm32_adc_handler) != HAL_OK)
  208. {
  209. LOG_E("Stop ADC conversion failed!\n");
  210. return -RT_ERROR;
  211. }
  212. }
  213. return RT_EOK;
  214. }
  215. static rt_uint8_t stm32_adc_get_resolution(struct rt_adc_device *device)
  216. {
  217. #if defined(SOC_SERIES_STM32F1) || defined(SOC_SERIES_STM32F3)
  218. return 12;
  219. #else
  220. ADC_HandleTypeDef *stm32_adc_handler = device->parent.user_data;
  221. RT_ASSERT(device != RT_NULL);
  222. switch(stm32_adc_handler->Init.Resolution)
  223. {
  224. #ifdef SOC_SERIES_STM32H7
  225. case ADC_RESOLUTION_16B:
  226. return 16;
  227. #endif /* SOC_SERIES_STM32H7 */
  228. #if defined(SOC_SERIES_STM32H7) || defined(SOC_SERIES_STM32U5)
  229. case ADC_RESOLUTION_14B:
  230. return 14;
  231. #endif /* defined(SOC_SERIES_STM32H7) || defined(SOC_SERIES_STM32U5) */
  232. case ADC_RESOLUTION_12B:
  233. return 12;
  234. case ADC_RESOLUTION_10B:
  235. return 10;
  236. case ADC_RESOLUTION_8B:
  237. return 8;
  238. #if defined(SOC_SERIES_STM32H7) && (ADC_VER_V5_V90) || defined(SOC_SERIES_STM32U5)
  239. case ADC_RESOLUTION_6B:
  240. return 6;
  241. #endif /* defined(SOC_SERIES_STM32H7) && (ADC_VER_V5_V90) || defined(SOC_SERIES_STM32U5) */
  242. default:
  243. return 0;
  244. }
  245. #endif /* defined(SOC_SERIES_STM32F1) || defined(SOC_SERIES_STM32F3) */
  246. }
  247. static rt_err_t stm32_adc_get_value(struct rt_adc_device *device, rt_int8_t channel, rt_uint32_t *value)
  248. {
  249. ADC_HandleTypeDef *stm32_adc_handler;
  250. RT_ASSERT(device != RT_NULL);
  251. RT_ASSERT(value != RT_NULL);
  252. stm32_adc_handler = device->parent.user_data;
  253. if (HAL_ADC_Start(stm32_adc_handler) != HAL_OK)
  254. {
  255. LOG_E("Start ADC conversion error!\n");
  256. return -RT_ERROR;
  257. }
  258. /* Wait for the ADC to convert */
  259. if (HAL_ADC_PollForConversion(stm32_adc_handler, 100) != RT_EOK)
  260. {
  261. LOG_E("ADC conversion error!\n");
  262. return -RT_ERROR;
  263. }
  264. /* get ADC value */
  265. *value = (rt_uint32_t)HAL_ADC_GetValue(stm32_adc_handler);
  266. return RT_EOK;
  267. }
  268. static rt_int16_t stm32_adc_get_vref (struct rt_adc_device *device)
  269. {
  270. rt_uint16_t vref_mv;
  271. #ifdef __LL_ADC_CALC_VREFANALOG_VOLTAGE
  272. rt_err_t ret;
  273. rt_uint32_t vref_value;
  274. ADC_HandleTypeDef *stm32_adc_handler = device->parent.user_data;
  275. ret = stm32_adc_enabled(device, RT_ADC_INTERN_CH_VREF, RT_TRUE);
  276. if (ret != RT_EOK)
  277. return 0;
  278. ret = stm32_adc_get_value(device, RT_ADC_INTERN_CH_VREF, &vref_value);
  279. if (ret != RT_EOK)
  280. return 0;
  281. ret = stm32_adc_enabled(device, RT_ADC_INTERN_CH_VREF, RT_FALSE);
  282. if (ret != RT_EOK)
  283. return 0;
  284. #ifdef SOC_SERIES_STM32U5
  285. vref_mv = __LL_ADC_CALC_VREFANALOG_VOLTAGE(stm32_adc_handler->Instance, vref_value, stm32_adc_handler->Init.Resolution);
  286. #else
  287. vref_mv = __LL_ADC_CALC_VREFANALOG_VOLTAGE(vref_value, stm32_adc_handler->Init.Resolution);
  288. #endif
  289. #else
  290. vref_mv = 3300;
  291. #endif /* __LL_ADC_CALC_VREFANALOG_VOLTAGE */
  292. return vref_mv;
  293. }
  294. static const struct rt_adc_ops stm_adc_ops =
  295. {
  296. .enabled = stm32_adc_enabled,
  297. .convert = stm32_adc_get_value,
  298. .get_resolution = stm32_adc_get_resolution,
  299. .get_vref = stm32_adc_get_vref,
  300. };
  301. static int stm32_adc_init(void)
  302. {
  303. int result = RT_EOK;
  304. /* save adc name */
  305. char name_buf[5] = {'a', 'd', 'c', '0', 0};
  306. rt_uint32_t i = 0;
  307. for (i = 0; i < sizeof(adc_config) / sizeof(adc_config[0]); i++)
  308. {
  309. /* ADC init */
  310. name_buf[3] = '0';
  311. stm32_adc_obj[i].ADC_Handler = adc_config[i];
  312. #if defined(ADC1)
  313. if (stm32_adc_obj[i].ADC_Handler.Instance == ADC1)
  314. {
  315. name_buf[3] = '1';
  316. }
  317. #endif
  318. #if defined(ADC2)
  319. if (stm32_adc_obj[i].ADC_Handler.Instance == ADC2)
  320. {
  321. name_buf[3] = '2';
  322. }
  323. #endif
  324. #if defined(ADC3)
  325. if (stm32_adc_obj[i].ADC_Handler.Instance == ADC3)
  326. {
  327. name_buf[3] = '3';
  328. }
  329. #endif
  330. if (HAL_ADC_Init(&stm32_adc_obj[i].ADC_Handler) != HAL_OK)
  331. {
  332. LOG_E("%s init failed", name_buf);
  333. result = -RT_ERROR;
  334. }
  335. else
  336. {
  337. /* register ADC device */
  338. if (rt_hw_adc_register(&stm32_adc_obj[i].stm32_adc_device, name_buf, &stm_adc_ops, &stm32_adc_obj[i].ADC_Handler) == RT_EOK)
  339. {
  340. LOG_D("%s init success", name_buf);
  341. }
  342. else
  343. {
  344. LOG_E("%s register failed", name_buf);
  345. result = -RT_ERROR;
  346. }
  347. }
  348. }
  349. return result;
  350. }
  351. INIT_BOARD_EXPORT(stm32_adc_init);
  352. #endif /* BSP_USING_ADC */