zephyr/drivers/adc/adc_ite_it8xxx2.c

337 lines
8.4 KiB
C

/*
* Copyright (c) 2021 ITE Corporation. All Rights Reserved.
*
* SPDX-License-Identifier: Apache-2.0
*/
#define DT_DRV_COMPAT ite_it8xxx2_adc
#define LOG_LEVEL CONFIG_ADC_LOG_LEVEL
#include <logging/log.h>
LOG_MODULE_REGISTER(adc_ite_it8xxx2);
#include <drivers/adc.h>
#include <soc.h>
#include <errno.h>
#include <assert.h>
#define ADC_CONTEXT_USES_KERNEL_TIMER
#include "adc_context.h"
#define DEV_DATA(dev) ((struct adc_it8xxx2_data * const)(dev)->data)
/* Data structure to define ADC channel control registers. */
struct adc_ctrl_t {
/* The voltage channel control register. */
volatile uint8_t *adc_ctrl;
/* The voltage channel data buffer MSB. */
volatile uint8_t *adc_datm;
/* The voltage channel data buffer LSB. */
volatile uint8_t *adc_datl;
};
/* Data structure of ADC channel control registers. */
static const struct adc_ctrl_t adc_ctrl_regs[] = {
{&IT83XX_ADC_VCH0CTL, &IT83XX_ADC_VCH0DATM, &IT83XX_ADC_VCH0DATL},
{&IT83XX_ADC_VCH1CTL, &IT83XX_ADC_VCH1DATM, &IT83XX_ADC_VCH1DATL},
{&IT83XX_ADC_VCH2CTL, &IT83XX_ADC_VCH2DATM, &IT83XX_ADC_VCH2DATL},
{&IT83XX_ADC_VCH3CTL, &IT83XX_ADC_VCH3DATM, &IT83XX_ADC_VCH3DATL},
{&IT83XX_ADC_VCH4CTL, &IT83XX_ADC_VCH4DATM, &IT83XX_ADC_VCH4DATL},
{&IT83XX_ADC_VCH5CTL, &IT83XX_ADC_VCH5DATM, &IT83XX_ADC_VCH5DATL},
{&IT83XX_ADC_VCH6CTL, &IT83XX_ADC_VCH6DATM, &IT83XX_ADC_VCH6DATL},
{&IT83XX_ADC_VCH7CTL, &IT83XX_ADC_VCH7DATM, &IT83XX_ADC_VCH7DATL},
};
/* List of ADC channels. */
enum chip_adc_channel {
CHIP_ADC_CH0 = 0,
CHIP_ADC_CH1,
CHIP_ADC_CH2,
CHIP_ADC_CH3,
CHIP_ADC_CH4,
CHIP_ADC_CH5,
CHIP_ADC_CH6,
CHIP_ADC_CH7,
CHIP_ADC_COUNT,
};
struct adc_it8xxx2_data {
struct adc_context ctx;
/* Save ADC result to the buffer. */
uint16_t *buffer;
/*
* The sample buffer pointer should be prepared
* for writing of next sampling results.
*/
uint16_t *repeat_buffer;
};
static int adc_it8xxx2_channel_setup(const struct device *dev,
const struct adc_channel_cfg *channel_cfg)
{
ARG_UNUSED(dev);
if (channel_cfg->acquisition_time != ADC_ACQ_TIME_DEFAULT) {
LOG_ERR("Selected ADC acquisition time is not valid");
return -EINVAL;
}
if (channel_cfg->channel_id >= CHIP_ADC_COUNT) {
LOG_ERR("Channel %d is not valid", channel_cfg->channel_id);
return -EINVAL;
}
if (channel_cfg->gain != ADC_GAIN_1) {
LOG_ERR("Invalid channel gain");
return -EINVAL;
}
if (channel_cfg->reference != ADC_REF_INTERNAL) {
LOG_ERR("Invalid channel reference");
return -EINVAL;
}
if (channel_cfg->channel_id < CHIP_ADC_CH4) {
/* For channel 0 ~ 3 control register. */
*adc_ctrl_regs[channel_cfg->channel_id].adc_ctrl =
(IT83XX_ADC_DATVAL | IT83XX_ADC_INTDVEN) +
channel_cfg->channel_id;
} else {
/* For channel 4 ~ 7 control register. */
*adc_ctrl_regs[channel_cfg->channel_id].adc_ctrl =
IT83XX_ADC_DATVAL | IT83XX_ADC_INTDVEN | IT83XX_ADC_VCHEN;
}
LOG_DBG("Channel setup succeeded!");
return 0;
}
static uint8_t count_channels(uint8_t ch)
{
uint8_t count = 0;
uint8_t bit;
bit = find_lsb_set(ch);
while (bit != 0) {
uint8_t idx = bit - 1;
ch &= ~BIT(idx);
bit = find_lsb_set(ch);
count++;
}
return count;
}
static int check_buffer_size(const struct adc_sequence *sequence,
uint8_t active_channels)
{
size_t needed_buffer_size;
needed_buffer_size = active_channels * sizeof(uint16_t);
if (sequence->options) {
needed_buffer_size *= (1 + sequence->options->extra_samplings);
}
if (sequence->buffer_size < needed_buffer_size) {
LOG_ERR("Provided buffer is too small (%u/%u)",
sequence->buffer_size, needed_buffer_size);
return -ENOMEM;
}
return 0;
}
static int adc_it8xxx2_start_read(const struct device *dev,
const struct adc_sequence *sequence)
{
struct adc_it8xxx2_data *data = DEV_DATA(dev);
uint8_t channels = sequence->channels;
uint8_t channel_count;
int err;
if (!channels || channels & ~BIT_MASK(CHIP_ADC_COUNT)) {
LOG_ERR("Invalid selection of channels");
return -EINVAL;
}
if (!sequence->resolution) {
LOG_ERR("ADC resolution is not valid");
return -EINVAL;
}
LOG_DBG("Configure resolution=%d", sequence->resolution);
channel_count = count_channels(channels);
err = check_buffer_size(sequence, channel_count);
if (err) {
return err;
}
data->buffer = sequence->buffer;
adc_context_start_read(&data->ctx, sequence);
return adc_context_wait_for_completion(&data->ctx);
}
static void adc_context_start_sampling(struct adc_context *ctx)
{
struct adc_it8xxx2_data *data =
CONTAINER_OF(ctx, struct adc_it8xxx2_data, ctx);
data->repeat_buffer = data->buffer;
/* enable adc interrupt */
irq_enable(DT_INST_IRQN(0));
/* ADC module enable */
IT83XX_ADC_ADCCFG |= IT83XX_ADC_ADCEN;
}
static int adc_it8xxx2_read(const struct device *dev,
const struct adc_sequence *sequence)
{
struct adc_it8xxx2_data *data = DEV_DATA(dev);
int err;
adc_context_lock(&data->ctx, false, NULL);
err = adc_it8xxx2_start_read(dev, sequence);
adc_context_release(&data->ctx, err);
return err;
}
static void adc_context_update_buffer_pointer(struct adc_context *ctx,
bool repeat_sampling)
{
struct adc_it8xxx2_data *data =
CONTAINER_OF(ctx, struct adc_it8xxx2_data, ctx);
if (repeat_sampling) {
data->buffer = data->repeat_buffer;
}
}
static int adc_data_valid(enum chip_adc_channel adc_ch)
{
return IT83XX_ADC_ADCDVSTS & BIT(adc_ch);
}
/* Get result for each ADC selected channel. */
static void adc_it8xxx2_get_sample(const struct device *dev)
{
struct adc_it8xxx2_data *data = DEV_DATA(dev);
uint8_t channels = data->ctx.sequence.channels;
uint8_t bit;
bool valid = false;
bit = find_lsb_set(channels);
while (bit != 0) {
uint8_t idx = bit - 1;
if (adc_data_valid(idx)) {
/* Read adc raw data of msb and lsb */
uint16_t val = (*adc_ctrl_regs[idx].adc_datm << 8) |
*adc_ctrl_regs[idx].adc_datl;
/* Raw data multiply resolution. */
*data->buffer++ = val * data->ctx.sequence.resolution;
/* W/C data valid flag */
IT83XX_ADC_ADCDVSTS = BIT(idx);
valid = 1;
}
if (!valid) {
LOG_WRN("ADC failed to read (regs=%x, ch=%d)",
IT83XX_ADC_ADCDVSTS, idx);
}
channels &= ~BIT(idx);
bit = find_lsb_set(channels);
}
/* ADC module disable */
IT83XX_ADC_ADCCFG &= ~IT83XX_ADC_ADCEN;
/* disable adc interrupt */
irq_disable(DT_INST_IRQN(0));
}
static void adc_it8xxx2_isr(const void *arg)
{
struct device *dev = (struct device *)arg;
struct adc_it8xxx2_data *data = DEV_DATA(dev);
LOG_DBG("ADC ISR triggered.");
adc_it8xxx2_get_sample(dev);
adc_context_on_sampling_done(&data->ctx, dev);
}
static const struct adc_driver_api api_it8xxx2_driver_api = {
.channel_setup = adc_it8xxx2_channel_setup,
.read = adc_it8xxx2_read,
};
/*
* ADC analog accuracy initialization (only once after VSTBY power on)
*
* Write 1 to this bit and write 0 to this bit immediately once and
* only once during the firmware initialization and do not write 1 again
* after initialization since IT83xx takes much power consumption
* if this bit is set as 1
*/
static void adc_accuracy_initialization(void)
{
/* Start adc accuracy initialization */
IT83XX_ADC_ADCSTS |= IT83XX_ADC_AINITB;
/* Enable automatic HW calibration. */
IT83XX_ADC_KDCTL |= IT83XX_ADC_AHCE;
/* short delay for adc accuracy initialization */
IT83XX_GCTRL_WNCKR = 0;
/* Stop adc accuracy initialization */
IT83XX_ADC_ADCSTS &= ~IT83XX_ADC_AINITB;
}
static int adc_it8xxx2_init(const struct device *dev)
{
struct adc_it8xxx2_data *data = DEV_DATA(dev);
/* ADC analog accuracy initialization */
adc_accuracy_initialization();
/*
* The ADC channel conversion time is 30.8*(SCLKDIV+1) us.
* (Current setting is 61.6us)
*
* NOTE: A sample time delay (60us) also need to be included in
* conversion time, so the final result is ~= 121.6us.
*/
IT83XX_ADC_ADCSTS &= ~IT83XX_ADC_ADCCTS1;
IT83XX_ADC_ADCCFG &= ~IT83XX_ADC_ADCCTS0;
/*
* bit[5-0]@ADCCTL : SCLKDIV
* SCLKDIV has to be equal to or greater than 1h;
*/
IT83XX_ADC_ADCCTL = 1;
IRQ_CONNECT(DT_INST_IRQN(0), DT_INST_IRQ(0, priority),
adc_it8xxx2_isr, DEVICE_DT_INST_GET(0), 0);
adc_context_unlock_unconditionally(&data->ctx);
return 0;
}
static struct adc_it8xxx2_data adc_it8xxx2_data_0 = {
ADC_CONTEXT_INIT_TIMER(adc_it8xxx2_data_0, ctx),
ADC_CONTEXT_INIT_LOCK(adc_it8xxx2_data_0, ctx),
ADC_CONTEXT_INIT_SYNC(adc_it8xxx2_data_0, ctx),
};
DEVICE_DT_INST_DEFINE(0, adc_it8xxx2_init,
NULL,
&adc_it8xxx2_data_0,
NULL, POST_KERNEL,
CONFIG_KERNEL_INIT_PRIORITY_DEVICE,
&api_it8xxx2_driver_api);