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:
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_XEC adc_mchp_xec.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)
|
||||
|
|
|
@ -59,4 +59,6 @@ source "drivers/adc/Kconfig.xec"
|
|||
|
||||
source "drivers/adc/Kconfig.lmp90xxx"
|
||||
|
||||
source "drivers/adc/Kconfig.mcp320x"
|
||||
|
||||
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