adc.c 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186
  1. #include "bsp/bsp.h"
  2. #include "bsp/adc.h"
  3. #include "libs/utils.h"
  4. #include "os/os_task.h"
  5. #include "libs/logger.h"
  6. static void adc0_init(void){
  7. /* config ADC clock */
  8. rcu_adc_clock_config(RCU_CKADC_CKAPB2_DIV4); //APB2 clk 120M, adc clk 30M
  9. rcu_periph_clock_enable(RCU_ADC0);
  10. adc_deinit(ADC0);
  11. adc_mode_config(ADC_DAUL_INSERTED_PARALLEL);
  12. adc_special_function_config(ADC0, ADC_SCAN_MODE, DISABLE);
  13. adc_discontinuous_mode_config(ADC0, ADC_CHANNEL_DISCON_DISABLE, 0);
  14. /* configure ADC data alignment */
  15. adc_data_alignment_config(ADC0, ADC_DATAALIGN_RIGHT);
  16. /* configure ADC inserted channel length */
  17. adc_channel_length_config(ADC0, ADC_INSERTED_CHANNEL, 1);
  18. adc_inserted_channel_config(ADC0, 0, U_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  19. adc_update_insert_sample_time(ADC0, U_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  20. adc_update_insert_sample_time(ADC0, V_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  21. adc_update_insert_sample_time(ADC0, W_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  22. /* configure ADC inserted channel trigger */
  23. adc_external_trigger_source_config(ADC0, ADC_INSERTED_CHANNEL, ADC_TRIGGER_PHASE);
  24. /* ADC external trigger enable */
  25. adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, ENABLE);
  26. /* configure ADC regular channel trigger */
  27. adc_external_trigger_source_config(ADC0, ADC_REGULAR_CHANNEL, ADC0_1_2_EXTTRIG_REGULAR_NONE);
  28. adc_external_trigger_config(ADC0, ADC_REGULAR_CHANNEL, ENABLE);
  29. /* enable ADC interface */
  30. adc_enable(ADC0);
  31. delay_ms(1);
  32. /* ADC calibration and reset calibration */
  33. adc_calibration_enable(ADC0);
  34. nvic_irq_enable(ADC0_1_IRQn, ADC_IRQ_PRIORITY, 0);
  35. adc_disable_ext_trigger();
  36. }
  37. static void adc1_init(void){
  38. rcu_periph_clock_enable(RCU_ADC1);
  39. adc_deinit(ADC1);
  40. adc_special_function_config(ADC1, ADC_SCAN_MODE, DISABLE);
  41. adc_discontinuous_mode_config(ADC1, ADC_CHANNEL_DISCON_DISABLE, 0);
  42. /* configure ADC data alignment */
  43. adc_data_alignment_config(ADC1, ADC_DATAALIGN_RIGHT);
  44. /* configure ADC inserted channel length */
  45. adc_channel_length_config(ADC1, ADC_INSERTED_CHANNEL, 1);
  46. /* configure ADC inserted channel */
  47. adc_inserted_channel_config(ADC1, 0, V_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  48. adc_update_insert_sample_time(ADC1, U_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  49. adc_update_insert_sample_time(ADC1, V_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  50. adc_update_insert_sample_time(ADC1, W_PHASE_I_CHAN, ADC_SAMPLE_TIME);
  51. /* ADC external trigger enable */
  52. adc_external_trigger_source_config(ADC1, ADC_INSERTED_CHANNEL, ADC_TRIGGER_NONE);
  53. adc_external_trigger_config(ADC1, ADC_INSERTED_CHANNEL, ENABLE);
  54. /* enable ADC interface */
  55. adc_enable(ADC1);
  56. delay_ms(1);
  57. /* ADC calibration and reset calibration */
  58. adc_calibration_enable(ADC1);
  59. /* ADC software trigger enable */
  60. adc_software_trigger_enable(ADC1, ADC_INSERTED_CHANNEL);
  61. }
  62. static void adc_gpio_init(void) {
  63. rcu_periph_clock_enable(RCU_GPIOA);
  64. rcu_periph_clock_enable(RCU_GPIOB);
  65. rcu_periph_clock_enable(RCU_AF);
  66. #ifdef GD32_FOC_DEMO
  67. /* configure ADC pin, bus voltage sampling -- ADC_IN0(PA0) */
  68. gpio_init(GPIOA, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_0);
  69. /* configure ADC pin, temperature sampling -- ADC_IN11(PC1) */
  70. gpio_init(GPIOC, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_1);
  71. /* configure ADC pin, current sampling -- ADC_IN1(PA1) ADC_IN12(PC2) ADC_IN13(PC3) */
  72. gpio_init(GPIOA, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_1);
  73. gpio_init(GPIOC, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_2);
  74. gpio_init(GPIOC, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_3);
  75. #else
  76. gpio_init(GPIOA, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3|GPIO_PIN_4|GPIO_PIN_5|GPIO_PIN_6|GPIO_PIN_7);
  77. gpio_init(GPIOB, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_0|GPIO_PIN_1);
  78. #endif
  79. }
  80. void adc_init(void) {
  81. adc_gpio_init();
  82. adc0_init();
  83. adc1_init();
  84. }
  85. void adc_start_convert(void) {
  86. int drop = 2;
  87. /* clear the ADC flag */
  88. adc_flag_clear(ADC0, ADC_FLAG_EOIC);
  89. adc_flag_clear(ADC1, ADC_FLAG_EOIC);
  90. adc_enable_ext_trigger();
  91. while(drop-- > 0) {
  92. while (adc_flag_get(ADC0, ADC_FLAG_EOIC) == RESET);
  93. adc_flag_clear(ADC0, ADC_FLAG_EOIC);
  94. }
  95. /* enable ADC interrupt */
  96. adc_interrupt_enable(ADC0, ADC_INT_EOIC);
  97. adc_update_ext_trigger(ADC_TRIGGER_PHASE);
  98. //adc_enable_ext_trigger();
  99. }
  100. void adc_stop_convert(void) {
  101. adc_disable_ext_trigger();
  102. /* disable ADC interrupt */
  103. adc_interrupt_disable(ADC0, ADC_INT_EOIC);
  104. /* clear the ADC flag */
  105. adc_flag_clear(ADC0, ADC_FLAG_EOIC);
  106. adc_flag_clear(ADC1, ADC_FLAG_EOIC);
  107. }
  108. s32 adc_sample_regular_channel(int channel, int times) {
  109. #if 1
  110. u32 adc_device = ADC0;
  111. int value = 0;
  112. int count = 0;
  113. int min = 0xFFFFF;
  114. int max = -0xFFFFF;
  115. u64 start_time;
  116. adc_channel_length_config(adc_device, ADC_REGULAR_CHANNEL, 1);
  117. adc_regular_channel_config(adc_device, 0, channel, ADC_SAMPLETIME_55POINT5);
  118. while(count < times){
  119. restart:
  120. start_time = shark_get_mseconds();
  121. adc_software_trigger_enable(adc_device, ADC_REGULAR_CHANNEL);
  122. while(SET != adc_flag_get(adc_device, ADC_FLAG_EOC)){
  123. if (shark_get_mseconds() - start_time >= 2){
  124. goto restart;
  125. }
  126. };
  127. int one = adc_regular_data_read(adc_device);
  128. adc_flag_clear(adc_device, ADC_FLAG_EOC);
  129. value += (one & 0xFFF);
  130. count ++;
  131. if (one > max){
  132. max = one;
  133. }
  134. if (one < min) {
  135. min = one;
  136. }
  137. }
  138. if (times <= 2) {
  139. return value/times;
  140. }
  141. return (value - min - max)/(times-2);
  142. #else
  143. return 0;
  144. #endif
  145. }