adc.c 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129
  1. #include "bsp/adc.h"
  2. #include "libs/task.h"
  3. static void _gpio_init(void);
  4. static void _adc_insert_chan_init(void);
  5. static void _adc_regular_chan_init(void);
  6. void adc_init(void){
  7. /* init adc input gpio */
  8. _gpio_init();
  9. /* enable ADC1 clock */
  10. rcu_periph_clock_enable(RCU_ADC0);
  11. /* config ADC clock */
  12. rcu_adc_clock_config(RCU_CKADC_CKAPB2_DIV4); //APB2 clk 120M, adc clk 30M
  13. /* ADC mode config */
  14. adc_mode_config(ADC_MODE_FREE);
  15. /* ADC special function config */
  16. adc_special_function_config(ADC0, ADC_SCAN_MODE, DISABLE);
  17. adc_special_function_config(ADC0, ADC_CONTINUOUS_MODE, DISABLE);
  18. /* ADC data alignment config */
  19. adc_data_alignment_config(ADC0, ADC_DATAALIGN_RIGHT);
  20. /* init insert chans*/
  21. _adc_insert_chan_init();
  22. /* init regular chans*/
  23. _adc_regular_chan_init();
  24. /* enable ADC interface */
  25. adc_enable(ADC0);
  26. delay_ms(1);
  27. /* ADC calibration and reset calibration */
  28. adc_calibration_enable(ADC0);
  29. nvic_irq_enable(ADC0_1_IRQn, 0, 0);
  30. }
  31. static void _gpio_init(void) {
  32. rcu_periph_clock_enable(RCU_GPIOA);
  33. rcu_periph_clock_enable(RCU_GPIOB);
  34. 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);
  35. gpio_init(GPIOB, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_0|GPIO_PIN_1);
  36. }
  37. static void _adc_insert_chan_init(void) {
  38. adc_discontinuous_mode_config(ADC0, ADC_INSERTED_CHANNEL, 1); //每次转化一个
  39. /* ADC channel length config */
  40. adc_channel_length_config(ADC0, ADC_INSERTED_CHANNEL, 2);
  41. /* ADC inserted channel config */
  42. adc_inserted_channel_config(ADC0, 0, VBUS_I_CHAN, ADC_SAMPLETIME_7POINT5);
  43. adc_inserted_channel_config(ADC0, 1, VBUS_I_CHAN, ADC_SAMPLETIME_7POINT5);
  44. /* ADC trigger config */
  45. adc_external_trigger_source_config(ADC0, ADC_INSERTED_CHANNEL, ADC0_1_EXTTRIG_INSERTED_T1_CH0);
  46. #if 0
  47. /* ADC external trigger enable */
  48. adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, ENABLE);
  49. /* clear the ADC flag */
  50. adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOC);
  51. adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOIC);
  52. /* enable ADC interrupt */
  53. adc_interrupt_enable(ADC0, ADC_INT_EOIC);
  54. #endif
  55. }
  56. static void _adc_regular_chan_init(void) {
  57. adc_discontinuous_mode_config(ADC0, ADC_REGULAR_CHANNEL, 1); //每次转化一个
  58. /* ADC channel length config */
  59. adc_channel_length_config(ADC0, ADC_REGULAR_CHANNEL, 1);
  60. adc_external_trigger_config(ADC0, ADC_REGULAR_CHANNEL, DISABLE);
  61. adc_regular_channel_config(ADC0, 0, MOTOR_TEMP_CHAN, ADC_SAMPLETIME_55POINT5);
  62. adc_regular_channel_config(ADC0, 1, HANDLERBAR_CHAN, ADC_SAMPLETIME_55POINT5);
  63. adc_regular_channel_config(ADC0, 2, VBUS_V_CHAN, ADC_SAMPLETIME_55POINT5);
  64. adc_regular_channel_config(ADC0, 3, W_PHASE_V_CHAN, ADC_SAMPLETIME_55POINT5);
  65. adc_regular_channel_config(ADC0, 4, V_PHASE_V_CHAN, ADC_SAMPLETIME_55POINT5);
  66. adc_regular_channel_config(ADC0, 5, U_PHASE_V_CHAN, ADC_SAMPLETIME_55POINT5);
  67. adc_regular_channel_config(ADC0, 6, W_PHASE_I_CHAN, ADC_SAMPLETIME_55POINT5);
  68. adc_regular_channel_config(ADC0, 7, V_PHASE_I_CHAN, ADC_SAMPLETIME_55POINT5);
  69. adc_regular_channel_config(ADC0, 8, U_PHASE_I_CHAN, ADC_SAMPLETIME_55POINT5);
  70. }
  71. s32 adc_sample_insert_chan(void) {
  72. adc_interrupt_disable(ADC0, ADC_INT_EOIC);
  73. adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, DISABLE);
  74. adc_software_trigger_enable(ADC0, 0);
  75. while(SET != adc_inserted_data_read(ADC0, 0));
  76. return adc_inserted_data_read(ADC0, 0);
  77. }
  78. void adc_start_insert_chan(void) {
  79. /* ADC external trigger enable */
  80. adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, ENABLE);
  81. /* clear the ADC flag */
  82. adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOC);
  83. adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOIC);
  84. /* enable ADC interrupt */
  85. adc_interrupt_enable(ADC0, ADC_INT_EOIC);
  86. }
  87. s32 adc_sample_regular_chan(int chan, int times) {
  88. int value = 0;
  89. int count = 0;
  90. int min = 0xFFFFF;
  91. int max = -0xFFFFF;
  92. u64 start_time;
  93. while(count < times){
  94. restart:
  95. start_time = get_mseconds();
  96. adc_software_trigger_enable(ADC0, ADC_REGULAR_CHANNEL);
  97. while(SET != adc_flag_get(ADC0, ADC_FLAG_EOC)){
  98. if (get_mseconds() - start_time >= 2){
  99. goto restart;
  100. }
  101. };
  102. int one = adc_regular_data_read(ADC0);
  103. adc_flag_clear(ADC0, ADC_FLAG_EOC);
  104. value += (one & 0xFFF);
  105. count ++;
  106. if (one > max){
  107. max = one;
  108. }
  109. if (one < min) {
  110. min = one;
  111. }
  112. }
  113. if (times <= 2) {
  114. return value/times;
  115. }
  116. return (value - min - max)/(times-2);
  117. }