drv_adc.c 3.6 KB
Newer Older
W
Wayne Lin 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
/**************************************************************************//**
* @copyright (C) 2020 Nuvoton Technology Corp. All rights reserved.
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date            Author       Notes
* 2020-9-16       Philo        First version
*
******************************************************************************/

#include <rtconfig.h>
#include <rtdevice.h>
#include "NuMicro.h"

#ifdef BSP_USING_ADC

/* Private define ---------------------------------------------------------------*/

/* Private Typedef --------------------------------------------------------------*/
struct nu_adc
{
    struct rt_adc_device dev;
    char *name;
    ADC_T *adc_base;
    int adc_reg_tab;
    int adc_max_ch_num;

};
typedef struct nu_adc *nu_adc_t;

/* Private functions ------------------------------------------------------------*/
static rt_err_t nu_adc_enabled(struct rt_adc_device *device, rt_uint32_t channel, rt_bool_t enabled);
static rt_err_t nu_get_adc_value(struct rt_adc_device *device, rt_uint32_t channel, rt_uint32_t *value);

/* Public functions ------------------------------------------------------------*/
int rt_hw_adc_init(void);

/* Private variables ------------------------------------------------------------*/

static struct nu_adc nu_adc_arr [] =
{
#if defined(BSP_USING_ADC0)
    {
        .name = "adc0",
        .adc_base = ADC,
        .adc_max_ch_num = 15,
    },
#endif

    {0}
};

static const struct rt_adc_ops nu_adc_ops =
{
    nu_adc_enabled,
    nu_get_adc_value,
};
typedef struct rt_adc_ops *rt_adc_ops_t;


/* nu_adc_enabled - Enable ADC clock and wait for ready */
static rt_err_t nu_adc_enabled(struct rt_adc_device *device, rt_uint32_t channel, rt_bool_t enabled)
{

    ADC_T *adc_base = ((nu_adc_t)device)->adc_base;
    int *padc_reg_tab = &((nu_adc_t)device)->adc_reg_tab;
    RT_ASSERT(device != RT_NULL);

    if (channel >= ((nu_adc_t)device)->adc_max_ch_num)
        return -(RT_EINVAL);

    if (enabled)
    {
        ADC_POWER_ON(adc_base);

        if (*padc_reg_tab == 0)
        {
            ADC_Open(adc_base, ADC_ADCR_DIFFEN_SINGLE_END, ADC_ADCR_ADMD_SINGLE, (0x1 << channel));
        }

        *padc_reg_tab |= (0x1 << channel);
    }
    else
    {
        *padc_reg_tab &= ~(0x1 << channel);

        if (*padc_reg_tab == 0)
        {
            ADC_Close(adc_base);
        }

        ADC_POWER_DOWN(adc_base);
    }

    return RT_EOK;
}

static rt_err_t nu_get_adc_value(struct rt_adc_device *device, rt_uint32_t channel, rt_uint32_t *value)
{

    RT_ASSERT(device != RT_NULL);
    RT_ASSERT(value != RT_NULL);

    ADC_T *adc_base = ((nu_adc_t)device)->adc_base;
    int *padc_reg_tab = &((nu_adc_t)device)->adc_reg_tab;

    if (channel >= ((nu_adc_t)device)->adc_max_ch_num)
    {
        *value = 0xFFFFFFFF;
        return -(RT_EINVAL);
    }

    if ((*padc_reg_tab & (1 << channel)) == 0)
    {
        *value = 0xFFFFFFFF;
        return -(RT_EBUSY);
    }

    ADC_SET_INPUT_CHANNEL(adc_base, (0x1<<channel));

    ADC_CLR_INT_FLAG(adc_base, ADC_ADF_INT);

    ADC_ENABLE_INT(adc_base, ADC_ADF_INT);

    ADC_START_CONV(adc_base);

    while (ADC_GET_INT_FLAG(adc_base, ADC_ADF_INT) == 0);

    *value = ADC_GET_CONVERSION_DATA(adc_base, channel);

    return RT_EOK;
}

int rt_hw_adc_init(void)
{
    rt_err_t result = RT_ERROR;
    int nu_sel = 0;

    while (nu_adc_arr[nu_sel].name != 0)
    {
        nu_adc_arr[nu_sel].adc_reg_tab = 0;

        result = rt_hw_adc_register(&nu_adc_arr[nu_sel].dev, nu_adc_arr[nu_sel].name, &nu_adc_ops, NULL);
        RT_ASSERT(result == RT_EOK);
        nu_sel++;
    }

    return (int)result;
}
INIT_BOARD_EXPORT(rt_hw_adc_init);


#endif //#if defined(BSP_USING_ADC)