drivers: adc: add Microchip MCP320x driver
Add driver for the Microchip MCP3204/MCP3208 12 bit ADCs with SPI interface. Signed-off-by: Henrik Brix Andersen <hebad@vestas.com>
This commit is contained in:
Henrik Brix Andersen
Ioannis Glaropoulos
parent
bc4a472a14
commit
53615ab11b
4 changed files with 409 additions and 0 deletions
|
|
@ -13,4 +13,5 @@ zephyr_library_sources_ifdef(CONFIG_ADC_SAM0 adc_sam0.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_ADC_STM32 adc_stm32.c)
|
zephyr_library_sources_ifdef(CONFIG_ADC_STM32 adc_stm32.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_ADC_XEC adc_mchp_xec.c)
|
zephyr_library_sources_ifdef(CONFIG_ADC_XEC adc_mchp_xec.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_ADC_LMP90XXX adc_lmp90xxx.c)
|
zephyr_library_sources_ifdef(CONFIG_ADC_LMP90XXX adc_lmp90xxx.c)
|
||||||
|
zephyr_library_sources_ifdef(CONFIG_ADC_MCP320X adc_mcp320x.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_USERSPACE adc_handlers.c)
|
zephyr_library_sources_ifdef(CONFIG_USERSPACE adc_handlers.c)
|
||||||
|
|
|
||||||
|
|
@ -59,4 +59,6 @@ source "drivers/adc/Kconfig.xec"
|
||||||
|
|
||||||
source "drivers/adc/Kconfig.lmp90xxx"
|
source "drivers/adc/Kconfig.lmp90xxx"
|
||||||
|
|
||||||
|
source "drivers/adc/Kconfig.mcp320x"
|
||||||
|
|
||||||
endif # ADC
|
endif # ADC
|
||||||
|
|
|
||||||
36
drivers/adc/Kconfig.mcp320x
Normal file
36
drivers/adc/Kconfig.mcp320x
Normal file
|
|
@ -0,0 +1,36 @@
|
||||||
|
# MCP320x ADC configuration options
|
||||||
|
|
||||||
|
# Copyright (c) 2020 Vestas Wind Systems A/S
|
||||||
|
# SPDX-License-Identifier: Apache-2.0
|
||||||
|
|
||||||
|
config ADC_MCP320X
|
||||||
|
bool "MCP3204/MCP3208 driver"
|
||||||
|
depends on SPI
|
||||||
|
help
|
||||||
|
Enable MCP3204/MCP3208 ADC driver.
|
||||||
|
|
||||||
|
The MCP3204/MCP3208 are 4/8 channel 12-bit A/D converters
|
||||||
|
with SPI interface.
|
||||||
|
|
||||||
|
if ADC_MCP320X
|
||||||
|
|
||||||
|
config ADC_MCP320X_INIT_PRIORITY
|
||||||
|
int "Init priority"
|
||||||
|
default 80
|
||||||
|
help
|
||||||
|
MCP320x ADC device driver initialization priority.
|
||||||
|
|
||||||
|
config ADC_MCP320X_ACQUISITION_THREAD_STACK_SIZE
|
||||||
|
int "Stack size for the ADC data acquisition thread"
|
||||||
|
default 512
|
||||||
|
help
|
||||||
|
Size of the stack used for the internal data acquisition
|
||||||
|
thread.
|
||||||
|
|
||||||
|
config ADC_MCP320X_ACQUISITION_THREAD_PRIO
|
||||||
|
int "Priority for the ADC data acquisition thread"
|
||||||
|
default 0
|
||||||
|
help
|
||||||
|
Priority level for the internal ADC data acquisition thread.
|
||||||
|
|
||||||
|
endif # ADC_MCP320X
|
||||||
370
drivers/adc/adc_mcp320x.c
Normal file
370
drivers/adc/adc_mcp320x.c
Normal file
|
|
@ -0,0 +1,370 @@
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2020 Vestas Wind Systems A/S
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file
|
||||||
|
* @brief ADC driver for the MCP3204/MCP3208 ADCs.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <drivers/adc.h>
|
||||||
|
#include <drivers/gpio.h>
|
||||||
|
#include <drivers/spi.h>
|
||||||
|
#include <kernel.h>
|
||||||
|
#include <logging/log.h>
|
||||||
|
#include <sys/byteorder.h>
|
||||||
|
#include <sys/util.h>
|
||||||
|
#include <zephyr.h>
|
||||||
|
|
||||||
|
LOG_MODULE_REGISTER(adc_mcp320x, CONFIG_ADC_LOG_LEVEL);
|
||||||
|
|
||||||
|
#define ADC_CONTEXT_USES_KERNEL_TIMER
|
||||||
|
#include "adc_context.h"
|
||||||
|
|
||||||
|
#define MCP320X_RESOLUTION 12U
|
||||||
|
|
||||||
|
struct mcp320x_config {
|
||||||
|
const char *spi_dev_name;
|
||||||
|
const char *spi_cs_dev_name;
|
||||||
|
u8_t spi_cs_pin;
|
||||||
|
struct spi_config spi_cfg;
|
||||||
|
u8_t channels;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct mcp320x_data {
|
||||||
|
struct adc_context ctx;
|
||||||
|
struct device *spi_dev;
|
||||||
|
struct spi_cs_control spi_cs;
|
||||||
|
u16_t *buffer;
|
||||||
|
u16_t *repeat_buffer;
|
||||||
|
u8_t channels;
|
||||||
|
u8_t differential;
|
||||||
|
struct k_thread thread;
|
||||||
|
struct k_sem sem;
|
||||||
|
|
||||||
|
K_THREAD_STACK_MEMBER(stack,
|
||||||
|
CONFIG_ADC_MCP320X_ACQUISITION_THREAD_STACK_SIZE);
|
||||||
|
};
|
||||||
|
|
||||||
|
static int mcp320x_channel_setup(struct device *dev,
|
||||||
|
const struct adc_channel_cfg *channel_cfg)
|
||||||
|
{
|
||||||
|
const struct mcp320x_config *config = dev->config->config_info;
|
||||||
|
struct mcp320x_data *data = dev->driver_data;
|
||||||
|
|
||||||
|
if (channel_cfg->gain != ADC_GAIN_1) {
|
||||||
|
LOG_ERR("unsupported channel gain '%d'", channel_cfg->gain);
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (channel_cfg->reference != ADC_REF_EXTERNAL0) {
|
||||||
|
LOG_ERR("unsupported channel reference '%d'",
|
||||||
|
channel_cfg->reference);
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (channel_cfg->acquisition_time != ADC_ACQ_TIME_DEFAULT) {
|
||||||
|
LOG_ERR("unsupported acquisition_time '%d'",
|
||||||
|
channel_cfg->acquisition_time);
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (channel_cfg->channel_id >= config->channels) {
|
||||||
|
LOG_ERR("unsupported channel id '%d'", channel_cfg->channel_id);
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
WRITE_BIT(data->differential, channel_cfg->channel_id,
|
||||||
|
channel_cfg->differential);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mcp320x_validate_buffer_size(struct device *dev,
|
||||||
|
const struct adc_sequence *sequence)
|
||||||
|
{
|
||||||
|
const struct mcp320x_config *config = dev->config->config_info;
|
||||||
|
u8_t channels = 0;
|
||||||
|
size_t needed;
|
||||||
|
u32_t mask;
|
||||||
|
|
||||||
|
for (mask = BIT(config->channels - 1); mask != 0; mask >>= 1) {
|
||||||
|
if (mask & sequence->channels) {
|
||||||
|
channels++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
needed = channels * sizeof(u16_t);
|
||||||
|
if (sequence->options) {
|
||||||
|
needed *= (1 + sequence->options->extra_samplings);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (sequence->buffer_size < needed) {
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mcp320x_start_read(struct device *dev,
|
||||||
|
const struct adc_sequence *sequence)
|
||||||
|
{
|
||||||
|
const struct mcp320x_config *config = dev->config->config_info;
|
||||||
|
struct mcp320x_data *data = dev->driver_data;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
if (sequence->resolution != MCP320X_RESOLUTION) {
|
||||||
|
LOG_ERR("unsupported resolution %d", sequence->resolution);
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (find_msb_set(sequence->channels) > config->channels) {
|
||||||
|
LOG_ERR("unsupported channels in mask: 0x%08x",
|
||||||
|
sequence->channels);
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = mcp320x_validate_buffer_size(dev, sequence);
|
||||||
|
if (err) {
|
||||||
|
LOG_ERR("buffer size too small");
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
data->buffer = sequence->buffer;
|
||||||
|
adc_context_start_read(&data->ctx, sequence);
|
||||||
|
|
||||||
|
return adc_context_wait_for_completion(&data->ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mcp320x_read_async(struct device *dev,
|
||||||
|
const struct adc_sequence *sequence,
|
||||||
|
struct k_poll_signal *async)
|
||||||
|
{
|
||||||
|
struct mcp320x_data *data = dev->driver_data;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
adc_context_lock(&data->ctx, async ? true : false, async);
|
||||||
|
err = mcp320x_start_read(dev, sequence);
|
||||||
|
adc_context_release(&data->ctx, err);
|
||||||
|
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mcp320x_read(struct device *dev,
|
||||||
|
const struct adc_sequence *sequence)
|
||||||
|
{
|
||||||
|
return mcp320x_read_async(dev, sequence, NULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void adc_context_start_sampling(struct adc_context *ctx)
|
||||||
|
{
|
||||||
|
struct mcp320x_data *data = CONTAINER_OF(ctx, struct mcp320x_data, ctx);
|
||||||
|
|
||||||
|
data->channels = ctx->sequence.channels;
|
||||||
|
data->repeat_buffer = data->buffer;
|
||||||
|
|
||||||
|
k_sem_give(&data->sem);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void adc_context_update_buffer_pointer(struct adc_context *ctx,
|
||||||
|
bool repeat_sampling)
|
||||||
|
{
|
||||||
|
struct mcp320x_data *data = CONTAINER_OF(ctx, struct mcp320x_data, ctx);
|
||||||
|
|
||||||
|
if (repeat_sampling) {
|
||||||
|
data->buffer = data->repeat_buffer;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mcp320x_read_channel(struct device *dev, u8_t channel, u16_t *result)
|
||||||
|
{
|
||||||
|
const struct mcp320x_config *config = dev->config->config_info;
|
||||||
|
struct mcp320x_data *data = dev->driver_data;
|
||||||
|
u8_t tx_bytes[2];
|
||||||
|
u8_t rx_bytes[2];
|
||||||
|
int err;
|
||||||
|
const struct spi_buf tx_buf[2] = {
|
||||||
|
{
|
||||||
|
.buf = tx_bytes,
|
||||||
|
.len = sizeof(tx_bytes)
|
||||||
|
},
|
||||||
|
{
|
||||||
|
.buf = NULL,
|
||||||
|
.len = 1
|
||||||
|
}
|
||||||
|
};
|
||||||
|
const struct spi_buf rx_buf[2] = {
|
||||||
|
{
|
||||||
|
.buf = NULL,
|
||||||
|
.len = 1
|
||||||
|
},
|
||||||
|
{
|
||||||
|
.buf = rx_bytes,
|
||||||
|
.len = sizeof(rx_bytes)
|
||||||
|
}
|
||||||
|
};
|
||||||
|
const struct spi_buf_set tx = {
|
||||||
|
.buffers = tx_buf,
|
||||||
|
.count = ARRAY_SIZE(tx_buf)
|
||||||
|
};
|
||||||
|
const struct spi_buf_set rx = {
|
||||||
|
.buffers = rx_buf,
|
||||||
|
.count = ARRAY_SIZE(rx_buf)
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Configuration bits consists of: 5 dummy bits + start bit +
|
||||||
|
* SGL/#DIFF bit + D2 + D1 + D0 + 6 dummy bits
|
||||||
|
*/
|
||||||
|
tx_bytes[0] = BIT(2) | channel >> 2;
|
||||||
|
tx_bytes[1] = channel << 6;
|
||||||
|
|
||||||
|
if ((data->differential & BIT(channel)) == 0) {
|
||||||
|
tx_bytes[0] |= BIT(1);
|
||||||
|
}
|
||||||
|
|
||||||
|
err = spi_transceive(data->spi_dev, &config->spi_cfg, &tx, &rx);
|
||||||
|
if (err) {
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
*result = sys_get_be16(rx_bytes);
|
||||||
|
*result &= BIT_MASK(MCP320X_RESOLUTION);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mcp320x_acquisition_thread(struct device *dev)
|
||||||
|
{
|
||||||
|
struct mcp320x_data *data = dev->driver_data;
|
||||||
|
u16_t result = 0;
|
||||||
|
u8_t channel;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
while (true) {
|
||||||
|
k_sem_take(&data->sem, K_FOREVER);
|
||||||
|
|
||||||
|
while (data->channels) {
|
||||||
|
channel = find_lsb_set(data->channels) - 1;
|
||||||
|
|
||||||
|
LOG_DBG("reading channel %d", channel);
|
||||||
|
|
||||||
|
err = mcp320x_read_channel(dev, channel, &result);
|
||||||
|
if (err) {
|
||||||
|
LOG_ERR("failed to read channel %d (err %d)",
|
||||||
|
channel, err);
|
||||||
|
adc_context_complete(&data->ctx, err);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOG_DBG("read channel %d, result = %d", channel,
|
||||||
|
result);
|
||||||
|
|
||||||
|
*data->buffer++ = result;
|
||||||
|
WRITE_BIT(data->channels, channel, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
adc_context_on_sampling_done(&data->ctx, dev);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int mcp320x_init(struct device *dev)
|
||||||
|
{
|
||||||
|
const struct mcp320x_config *config = dev->config->config_info;
|
||||||
|
struct mcp320x_data *data = dev->driver_data;
|
||||||
|
|
||||||
|
k_sem_init(&data->sem, 0, 1);
|
||||||
|
data->spi_dev = device_get_binding(config->spi_dev_name);
|
||||||
|
|
||||||
|
if (!data->spi_dev) {
|
||||||
|
LOG_ERR("SPI master device '%s' not found",
|
||||||
|
config->spi_dev_name);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (config->spi_cs_dev_name) {
|
||||||
|
data->spi_cs.gpio_dev =
|
||||||
|
device_get_binding(config->spi_cs_dev_name);
|
||||||
|
if (!data->spi_cs.gpio_dev) {
|
||||||
|
LOG_ERR("SPI CS GPIO device '%s' not found",
|
||||||
|
config->spi_cs_dev_name);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
data->spi_cs.gpio_pin = config->spi_cs_pin;
|
||||||
|
}
|
||||||
|
|
||||||
|
k_thread_create(&data->thread, data->stack,
|
||||||
|
CONFIG_ADC_MCP320X_ACQUISITION_THREAD_STACK_SIZE,
|
||||||
|
(k_thread_entry_t)mcp320x_acquisition_thread,
|
||||||
|
dev, NULL, NULL,
|
||||||
|
CONFIG_ADC_MCP320X_ACQUISITION_THREAD_PRIO,
|
||||||
|
0, K_NO_WAIT);
|
||||||
|
|
||||||
|
adc_context_unlock_unconditionally(&data->ctx);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct adc_driver_api mcp320x_adc_api = {
|
||||||
|
.channel_setup = mcp320x_channel_setup,
|
||||||
|
.read = mcp320x_read,
|
||||||
|
#ifdef CONFIG_ADC_ASYNC
|
||||||
|
.read_async = mcp320x_read_async,
|
||||||
|
#endif
|
||||||
|
};
|
||||||
|
|
||||||
|
#define DT_INST_MCP320X(inst, t) DT_INST(inst, microchip_mcp##t)
|
||||||
|
|
||||||
|
#define MCP320X_DEVICE(t, n, ch) \
|
||||||
|
static struct mcp320x_data mcp##t##_data_##n = { \
|
||||||
|
ADC_CONTEXT_INIT_TIMER(mcp##t##_data_##n, ctx), \
|
||||||
|
ADC_CONTEXT_INIT_LOCK(mcp##t##_data_##n, ctx), \
|
||||||
|
ADC_CONTEXT_INIT_SYNC(mcp##t##_data_##n, ctx), \
|
||||||
|
}; \
|
||||||
|
static const struct mcp320x_config mcp##t##_config_##n = { \
|
||||||
|
.spi_dev_name = DT_BUS_LABEL(DT_INST_MCP320X(n, t)), \
|
||||||
|
.spi_cs_dev_name = \
|
||||||
|
UTIL_AND( \
|
||||||
|
DT_SPI_DEV_HAS_CS_GPIOS(DT_INST_MCP320X(n, t)), \
|
||||||
|
DT_SPI_DEV_CS_GPIOS_LABEL(DT_INST_MCP320X(n, t)) \
|
||||||
|
), \
|
||||||
|
.spi_cs_pin = \
|
||||||
|
UTIL_AND( \
|
||||||
|
DT_SPI_DEV_HAS_CS_GPIOS(DT_INST_MCP320X(n, t)), \
|
||||||
|
DT_SPI_DEV_CS_GPIOS_PIN(DT_INST_MCP320X(n, t)) \
|
||||||
|
), \
|
||||||
|
.spi_cfg = { \
|
||||||
|
.operation = (SPI_OP_MODE_MASTER | SPI_TRANSFER_MSB | \
|
||||||
|
SPI_WORD_SET(8)), \
|
||||||
|
.frequency = DT_PROP(DT_INST_MCP320X(n, t), \
|
||||||
|
spi_max_frequency), \
|
||||||
|
.slave = DT_REG_ADDR(DT_INST_MCP320X(n, t)), \
|
||||||
|
.cs = &mcp##t##_data_##n.spi_cs, \
|
||||||
|
}, \
|
||||||
|
.channels = ch, \
|
||||||
|
}; \
|
||||||
|
DEVICE_AND_API_INIT(mcp##t##_##n, \
|
||||||
|
DT_LABEL(DT_INST_MCP320X(n, t)), \
|
||||||
|
&mcp320x_init, &mcp##t##_data_##n, \
|
||||||
|
&mcp##t##_config_##n, POST_KERNEL, \
|
||||||
|
CONFIG_ADC_MCP320X_INIT_PRIORITY, \
|
||||||
|
&mcp320x_adc_api)
|
||||||
|
|
||||||
|
/*
|
||||||
|
* MCP3204: 4 channels
|
||||||
|
*/
|
||||||
|
#define MCP3204_DEVICE(n) MCP320X_DEVICE(3204, n, 4)
|
||||||
|
|
||||||
|
/*
|
||||||
|
* MCP3208: 8 channels
|
||||||
|
*/
|
||||||
|
#define MCP3208_DEVICE(n) MCP320X_DEVICE(3208, n, 8)
|
||||||
|
|
||||||
|
#define DT_INST_MCP320X_FOREACH(t, inst_expr) \
|
||||||
|
UTIL_LISTIFY(DT_NUM_INST(microchip_mcp##t), DT_CALL_WITH_ARG, inst_expr)
|
||||||
|
|
||||||
|
DT_INST_MCP320X_FOREACH(3204, MCP3204_DEVICE);
|
||||||
|
DT_INST_MCP320X_FOREACH(3208, MCP3208_DEVICE);
|
||||||
Loading…
Add table
Add a link
Reference in a new issue