adc.c 5.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153
  1. #include "stm32f0xx_hal.h"
  2. #include "adc.h"
  3. #include "led.h"
  4. #include <stdio.h>
  5. #define VOLTAGE_FACTOR 0.000806 // 0.24194
  6. #define FREQ_FACTOR 0.000806
  7. ADC_HandleTypeDef AdcHandle;
  8. ADC_ChannelConfTypeDef sConfig;
  9. ADC_FILTER_t adc_bat;
  10. ADC_FILTER_t adc_freq;
  11. float bat_voltage = 0.0;
  12. float freq_voltage = 0.0;
  13. __IO uint16_t adc_values[2];
  14. //
  15. void adc_init(void)
  16. {
  17. GPIO_InitTypeDef GPIO_InitStruct = {0};
  18. __HAL_RCC_GPIOA_CLK_ENABLE();
  19. __HAL_RCC_ADC1_CLK_ENABLE();
  20. GPIO_InitStruct.Pin = GPIO_PIN_0 | GPIO_PIN_1;
  21. GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
  22. GPIO_InitStruct.Pull = GPIO_NOPULL;
  23. HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
  24. AdcHandle.Instance = ADC1;
  25. HAL_ADC_DeInit(&AdcHandle);
  26. AdcHandle.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV2; /* Synchronous clock mode, input ADC clock with prscaler 2 */
  27. AdcHandle.Init.Resolution = ADC_RESOLUTION_12B; /* 12-bit resolution for converted data */
  28. AdcHandle.Init.DataAlign = ADC_DATAALIGN_RIGHT; /* Right-alignment for converted data */
  29. AdcHandle.Init.ScanConvMode = ADC_SCAN_DIRECTION_FORWARD; /* Sequencer disabled (ADC conversion on only 1 channel: channel set on rank 1) */
  30. AdcHandle.Init.EOCSelection = ADC_EOC_SINGLE_CONV; /* EOC flag picked-up to indicate conversion end */
  31. AdcHandle.Init.LowPowerAutoPowerOff = DISABLE;
  32. AdcHandle.Init.LowPowerAutoWait = DISABLE; /* Auto-delayed conversion feature disabled */
  33. AdcHandle.Init.ContinuousConvMode = DISABLE; /* Continuous mode enabled (automatic conversion restart after each conversion) */
  34. AdcHandle.Init.DiscontinuousConvMode = ENABLE; /* Parameter discarded because sequencer is disabled */
  35. AdcHandle.Init.ExternalTrigConv = ADC_SOFTWARE_START; /* Software start to trig the 1st conversion manually, without external event */
  36. AdcHandle.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE; /* Parameter discarded because software trigger chosen */
  37. AdcHandle.Init.DMAContinuousRequests = ENABLE; /* ADC DMA continuous request to match with DMA circular mode */
  38. AdcHandle.Init.Overrun = ADC_OVR_DATA_OVERWRITTEN; /* DR register is overwritten with the last conversion result in case of overrun */
  39. AdcHandle.Init.SamplingTimeCommon = ADC_SAMPLETIME_28CYCLES_5;
  40. HAL_ADC_Init(&AdcHandle);
  41. sConfig.Channel = ADC_CHANNEL_0; /* Channel to be converted */
  42. sConfig.Rank = ADC_RANK_CHANNEL_NUMBER;
  43. HAL_ADC_ConfigChannel(&AdcHandle, &sConfig);
  44. sConfig.Channel = ADC_CHANNEL_1; /* Channel to be converted */
  45. HAL_ADC_ConfigChannel(&AdcHandle, &sConfig);
  46. HAL_ADCEx_Calibration_Start(&AdcHandle);
  47. adc_dma_init(&AdcHandle);
  48. //HAL_ADC_Start(&AdcHandle);
  49. }
  50. void adc_dma_init(ADC_HandleTypeDef *hadc)
  51. {
  52. static DMA_HandleTypeDef DmaHandle;
  53. __HAL_RCC_DMA1_CLK_ENABLE();
  54. DmaHandle.Instance = DMA1_Channel1;
  55. DmaHandle.Init.Direction = DMA_PERIPH_TO_MEMORY;
  56. DmaHandle.Init.PeriphInc = DMA_PINC_DISABLE;
  57. DmaHandle.Init.MemInc = DMA_MINC_ENABLE;
  58. DmaHandle.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD; /* Transfer from ADC by half-word to match with ADC configuration: ADC resolution 10 or 12 bits */
  59. DmaHandle.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD; /* Transfer to memory by half-word to match with buffer variable type: half-word */
  60. DmaHandle.Init.Mode = DMA_CIRCULAR; /* DMA in circular mode to match with ADC configuration: DMA continuous requests */
  61. DmaHandle.Init.Priority = DMA_PRIORITY_HIGH;
  62. HAL_DMA_DeInit(&DmaHandle);
  63. HAL_DMA_Init(&DmaHandle);
  64. __HAL_LINKDMA(hadc, DMA_Handle, DmaHandle);
  65. HAL_NVIC_SetPriority(DMA1_Channel1_IRQn, 1, 0);
  66. HAL_NVIC_EnableIRQ(DMA1_Channel1_IRQn);
  67. }
  68. //
  69. float adc_average(ADC_FILTER_t *flt, float new_value)
  70. {
  71. if (!(flt->head < ADC_FILTER_LEN))
  72. flt->head = 0;
  73. if (flt->count < ADC_FILTER_LEN)
  74. flt->count++;
  75. flt->sum -= flt->buf[flt->head];
  76. flt->sum += new_value;
  77. flt->buf[flt->head++] = new_value;
  78. return flt->sum/(flt->count);
  79. }
  80. //
  81. void adc_task(void)
  82. {
  83. HAL_ADC_Start_DMA(&AdcHandle, (uint32_t *)adc_values, 2);
  84. HAL_ADC_Start(&AdcHandle);
  85. #if 0
  86. bat_voltage = 2*adc_average(&adc_bat, HAL_ADC_GetValue(&AdcHandle) * ADC_FACTOR);
  87. if (bat_voltage > 3.4)
  88. led_but_on();
  89. else
  90. led_but_toggle();
  91. #endif
  92. }
  93. //
  94. void adc_print_data(void)
  95. {
  96. printf("%f %f\r\n", bat_voltage, freq_voltage);
  97. }
  98. void DMA1_Channel1_IRQHandler(void)
  99. {
  100. HAL_DMA_IRQHandler(AdcHandle.DMA_Handle);
  101. }
  102. void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef *AdcHandle)
  103. {
  104. bat_voltage = adc_average(&adc_bat, adc_values[0] * VOLTAGE_FACTOR);
  105. freq_voltage = adc_average(&adc_freq, adc_values[1] * FREQ_FACTOR);
  106. }