zephyr/drivers/counter/counter_realtek_rts5912.c
jhan bo chao 85dc257072 drivers: counter: rts5912: clear pending irq when setup
clear pending irq when setup.

Signed-off-by: jhan bo chao <jhan_bo_chao@realtek.com>
2025-05-22 20:57:15 +02:00

358 lines
11 KiB
C

/*
* Copyright (c) 2025 Realtek Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#define DT_DRV_COMPAT realtek_rts5912_timer
/**
* @file
* @brief Realtek RTS5912 Counter driver
*
* This is the driver for the 32-bit counters on the Realtek SoCs.
*
* Notes:
* - The counters are running in down counting mode.
* - Interrupts are triggered (if enabled) when the counter
* reaches zero.
* - These are not free running counters where there are separate
* compare values for interrupts. When setting single shot alarms,
* the counter values are changed so that interrupts are triggered
* when the counters reach zero.
*/
#include <zephyr/kernel.h>
#include <zephyr/drivers/counter.h>
#include <zephyr/drivers/clock_control.h>
#include <zephyr/drivers/clock_control/clock_control_rts5912.h>
#include "reg/reg_timer.h"
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(counter_realtek_rts5912, CONFIG_COUNTER_LOG_LEVEL);
struct counter_rts5912_config {
struct counter_config_info info;
void (*config_func)(void);
volatile struct timer32_type *base_address;
uint16_t prescaler;
uint32_t clk_grp;
uint32_t clk_idx;
const struct device *clk_dev;
};
struct counter_rts5912_data {
counter_alarm_callback_t alarm_cb;
counter_top_callback_t top_cb;
void *user_data;
};
#define COUNTER_RTS5912_REG_BASE(_dev) \
((const struct counter_rts5912_config *const)_dev->config)->base_address
static int counter_rts5912_start(const struct device *dev)
{
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
if (counter->ctrl & TIMER32_CTRL_EN) {
return 0;
}
counter->ctrl |= (TIMER32_CTRL_EN);
LOG_DBG("%p Counter started", dev);
return 0;
}
static int counter_rts5912_stop(const struct device *dev)
{
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
if (!(counter->ctrl & TIMER32_CTRL_EN)) {
/* Already stopped, nothing to do */
return 0;
}
/* disable timer and disable interrupt. */
counter->ctrl = TIMER32_CTRL_INTEN_DIS;
counter->cnt = counter->ldcnt;
/* w1c interrupt pending status */
counter->intclr |= TIMER32_INTCLR_INTCLR;
LOG_DBG("%p Counter stopped", dev);
return 0;
}
static int counter_rts5912_get_value(const struct device *dev, uint32_t *ticks)
{
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
*ticks = counter->cnt + 1;
return 0;
}
static int counter_rts5912_set_alarm(const struct device *dev, uint8_t chan_id,
const struct counter_alarm_cfg *alarm_cfg)
{
struct counter_rts5912_data *data = dev->data;
const struct counter_rts5912_config *counter_cfg = dev->config;
volatile struct timer32_type *counter = counter_cfg->base_address;
uint32_t value;
if (chan_id != 0) {
LOG_ERR("Invalid channel id %u", chan_id);
return -ENOTSUP;
}
/* Interrupts are only triggered when the counter reaches 0.
* So only relative alarms are supported.
*/
if (alarm_cfg->flags & COUNTER_ALARM_CFG_ABSOLUTE) {
return -ENOTSUP;
}
if (data->alarm_cb != NULL) {
return -EBUSY;
}
if (!alarm_cfg->callback) {
return -EINVAL;
}
if (alarm_cfg->ticks > counter_cfg->info.max_top_value) {
return -EINVAL;
}
/* disable timer */
counter->ctrl &= ~TIMER32_CTRL_EN;
/* disable interrupt */
counter->ctrl |= TIMER32_CTRL_INTEN_DIS;
/* set in one-shot mode */
counter->ctrl &= ~TIMER32_CTRL_MDSELS_PERIOD;
/* set load counter */
counter->ldcnt = alarm_cfg->ticks;
data->alarm_cb = alarm_cfg->callback;
data->user_data = alarm_cfg->user_data;
/* w1c interrupt status */
counter->intclr |= TIMER32_INTCLR_INTCLR;
/* enable interrupt */
counter->ctrl &= ~TIMER32_CTRL_INTEN_DIS;
LOG_DBG("%p Counter alarm set to %u ticks", dev, alarm_cfg->ticks);
/* enable timer and re-load PRCNT to CNT */
counter->ctrl |= TIMER32_CTRL_EN;
/* read count value to update register */
value = counter->cnt;
return 0;
}
static int counter_rts5912_cancel_alarm(const struct device *dev, uint8_t chan_id)
{
struct counter_rts5912_data *data = dev->data;
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
if (chan_id != 0) {
LOG_ERR("Invalid channel id %u", chan_id);
return -ENOTSUP;
}
counter->ctrl = 0;
data->alarm_cb = NULL;
data->user_data = NULL;
LOG_DBG("%p Counter alarm canceled", dev);
return 0;
}
static uint32_t counter_rts5912_get_pending_int(const struct device *dev)
{
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
return counter->intsts;
}
static uint32_t counter_rts5912_get_top_value(const struct device *dev)
{
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
return counter->ldcnt;
}
static int counter_rts5912_set_top_value(const struct device *dev,
const struct counter_top_cfg *cfg)
{
const struct counter_rts5912_config *counter_cfg = dev->config;
struct counter_rts5912_data *data = dev->data;
volatile struct timer32_type *counter = counter_cfg->base_address;
uint32_t value;
int ret = 0;
if (data->alarm_cb) {
return -EBUSY;
}
if (cfg->ticks > counter_cfg->info.max_top_value) {
return -EINVAL;
}
counter->ctrl &= ~TIMER32_CTRL_EN;
counter->ctrl |= TIMER32_CTRL_INTEN_DIS;
counter->ldcnt = cfg->ticks;
data->top_cb = cfg->callback;
data->user_data = cfg->user_data;
if (data->top_cb) {
/* w1c interrupt status */
counter->intclr |= TIMER32_INTCLR_INTCLR;
/* enable interrupt */
counter->ctrl &= ~TIMER32_CTRL_INTEN_DIS;
/* enable periodic alarm mode */
counter->ctrl |= TIMER32_CTRL_MDSELS_PERIOD;
} else {
counter->ctrl = TIMER32_CTRL_INTEN_DIS;
}
LOG_DBG("%p Counter top value was set to %u", dev, cfg->ticks);
counter->ctrl |= TIMER32_CTRL_EN;
/* read count value to update register */
value = counter->cnt;
return ret;
}
static void counter_rts5912_isr(const struct device *dev)
{
struct counter_rts5912_data *data = dev->data;
const struct counter_rts5912_config *config = dev->config;
volatile struct timer32_type *counter = config->base_address;
counter_alarm_callback_t alarm_cb;
void *user_data;
uint32_t value;
/* disable timer */
counter->ctrl &= ~TIMER32_CTRL_EN;
/* disable interrupt */
counter->ctrl |= TIMER32_CTRL_INTEN_DIS;
/* clear interrupt pending status */
counter->intclr |= TIMER32_INTCLR_INTCLR;
LOG_DBG("%p Counter ISR", dev);
if (data->alarm_cb) {
/* Alarm is one-shot, so disable callback */
alarm_cb = data->alarm_cb;
data->alarm_cb = NULL;
user_data = data->user_data;
alarm_cb(dev, 0, counter->cnt + 1, user_data);
} else if (data->top_cb) {
data->top_cb(dev, data->user_data);
/* periodic alarm mode, enable interrupt */
counter->ctrl &= ~TIMER32_CTRL_INTEN_DIS;
/* enable timer again */
counter->ctrl |= TIMER32_CTRL_EN;
/* read count value to update register */
value = counter->cnt;
}
}
static uint32_t counter_rts5912_get_freq(const struct device *dev)
{
const struct counter_rts5912_config *counter_cfg = dev->config;
return counter_cfg->info.freq;
}
static DEVICE_API(counter, counter_rts5912_api) = {
.start = counter_rts5912_start,
.stop = counter_rts5912_stop,
.get_value = counter_rts5912_get_value,
.set_alarm = counter_rts5912_set_alarm,
.cancel_alarm = counter_rts5912_cancel_alarm,
.set_top_value = counter_rts5912_set_top_value,
.get_pending_int = counter_rts5912_get_pending_int,
.get_top_value = counter_rts5912_get_top_value,
.get_freq = counter_rts5912_get_freq,
};
static int counter_rts5912_init(const struct device *dev)
{
const struct counter_rts5912_config *counter_cfg = dev->config;
volatile struct timer32_type *counter = counter_cfg->base_address;
int rc;
struct rts5912_sccon_subsys sccon_subsys = {
.clk_grp = counter_cfg->clk_grp,
.clk_idx = counter_cfg->clk_idx,
};
if (!device_is_ready(counter_cfg->clk_dev)) {
LOG_ERR("device is not ready");
return -ENODEV;
}
rc = clock_control_on(counter_cfg->clk_dev, (clock_control_subsys_t)&sccon_subsys);
if (rc != 0) {
LOG_ERR("clock power on fail");
return rc;
}
counter_rts5912_stop(dev);
/* Set preload and actually pre-load the counter */
counter->ldcnt = counter_cfg->info.max_top_value;
counter->cnt = counter_cfg->info.max_top_value;
counter_cfg->config_func();
LOG_DBG("Init complete!");
return 0;
}
#define DEV_CONFIG_CLK_DEV_INIT(n) \
.clk_dev = DEVICE_DT_GET(DT_INST_CLOCKS_CTLR(n)), \
.clk_grp = DT_INST_CLOCKS_CELL_BY_NAME(n, tmr32, clk_grp), \
.clk_idx = DT_INST_CLOCKS_CELL_BY_NAME(n, tmr32, clk_idx),
#define COUNTER_RTS5912_INIT(inst) \
static void counter_rts5912_irq_config_##inst(void); \
\
static struct counter_rts5912_data counter_rts5912_dev_data_##inst; \
\
static struct counter_rts5912_config counter_rts5912_dev_config_##inst = { \
.info = \
{ \
.max_top_value = DT_INST_PROP(inst, max_value), \
.freq = DT_INST_PROP(inst, clock_frequency) / \
(1 << DT_INST_PROP(inst, prescaler)), \
.flags = 0, \
.channels = 1, \
}, \
\
.config_func = counter_rts5912_irq_config_##inst, \
.base_address = (struct timer32_type *)DT_INST_REG_ADDR(inst), \
.prescaler = DT_INST_PROP(inst, prescaler), \
DEV_CONFIG_CLK_DEV_INIT(inst)}; \
\
DEVICE_DT_INST_DEFINE(inst, counter_rts5912_init, NULL, &counter_rts5912_dev_data_##inst, \
&counter_rts5912_dev_config_##inst, PRE_KERNEL_1, \
CONFIG_COUNTER_INIT_PRIORITY, &counter_rts5912_api); \
\
static void counter_rts5912_irq_config_##inst(void) \
{ \
NVIC_ClearPendingIRQ(DT_INST_IRQN(inst)); \
IRQ_CONNECT(DT_INST_IRQN(inst), DT_INST_IRQ(inst, priority), counter_rts5912_isr, \
DEVICE_DT_INST_GET(inst), 0); \
irq_enable(DT_INST_IRQN(inst)); \
}
DT_INST_FOREACH_STATUS_OKAY(COUNTER_RTS5912_INIT)