drv_adc.c 3.2 KB
Newer Older
Z
ze9hyr 已提交
1
/*
A
ACM32_MCU 已提交
2
 * Copyright (c) 2006-2022, RT-Thread Development Team
Z
ze9hyr 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Change Logs:
 * Date           Author       Notes
 * 2021-08-23     AisinoChip   first implementation
 */

#include <board.h>
#include <rtdevice.h>

#define     ADC_NAME        "adc"

A
ACM32_MCU 已提交
16
#if defined(RT_USING_ADC)
Z
ze9hyr 已提交
17 18 19 20 21 22 23 24 25 26
#if defined(BSP_USING_ADC)

struct acm32_adc
{
    ADC_HandleTypeDef       handle;
    struct rt_adc_device    acm32_adc_device;
};

static struct acm32_adc acm32_adc_obj = {0};

A
ACM32_MCU 已提交
27
static rt_err_t _adc_enabled(struct rt_adc_device *device, rt_uint32_t channel, rt_bool_t enabled)
Z
ze9hyr 已提交
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
{
    struct acm32_adc *adcObj = RT_NULL;

    RT_ASSERT(device != RT_NULL);

    adcObj = rt_container_of(device, struct acm32_adc, acm32_adc_device);

    if (enabled)
    {
        /* channel enabled */
        if (0 != (adcObj->handle.Init.ChannelEn & (1 << channel)))
        {
            return RT_EOK;
        }

        adcObj->handle.Instance = ADC;
        adcObj->handle.Init.ClockDiv = ADC_CLOCK_DIV8;
        adcObj->handle.Init.ConConvMode = ADC_CONCONVMODE_DISABLE;
        adcObj->handle.Init.JChannelMode = ADC_JCHANNELMODE_DISABLE;
        adcObj->handle.Init.DiffMode = ADC_DIFFMODE_DISABLE;
        adcObj->handle.Init.DMAMode = ADC_DMAMODE_DISABLE;
        adcObj->handle.Init.OverMode = ADC_OVERMODE_DISABLE;
        adcObj->handle.Init.OverSampMode = ADC_OVERSAMPMODE_DISABLE;
        adcObj->handle.Init.AnalogWDGEn = ADC_ANALOGWDGEN_DISABLE;
        adcObj->handle.Init.ExTrigMode.ExTrigSel = ADC_SOFTWARE_START;
        adcObj->handle.Init.ChannelEn |= 1 << channel;

        HAL_ADC_Init(&adcObj->handle);

        adcObj->handle.ChannelNum ++;
    }
    else
    {
        /* channel disabled */
        if (0 == (adcObj->handle.Init.ChannelEn & (1 << channel)))
        {
            return RT_EOK;
        }
        adcObj->handle.Init.ChannelEn &= ~(1 << channel);
        adcObj->handle.ChannelNum --;
    }

    return RT_EOK;
}

A
ACM32_MCU 已提交
73
static rt_err_t _get_adc_value(struct rt_adc_device *device, rt_uint32_t channel, rt_uint32_t *value)
Z
ze9hyr 已提交
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
{
    struct acm32_adc *adcObj = RT_NULL;
    ADC_ChannelConfTypeDef channelConf = {0};

    RT_ASSERT(device != RT_NULL);
    RT_ASSERT(value != RT_NULL);
    if (channel > ADC_CHANNEL_15)
    {
        return -RT_ERROR;
    }
    *value = RT_UINT32_MAX;
    adcObj = rt_container_of(device, struct acm32_adc, acm32_adc_device);

    /* channel disabled */
    if (0 == (adcObj->handle.Init.ChannelEn & (1 << channel)))
    {
        return -RT_ERROR;
    }

    channelConf.Channel = channel;
    channelConf.RjMode = 0;
    channelConf.Sq = ADC_SEQUENCE_SQ1;
    channelConf.Smp = ADC_SMP_CLOCK_320;
    HAL_ADC_ConfigChannel(&adcObj->handle, &channelConf);

    if (HAL_OK != HAL_ADC_Polling(&adcObj->handle, (uint32_t *)value, 1, 100))
    {
        return -RT_ERROR;
    }
    *value &= ~(HAL_ADC_EOC_FLAG);

    return RT_EOK;
}

static const struct rt_adc_ops acm_adc_ops =
{
A
ACM32_MCU 已提交
110 111
    .enabled = _adc_enabled,
    .convert = _get_adc_value,
Z
ze9hyr 已提交
112 113
};

A
ACM32_MCU 已提交
114
static int rt_hw_adc_init(void)
Z
ze9hyr 已提交
115 116 117 118 119 120
{
    return rt_hw_adc_register(&acm32_adc_obj.acm32_adc_device,
                              ADC_NAME,
                              &acm_adc_ops,
                              RT_NULL);
}
A
ACM32_MCU 已提交
121
INIT_BOARD_EXPORT(rt_hw_adc_init);
Z
ze9hyr 已提交
122 123

#endif /* BSP_USING_ADC */
A
ACM32_MCU 已提交
124
#endif /* RT_USING_ADC */
Z
ze9hyr 已提交
125