zephyr/drivers/adc/adc_smartbond_gpadc.c

/*
 * Copyright (c) 2023 Renesas Electronics Corporation
 *
 * SPDX-License-Identifier: Apache-2.0
 */

#define DT_DRV_COMPAT renesas_smartbond_adc

#define ADC_CONTEXT_USES_KERNEL_TIMER
#include <DA1469xAB.h>
#include <da1469x_pd.h>
#include "adc_context.h"
#include <zephyr/dt-bindings/adc/smartbond-adc.h>

#define LOG_LEVEL CONFIG_ADC_LOG_LEVEL
#include <zephyr/logging/log.h>
#include <zephyr/irq.h>
#include <zephyr/sys/math_extras.h>
#include <zephyr/drivers/clock_control.h>
#include <zephyr/drivers/clock_control/smartbond_clock_control.h>
#include <zephyr/drivers/gpio.h>
#include <zephyr/drivers/pinctrl.h>
#include <zephyr/pm/device.h>
#include <zephyr/pm/policy.h>
#include <zephyr/pm/device_runtime.h>

LOG_MODULE_REGISTER(adc_smartbond_adc);

struct adc_smartbond_cfg {
	const struct pinctrl_dev_config *pcfg;
};

struct adc_smartbond_data {
	struct adc_context ctx;

	/* Buffer to store channel data */
	uint16_t *buffer;
	/* Copy of channel mask from sequence */
	uint32_t channel_read_mask;
	/* Number of bits in sequence channels */
	uint8_t sequence_channel_count;
	/* Index in buffer to store current value to */
	uint8_t result_index;
};

#define SMARTBOND_ADC_CHANNEL_COUNT	8

/*
 * Channels are handled by software this array holds individual
 * settings for each channel that must be applied before conversion.
 */
struct adc_smartbond_channel_cfg {
	uint32_t gp_adc_ctrl_reg;
	uint32_t gp_adc_ctrl2_reg;
} m_channels[SMARTBOND_ADC_CHANNEL_COUNT];

/* Implementation of the ADC driver API function: adc_channel_setup. */
static int adc_smartbond_channel_setup(const struct device *dev,
				       const struct adc_channel_cfg *channel_cfg)
{
	uint8_t channel_id = channel_cfg->channel_id;
	struct adc_smartbond_channel_cfg *config = &m_channels[channel_id];

	if (channel_id >= SMARTBOND_ADC_CHANNEL_COUNT) {
		return -EINVAL;
	}

	if (channel_cfg->acquisition_time != ADC_ACQ_TIME_DEFAULT) {
		LOG_ERR("Selected ADC acquisition time is not valid");
		return -EINVAL;
	}

	if (channel_cfg->differential) {
		if (channel_cfg->input_positive != SMARTBOND_GPADC_P1_09 &&
		    channel_cfg->input_positive != SMARTBOND_GPADC_P0_08) {
			LOG_ERR("Differential channels supported only for P1_09 and P0_08");
			return -EINVAL;
		}
	}

	switch (channel_cfg->gain) {
	case ADC_GAIN_1_3:
		/* Turn on attenuator and increase sample time to 32 cycles */
		config->gp_adc_ctrl2_reg = 0x101;
		break;
	case ADC_GAIN_1:
		config->gp_adc_ctrl2_reg = 0;
		break;
	default:
		LOG_ERR("Selected ADC gain is not valid");
		return -EINVAL;
	}

	switch (channel_cfg->reference) {
	case ADC_REF_INTERNAL:
		break;
	default:
		LOG_ERR("Selected ADC reference is not valid");
		return -EINVAL;
	}

	config->gp_adc_ctrl_reg =
		channel_cfg->input_positive << GPADC_GP_ADC_CTRL_REG_GP_ADC_SEL_Pos;
	if (!channel_cfg->differential) {
		config->gp_adc_ctrl_reg |= GPADC_GP_ADC_CTRL_REG_GP_ADC_SE_Msk;
	}

	return 0;
}

static inline void gpadc_smartbond_pm_policy_state_lock_get(const struct device *dev,
					      struct adc_smartbond_data *data)
{
#if defined(CONFIG_PM_DEVICE)
	pm_device_runtime_get(dev);
	/*
	 * Prevent the SoC from entering the normal sleep state.
	 */
	pm_policy_state_lock_get(PM_STATE_STANDBY, PM_ALL_SUBSTATES);
#endif
}

static inline void gpadc_smartbond_pm_policy_state_lock_put(const struct device *dev,
					      struct adc_smartbond_data *data)
{
#if defined(CONFIG_PM_DEVICE)
	/*
	 * Allow the SoC to enter the normal sleep state once GPADC is done.
	 */
	pm_policy_state_lock_put(PM_STATE_STANDBY, PM_ALL_SUBSTATES);
	pm_device_runtime_put(dev);
#endif
}

#define PER_CHANNEL_ADC_CONFIG_MASK (GPADC_GP_ADC_CTRL_REG_GP_ADC_SEL_Msk |	\
				     GPADC_GP_ADC_CTRL_REG_GP_ADC_SE_Msk)

