118 lines
2.8 KiB
C
118 lines
2.8 KiB
C
/*
|
|
* Copyright (c) 2006-2024, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2024/02/22 flyingcys first version
|
|
*/
|
|
#include <rtthread.h>
|
|
#include <rtdevice.h>
|
|
#include "drv_adc.h"
|
|
|
|
#define DBG_LEVEL DBG_LOG
|
|
#include <rtdbg.h>
|
|
#define LOG_TAG "DRV.ADC"
|
|
|
|
struct cvi_adc_dev
|
|
{
|
|
struct rt_adc_device device;
|
|
const char *name;
|
|
rt_ubase_t base;
|
|
};
|
|
|
|
static struct cvi_adc_dev adc_dev_config[] =
|
|
{
|
|
{
|
|
.name = "adc1",
|
|
.base = SARADC_BASE
|
|
},
|
|
};
|
|
|
|
static rt_err_t _adc_enabled(struct rt_adc_device *device, rt_int8_t channel, rt_bool_t enabled)
|
|
{
|
|
struct cvi_adc_dev *adc_dev = (struct cvi_adc_dev *)device->parent.user_data;
|
|
uint32_t value;
|
|
|
|
RT_ASSERT(adc_dev != RT_NULL);
|
|
|
|
if (channel > SARADC_CH_MAX)
|
|
return -RT_EINVAL;
|
|
|
|
if (enabled)
|
|
{
|
|
//set channel
|
|
cvi_set_saradc_ctrl(adc_dev->base, (rt_uint32_t)channel << (SARADC_CTRL_SEL_POS + 1));
|
|
|
|
//set saradc clock cycle
|
|
cvi_set_cyc(adc_dev->base);
|
|
|
|
//start
|
|
cvi_set_saradc_ctrl(adc_dev->base, SARADC_CTRL_START);
|
|
LOG_D("enable saradc...");
|
|
}
|
|
else
|
|
{
|
|
cvi_reset_saradc_ctrl(adc_dev->base, (rt_uint32_t)channel << (SARADC_CTRL_SEL_POS + 1));
|
|
LOG_D("disable saradc...");
|
|
}
|
|
return RT_EOK;
|
|
}
|
|
|
|
static rt_err_t _adc_convert(struct rt_adc_device *device, rt_int8_t channel, rt_uint32_t *value)
|
|
{
|
|
struct cvi_adc_dev *adc_dev = (struct cvi_adc_dev *)device->parent.user_data;
|
|
rt_uint32_t result;
|
|
rt_uint32_t cnt = 0;
|
|
|
|
RT_ASSERT(adc_dev != RT_NULL);
|
|
|
|
if (channel > SARADC_CH_MAX)
|
|
return -RT_EINVAL;
|
|
|
|
while (cvi_get_saradc_status(adc_dev->base) & SARADC_STATUS_BUSY)
|
|
{
|
|
rt_thread_delay(10);
|
|
LOG_D("wait saradc ready");
|
|
cnt ++;
|
|
if (cnt > 100)
|
|
return -RT_ETIMEOUT;
|
|
}
|
|
|
|
result = mmio_read_32(adc_dev->base + SARADC_RESULT(channel - 1));
|
|
if (result & SARADC_RESULT_VALID)
|
|
{
|
|
*value = result & SARADC_RESULT_MASK;
|
|
LOG_D("saradc channel %d value: %04x", channel, *value);
|
|
}
|
|
else
|
|
{
|
|
LOG_E("saradc channel %d read failed. result:0x%04x", channel, result);
|
|
return -RT_ERROR;
|
|
}
|
|
return RT_EOK;
|
|
}
|
|
|
|
static const struct rt_adc_ops _adc_ops =
|
|
{
|
|
.enabled = _adc_enabled,
|
|
.convert = _adc_convert,
|
|
};
|
|
|
|
int rt_hw_adc_init(void)
|
|
{
|
|
rt_uint8_t i;
|
|
for (i = 0; i < sizeof(adc_dev_config) / sizeof(adc_dev_config[0]); i ++)
|
|
{
|
|
if (rt_hw_adc_register(&adc_dev_config[i].device, adc_dev_config[i].name, &_adc_ops, &adc_dev_config[i]) != RT_EOK)
|
|
{
|
|
LOG_E("%s register failed!", adc_dev_config[i].name);
|
|
return -RT_ERROR;
|
|
}
|
|
}
|
|
|
|
return RT_EOK;
|
|
}
|
|
INIT_BOARD_EXPORT(rt_hw_adc_init);
|