| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129 |
- #include "bsp/adc.h"
- #include "libs/task.h"
- static void _gpio_init(void);
- static void _adc_insert_chan_init(void);
- static void _adc_regular_chan_init(void);
- void adc_init(void){
- /* init adc input gpio */
- _gpio_init();
- /* enable ADC1 clock */
- rcu_periph_clock_enable(RCU_ADC0);
- /* config ADC clock */
- rcu_adc_clock_config(RCU_CKADC_CKAPB2_DIV4); //APB2 clk 120M, adc clk 30M
- /* ADC mode config */
- adc_mode_config(ADC_MODE_FREE);
- /* ADC special function config */
- adc_special_function_config(ADC0, ADC_SCAN_MODE, DISABLE);
- adc_special_function_config(ADC0, ADC_CONTINUOUS_MODE, DISABLE);
- /* ADC data alignment config */
- adc_data_alignment_config(ADC0, ADC_DATAALIGN_RIGHT);
- /* init insert chans*/
- _adc_insert_chan_init();
- /* init regular chans*/
- _adc_regular_chan_init();
- /* enable ADC interface */
- adc_enable(ADC0);
- delay_ms(1);
- /* ADC calibration and reset calibration */
- adc_calibration_enable(ADC0);
- nvic_irq_enable(ADC0_1_IRQn, 0, 0);
- }
- static void _gpio_init(void) {
- rcu_periph_clock_enable(RCU_GPIOA);
- rcu_periph_clock_enable(RCU_GPIOB);
- 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);
- gpio_init(GPIOB, GPIO_MODE_AIN, GPIO_OSPEED_50MHZ, GPIO_PIN_0|GPIO_PIN_1);
- }
- static void _adc_insert_chan_init(void) {
- adc_discontinuous_mode_config(ADC0, ADC_INSERTED_CHANNEL, 1); //每次转化一个
- /* ADC channel length config */
- adc_channel_length_config(ADC0, ADC_INSERTED_CHANNEL, 2);
- /* ADC inserted channel config */
- adc_inserted_channel_config(ADC0, 0, VBUS_I_CHAN, ADC_SAMPLETIME_7POINT5);
- adc_inserted_channel_config(ADC0, 1, VBUS_I_CHAN, ADC_SAMPLETIME_7POINT5);
- /* ADC trigger config */
- adc_external_trigger_source_config(ADC0, ADC_INSERTED_CHANNEL, ADC0_1_EXTTRIG_INSERTED_T1_CH0);
- #if 0
- /* ADC external trigger enable */
- adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, ENABLE);
-
- /* clear the ADC flag */
- adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOC);
- adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOIC);
- /* enable ADC interrupt */
- adc_interrupt_enable(ADC0, ADC_INT_EOIC);
- #endif
- }
- static void _adc_regular_chan_init(void) {
- adc_discontinuous_mode_config(ADC0, ADC_REGULAR_CHANNEL, 1); //每次转化一个
- /* ADC channel length config */
- adc_channel_length_config(ADC0, ADC_REGULAR_CHANNEL, 1);
- adc_external_trigger_config(ADC0, ADC_REGULAR_CHANNEL, DISABLE);
- adc_regular_channel_config(ADC0, 0, MOTOR_TEMP_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 1, HANDLERBAR_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 2, VBUS_V_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 3, W_PHASE_V_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 4, V_PHASE_V_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 5, U_PHASE_V_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 6, W_PHASE_I_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 7, V_PHASE_I_CHAN, ADC_SAMPLETIME_55POINT5);
- adc_regular_channel_config(ADC0, 8, U_PHASE_I_CHAN, ADC_SAMPLETIME_55POINT5);
- }
- s32 adc_sample_insert_chan(void) {
- adc_interrupt_disable(ADC0, ADC_INT_EOIC);
- adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, DISABLE);
- adc_software_trigger_enable(ADC0, 0);
- while(SET != adc_inserted_data_read(ADC0, 0));
- return adc_inserted_data_read(ADC0, 0);
- }
- void adc_start_insert_chan(void) {
- /* ADC external trigger enable */
- adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, ENABLE);
-
- /* clear the ADC flag */
- adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOC);
- adc_interrupt_flag_clear(ADC0, ADC_INT_FLAG_EOIC);
- /* enable ADC interrupt */
- adc_interrupt_enable(ADC0, ADC_INT_EOIC);
- }
- s32 adc_sample_regular_chan(int chan, int times) {
- int value = 0;
- int count = 0;
- int min = 0xFFFFF;
- int max = -0xFFFFF;
- u64 start_time;
- while(count < times){
- restart:
- start_time = get_mseconds();
- adc_software_trigger_enable(ADC0, ADC_REGULAR_CHANNEL);
- while(SET != adc_flag_get(ADC0, ADC_FLAG_EOC)){
- if (get_mseconds() - start_time >= 2){
- goto restart;
- }
- };
- int one = adc_regular_data_read(ADC0);
- adc_flag_clear(ADC0, ADC_FLAG_EOC);
- value += (one & 0xFFF);
- count ++;
- if (one > max){
- max = one;
- }
- if (one < min) {
- min = one;
- }
- }
- if (times <= 2) {
- return value/times;
- }
- return (value - min - max)/(times-2);
-
- }
|