static int pop_count(uint32_t n)
{
	return __builtin_popcount(n);
}

static void adc_context_start_sampling(struct adc_context *ctx)
{
	uint32_t val;
	struct adc_smartbond_data *data =
		CONTAINER_OF(ctx, struct adc_smartbond_data, ctx);
	/* Extract lower channel from sequence mask */
	int current_channel = u32_count_trailing_zeros(data->channel_read_mask);

	if (ctx->sequence.calibrate) {
		/* TODO: Add calibration code */
	} else {
		val = GPADC->GP_ADC_CTRL_REG & ~PER_CHANNEL_ADC_CONFIG_MASK;
		val |= m_channels[current_channel].gp_adc_ctrl_reg;
		val |= GPADC_GP_ADC_CTRL_REG_GP_ADC_START_Msk |
		       GPADC_GP_ADC_CTRL_REG_GP_ADC_MINT_Msk;

		GPADC->GP_ADC_CTRL2_REG = m_channels[current_channel].gp_adc_ctrl2_reg;
		GPADC->GP_ADC_CTRL_REG = val;
	}
}

static void adc_context_update_buffer_pointer(struct adc_context *ctx,
					      bool repeat)
{
	struct adc_smartbond_data *data =
		CONTAINER_OF(ctx, struct adc_smartbond_data, ctx);

	if (!repeat) {
		data->buffer += data->sequence_channel_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 start_read(const struct device *dev,
		      const struct adc_sequence *sequence)
{
	int error;
	struct adc_smartbond_data *data = dev->data;

	if (sequence->oversampling > 7U) {
		LOG_ERR("Invalid oversampling");
		return -EINVAL;
	}

	if ((sequence->channels == 0) ||
	    ((sequence->channels & ~BIT_MASK(SMARTBOND_ADC_CHANNEL_COUNT)) != 0)) {
		LOG_ERR("Channel scanning is not supported");
		return -EINVAL;
	}

	if (sequence->resolution < 8 || sequence->resolution > 15) {
		LOG_ERR("ADC resolution value %d is not valid",
			sequence->resolution);
		return -EINVAL;
	}

	error = check_buffer_size(sequence, 1);
	if (error) {
		return error;
	}

	data->buffer = sequence->buffer;
	data->channel_read_mask = sequence->channels;
	data->sequence_channel_count = pop_count(sequence->channels);
	data->result_index = 0;

	adc_context_start_read(&data->ctx, sequence);

	error = adc_context_wait_for_completion(&data->ctx);
	return error;
}

static void adc_smartbond_isr(const struct device *dev)
{
	struct adc_smartbond_data *data = dev->data;
	int current_channel = u32_count_trailing_zeros(data->channel_read_mask);

	GPADC->GP_ADC_CLEAR_INT_REG = 0;
	/* Store current channel value, result is left justified, move bits right */
	data->buffer[data->result_index++] = ((uint16_t)GPADC->GP_ADC_RESULT_REG) >>
		(16 - data->ctx.sequence.resolution);
	/* Exclude channel from mask for further reading */
	data->channel_read_mask ^= 1 << current_channel;

	if (data->channel_read_mask == 0) {
		gpadc_smartbond_pm_policy_state_lock_put(dev, data);
		adc_context_on_sampling_done(&data->ctx, dev);
	} else {
		adc_context_start_sampling(&data->ctx);
	}

	LOG_DBG("%s ISR triggered.", dev->name);
}

/* Implementation of the ADC driver API function: adc_read. */
static int adc_smartbond_read(const struct device *dev,
			      const struct adc_sequence *sequence)
{
	int error;
	struct adc_smartbond_data *data = dev->data;

	adc_context_lock(&data->ctx, false, NULL);
	gpadc_smartbond_pm_policy_state_lock_get(dev, data);
	error = start_read(dev, sequence);
	adc_context_release(&data->ctx, error);

	return error;
}

#if defined(CONFIG_ADC_ASYNC)
/* Implementation of the ADC driver API function: adc_read_sync. */
static int adc_smartbond_read_async(const struct device *dev,
				    const struct adc_sequence *sequence,
				    struct k_poll_signal *async)
{
	struct adc_smartbond_data *data = dev->data;
	int error;

	adc_context_lock(&data->ctx, true, async);
	gpadc_smartbond_pm_policy_state_lock_get(dev, data);
	error = start_read(dev, sequence);
	adc_context_release(&data->ctx, error);

	return error;
}
#endif /* CONFIG_ADC_ASYNC */

static int gpadc_smartbond_resume(const struct device *dev)
{
	int ret, rate;
	const struct adc_smartbond_cfg *config = dev->config;
	const struct device *clock_dev = DEVICE_DT_GET(DT_NODELABEL(osc));

	da1469x_pd_acquire(MCU_PD_DOMAIN_PER);

	/* Get current clock to determine GP_ADC_EN_DEL */
	clock_control_get_rate(clock_dev, (clock_control_subsys_t)SMARTBOND_CLK_SYS_CLK, &rate);
	GPADC->GP_ADC_CTRL3_REG = (rate/1600000)&0xff;

	GPADC->GP_ADC_CTRL_REG = GPADC_GP_ADC_CTRL_REG_GP_ADC_EN_Msk;

	/*
	 * Configure dt provided device signals when available.
	 * pinctrl is optional so ENOENT is not setup failure.
	 */
	ret = pinctrl_apply_state(config->pcfg, PINCTRL_STATE_DEFAULT);
	if (ret < 0 && ret != -ENOENT) {
		/* Disable the GPADC LDO */
		GPADC->GP_ADC_CTRL_REG = 0;

		/* Release the peripheral domain */
		da1469x_pd_release(MCU_PD_DOMAIN_PER);

		LOG_ERR("ADC pinctrl setup failed (%d)", ret);
		return ret;
	}

	return 0;
}

#ifdef CONFIG_PM_DEVICE
static int gpadc_smartbond_suspend(const struct device *dev)
{
	int ret;
	const struct adc_smartbond_cfg *config = dev->config;

	/* Disable the GPADC LDO */
	GPADC->GP_ADC_CTRL_REG = 0;

	/* Release the peripheral domain */
	da1469x_pd_release(MCU_PD_DOMAIN_PER);

	/*
	 * Configure dt provided device signals for sleep.
	 * pinctrl is optional so ENOENT is not setup failure.
	 */
	ret = pinctrl_apply_state(config->pcfg, PINCTRL_STATE_SLEEP);
	if (ret < 0 && ret != -ENOENT) {
		LOG_WRN("Failed to configure the GPADC pins to inactive state");
		return ret;
	}

	return 0;
}

static int gpadc_smartbond_pm_action(const struct device *dev,
				   enum pm_device_action action)
{
	int ret;

	switch (action) {
	case PM_DEVICE_ACTION_RESUME:
		ret = gpadc_smartbond_resume(dev);
		break;
	case PM_DEVICE_ACTION_SUSPEND:
		ret = gpadc_smartbond_suspend(dev);
		break;
	default:
		return -ENOTSUP;
	}
	return ret;
}
#endif /* CONFIG_PM_DEVICE */

static int adc_smartbond_init(const struct device *dev)
{
	int ret;
	struct adc_smartbond_data *data = dev->data;

#ifdef CONFIG_PM_DEVICE_RUNTIME
	/* Make sure device state is marked as suspended */
	pm_device_init_suspended(dev);

	ret = pm_device_runtime_enable(dev);

#else
	ret = gpadc_smartbond_resume(dev);

#endif

	IRQ_CONNECT(DT_INST_IRQN(0), DT_INST_IRQ(0, priority),
		    adc_smartbond_isr, DEVICE_DT_INST_GET(0), 0);

	NVIC_ClearPendingIRQ(DT_INST_IRQN(0));
	NVIC_EnableIRQ(DT_INST_IRQN(0));

	adc_context_unlock_unconditionally(&data->ctx);

	return ret;
}

static const struct adc_driver_api adc_smartbond_driver_api = {
	.channel_setup = adc_smartbond_channel_setup,
	.read          = adc_smartbond_read,
#ifdef CONFIG_ADC_ASYNC
	.read_async    = adc_smartbond_read_async,
#endif
	.ref_internal  = 1200,
};

/*
 * There is only one instance on supported SoCs, so inst is guaranteed
 * to be 0 if any instance is okay. (We use adc_0 above, so the driver
 * is relying on the numeric instance value in a way that happens to
 * be safe.)
 *
 * Just in case that assumption becomes invalid in the future, we use
 * a BUILD_ASSERT().
 */
#define ADC_INIT(inst)							\
	BUILD_ASSERT((inst) == 0,					\
		     "multiple instances not supported");		\
	PINCTRL_DT_INST_DEFINE(inst);					\
	static const struct adc_smartbond_cfg adc_smartbond_cfg_##inst = {\
		.pcfg = PINCTRL_DT_INST_DEV_CONFIG_GET(inst),		\
	};								\
	static struct adc_smartbond_data adc_smartbond_data_##inst = {	\
		ADC_CONTEXT_INIT_TIMER(adc_smartbond_data_##inst, ctx),	\
		ADC_CONTEXT_INIT_LOCK(adc_smartbond_data_##inst, ctx),	\
		ADC_CONTEXT_INIT_SYNC(adc_smartbond_data_##inst, ctx),	\
	};								\
	PM_DEVICE_DT_INST_DEFINE(inst, gpadc_smartbond_pm_action);	\
	DEVICE_DT_INST_DEFINE(inst,					\
			      adc_smartbond_init,  \
				  PM_DEVICE_DT_INST_GET(inst),			\
			      &adc_smartbond_data_##inst,		\
			      &adc_smartbond_cfg_##inst,		\
			      POST_KERNEL,				\
			      CONFIG_ADC_INIT_PRIORITY,			\
			      &adc_smartbond_driver_api);

DT_INST_FOREACH_STATUS_OKAY(ADC_INIT)