adc.c 8.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276
  1. /**
  2. ******************************************************************************
  3. * @file VAPC-meter/lib/adc.c
  4. * @author "Vladimir N. Shilov" <shilow@ukr.net>
  5. * @version V1
  6. * @date 24-March-2016
  7. * @brief This file contains the ADC functions.
  8. ******************************************************************************
  9. * Tim2 регулярно запускат АЦП.
  10. * АЦП измеряет два заданных канала и пинает DMA
  11. * DMA забирает данные у ADC и складывает их в ADC_Buffer
  12. * В прерывании по окончанию транзакции данные из ADC_Buffer
  13. * раскладываем по FastBuffers.
  14. */
  15. /* Includes ------------------------------------------------------------------*/
  16. #include "adc.h"
  17. /** @addtogroup ADC
  18. * @{
  19. */
  20. /* Private typedef -----------------------------------------------------------*/
  21. /* Private define ------------------------------------------------------------*/
  22. #define VOLTAGE_CHANNEL ADC_Channel_17
  23. #define CURRENT_CHANNEL ADC_Channel_18
  24. #define ADC1_DR_ADDRESS ((uint16_t)0x5344)
  25. #define ADC_BUFFER_ADDRESS ((uint16_t)(&ADC_Buffer))
  26. // Suply voltage
  27. #define ADC_REF 3306
  28. // Normal K for current channel = 4095 * 10 (Ку ОУ) * 0.05 (Rш)
  29. #define ADC_DIV 2048
  30. #define ADC_DIV_H 1024
  31. // Oversampl K for current channel = 32760 * 10 (Ку ОУ) * 0.05 (Rш)
  32. #define ADC_ODIV 16380
  33. #define ADC_ODIV_H 8190
  34. // for shunt voltage calcuation
  35. #define ADC_ORES 32760
  36. #define ADC_ORES_H 16380
  37. #define ADC_OU_MUL 10
  38. #define ADC_OU_ZERO_DRIFT 41
  39. // Input Voltage divider
  40. #define ADC_VOLT_K 11
  41. // (Частота МК (16 МHz) / Предделитель таймера (8) * Нужное время в секундах (0.0015625)) - 1
  42. #define TIM_PERIOD ((uint16_t)3128)
  43. #define TIM_PRESCALER TIM2_Prescaler_8
  44. /* Private macro -------------------------------------------------------------*/
  45. /* Private variables ---------------------------------------------------------*/
  46. static __IO uint16_t ADC_Buffer[ADC_BUFFER_SIZE];
  47. static __IO uint16_t VoltageFastBuffer[FAST_BUFFER_SIZE];
  48. static __IO uint16_t CurrentFastBuffer[FAST_BUFFER_SIZE];
  49. /* Private constants ---------------------------------------------------------*/
  50. __near __no_init const unsigned char Factory_VREFINT @ 0x4910;
  51. /* Private function prototypes -----------------------------------------------*/
  52. static void ADC_ConfigADC(void);
  53. static void ADC_ConfigDMA(void);
  54. static void ADC_ConfigTIM2(void);
  55. /* Private functions ---------------------------------------------------------*/
  56. /**
  57. * @brief Initialize and start ADC
  58. * @param None
  59. * @retval None
  60. */
  61. void ADC_Config(void)
  62. {
  63. /* ADC configuration */
  64. ADC_ConfigADC();
  65. /* DMA configuration */
  66. ADC_ConfigDMA();
  67. /* TIM2 configuration */
  68. ADC_ConfigTIM2();
  69. }
  70. /**
  71. * @brief Configure ADC peripheral
  72. * @param None
  73. * @retval None
  74. */
  75. static void ADC_ConfigADC(void)
  76. {
  77. /* Enable ADC1 clock */
  78. CLK_PeripheralClockConfig(CLK_Peripheral_ADC1, ENABLE);
  79. /* Initialize and configure ADC1 */
  80. ADC_Init(ADC1, ADC_ConversionMode_Single, ADC_Resolution_12Bit, ADC_Prescaler_1);
  81. ADC_SamplingTimeConfig(ADC1, ADC_Group_SlowChannels, ADC_SamplingTime_384Cycles);
  82. ADC_SamplingTimeConfig(ADC1, ADC_Group_FastChannels, ADC_SamplingTime_384Cycles);
  83. /* Enable ADC1 */
  84. ADC_Cmd(ADC1, ENABLE);
  85. /* Enable ADC1 Voltage meter channel */
  86. ADC_ChannelCmd(ADC1, VOLTAGE_CHANNEL, ENABLE);
  87. ADC_SchmittTriggerConfig(ADC1, VOLTAGE_CHANNEL, DISABLE);
  88. /* Enable ADC1 Current meter channel */
  89. ADC_ChannelCmd(ADC1, CURRENT_CHANNEL, ENABLE);
  90. ADC_SchmittTriggerConfig(ADC1, CURRENT_CHANNEL, DISABLE);
  91. #ifdef ADC_MEASURE_REF_VOLT
  92. /* ADC Voltage Reference */
  93. ADC_VrefintCmd(ENABLE);
  94. /* Enable ADC1 Vrefint Channel */
  95. ADC_ChannelCmd(ADC1, ADC_Channel_Vrefint, ENABLE);
  96. #endif // ADC_MEASURE_REF_VOLT
  97. /* Enable ADC1 DMA requests*/
  98. ADC_DMACmd(ADC1, ENABLE);
  99. /* Start ADC1 Conversion using TIM1 TRGO*/
  100. ADC_ExternalTrigConfig(ADC1, ADC_ExtEventSelection_Trigger3, ADC_ExtTRGSensitivity_Rising);
  101. }
  102. /**
  103. * @brief Configure DMA peripheral
  104. * @param None
  105. * @retval None
  106. */
  107. static void ADC_ConfigDMA(void)
  108. {
  109. /* Enable DMA1 clock */
  110. CLK_PeripheralClockConfig(CLK_Peripheral_DMA1, ENABLE);
  111. /* Connect ADC to DMA channel 0 */
  112. SYSCFG_REMAPDMAChannelConfig(REMAP_DMA1Channel_ADC1ToChannel0);
  113. DMA_Init(DMA1_Channel0, ADC_BUFFER_ADDRESS,
  114. ADC1_DR_ADDRESS,
  115. ADC_BUFFER_SIZE,
  116. DMA_DIR_PeripheralToMemory,
  117. DMA_Mode_Circular,
  118. DMA_MemoryIncMode_Inc,
  119. DMA_Priority_High,
  120. DMA_MemoryDataSize_HalfWord);
  121. /* DMA Channel0 enable */
  122. DMA_Cmd(DMA1_Channel0, ENABLE);
  123. /* Enable DMA1 channel0 Transfer complete interrupt */
  124. DMA_ITConfig(DMA1_Channel0, DMA_ITx_TC, ENABLE);
  125. /* DMA enable */
  126. DMA_GlobalCmd(ENABLE);
  127. }
  128. /**
  129. * @brief Configure TIM2 peripheral
  130. * @param None
  131. * @retval None
  132. */
  133. static void ADC_ConfigTIM2(void)
  134. {
  135. /* Enable TIM2 clock */
  136. CLK_PeripheralClockConfig(CLK_Peripheral_TIM2, ENABLE);
  137. /* Initializes the TIM2 Time Base Unit */
  138. TIM2_TimeBaseInit(TIM_PRESCALER, TIM2_CounterMode_Up, TIM_PERIOD);
  139. /* Selects the TIM2 Update Request Interrupt source */
  140. TIM2_UpdateRequestConfig(TIM2_UpdateSource_Regular);
  141. /* Master Mode selection: Update event */
  142. TIM2_SelectOutputTrigger(TIM2_TRGOSource_Update);
  143. /* Enable TIM2 */
  144. TIM2_Cmd(ENABLE);
  145. }
  146. /**
  147. * @brief DMA1 channel0 and channel1 Interrupt routine.
  148. * @param None
  149. * @retval None
  150. */
  151. INTERRUPT_HANDLER(DMA1_CHANNEL0_1_IRQHandler,2)
  152. {
  153. static uint8_t idx = 0;
  154. static uint16_t va1=0, va2=0, ca1=0, ca2=0;
  155. if (ADC_Buffer[0] < va1 && ADC_Buffer[0] < va2) {
  156. VoltageFastBuffer[idx] = va1;
  157. } else if (ADC_Buffer[0] > va1 && ADC_Buffer[0] > va2) {
  158. VoltageFastBuffer[idx] = va1;
  159. } else {
  160. VoltageFastBuffer[idx] = ADC_Buffer[0];
  161. }
  162. va2 = va1;
  163. va1 = ADC_Buffer[0];
  164. if (ADC_Buffer[1] < ca1 && ADC_Buffer[1] < ca2) {
  165. CurrentFastBuffer[idx] = ca1;
  166. } else if (ADC_Buffer[1] > ca1 && ADC_Buffer[1] > ca2) {
  167. CurrentFastBuffer[idx] = ca1;
  168. } else {
  169. CurrentFastBuffer[idx] = ADC_Buffer[1];
  170. }
  171. ca2 = ca1;
  172. ca1 = ADC_Buffer[1];
  173. idx ++;
  174. if(idx >= FAST_BUFFER_SIZE) {
  175. idx = 0;
  176. }
  177. /* Clear IT Pending Bit */
  178. DMA1_Channel0->CSPR &= (uint8_t)~(uint8_t)(DMA1_IT_TC0 & (uint8_t)0x06);
  179. }
  180. /**
  181. * @brief Return average values from fast buffers
  182. * @param None
  183. * @retval Latest_Voltage
  184. */
  185. uint16_t * ADC_GetValues(void) {
  186. static uint16_t avgVal[ADC_BUFFER_SIZE];
  187. uint32_t volt=0, curr=0, shunt_volt=0;
  188. uint8_t i;
  189. /* Summarize buffers values */
  190. for(i=0;i<FAST_BUFFER_SIZE;i++){
  191. volt += VoltageFastBuffer[i];
  192. curr += CurrentFastBuffer[i];
  193. }
  194. curr += 4;
  195. curr /= 8;
  196. // компенсация смещения нуля ОУ
  197. if (curr > ADC_OU_ZERO_DRIFT) {
  198. curr -= ADC_OU_ZERO_DRIFT;
  199. curr *= ADC_REF;
  200. shunt_volt = curr;
  201. curr += ADC_ODIV_H; // для округления
  202. curr /= ADC_ODIV; // делим на К -- на выходе ток в мА
  203. /* так как шунт стоит в разрыве земли до выхода из БП
  204. компенсируем падение напряжения на нём. */
  205. shunt_volt += (ADC_OU_MUL/2);
  206. shunt_volt /= ADC_OU_MUL;
  207. // shunt_volt += ADC_ORES_H;
  208. // shunt_volt /= ADC_ORES; // мВ на входе ОУ
  209. // volt -= shunt_volt; // получили напряжение на клемах
  210. } else {
  211. curr = 0;
  212. }
  213. /* Попытка оверсемплинга, чтобы сделать шаг ~1мВ
  214. делим на 8, умножаем на опорное напряжение, умножаем на входной делитель
  215. и делим на (12 бит АЦП * 8). */
  216. volt += 4; // для округления
  217. volt /= 8; // усредняем
  218. volt *= ADC_REF;
  219. volt *= ADC_VOLT_K;
  220. volt -= shunt_volt;
  221. volt += ADC_ORES_H;
  222. volt /= ADC_ORES;
  223. avgVal[0] = (uint16_t)volt;
  224. avgVal[1] = (uint16_t)curr;
  225. return avgVal;
  226. }
  227. /**
  228. * @}
  229. */
  230. /************************ (C) Vladimir N. Shilov *****END OF FILE****/