You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
205 lines
5.7 KiB
205 lines
5.7 KiB
/* |
|
* Copyright (c) 2020 Vestas Wind Systems A/S |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
|
|
#define DT_DRV_COMPAT nxp_lptmr |
|
|
|
#include <zephyr/devicetree.h> |
|
#include <zephyr/sys/util.h> |
|
#include <zephyr/drivers/counter.h> |
|
#include <zephyr/irq.h> |
|
#include <fsl_lptmr.h> |
|
|
|
struct mcux_lptmr_config { |
|
struct counter_config_info info; |
|
LPTMR_Type *base; |
|
lptmr_prescaler_clock_select_t clk_source; |
|
lptmr_prescaler_glitch_value_t prescaler_glitch; |
|
bool bypass_prescaler_glitch; |
|
lptmr_timer_mode_t mode; |
|
lptmr_pin_select_t pin; |
|
lptmr_pin_polarity_t polarity; |
|
void (*irq_config_func)(const struct device *dev); |
|
}; |
|
|
|
struct mcux_lptmr_data { |
|
counter_top_callback_t top_callback; |
|
void *top_user_data; |
|
}; |
|
|
|
static int mcux_lptmr_start(const struct device *dev) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
|
|
LPTMR_EnableInterrupts(config->base, |
|
kLPTMR_TimerInterruptEnable); |
|
LPTMR_StartTimer(config->base); |
|
|
|
return 0; |
|
} |
|
|
|
static int mcux_lptmr_stop(const struct device *dev) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
|
|
LPTMR_DisableInterrupts(config->base, |
|
kLPTMR_TimerInterruptEnable); |
|
LPTMR_StopTimer(config->base); |
|
|
|
return 0; |
|
} |
|
|
|
static int mcux_lptmr_get_value(const struct device *dev, uint32_t *ticks) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
|
|
*ticks = LPTMR_GetCurrentTimerCount(config->base); |
|
|
|
return 0; |
|
} |
|
|
|
static int mcux_lptmr_set_top_value(const struct device *dev, |
|
const struct counter_top_cfg *cfg) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
struct mcux_lptmr_data *data = dev->data; |
|
|
|
if (cfg->ticks == 0) { |
|
return -EINVAL; |
|
} |
|
|
|
data->top_callback = cfg->callback; |
|
data->top_user_data = cfg->user_data; |
|
|
|
if (config->base->CSR & LPTMR_CSR_TEN_MASK) { |
|
/* Timer already enabled, check flags before resetting */ |
|
if (cfg->flags & COUNTER_TOP_CFG_DONT_RESET) { |
|
return -ENOTSUP; |
|
} |
|
LPTMR_StopTimer(config->base); |
|
LPTMR_SetTimerPeriod(config->base, cfg->ticks); |
|
LPTMR_StartTimer(config->base); |
|
} else { |
|
LPTMR_SetTimerPeriod(config->base, cfg->ticks); |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static uint32_t mcux_lptmr_get_pending_int(const struct device *dev) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
uint32_t mask = LPTMR_CSR_TCF_MASK | LPTMR_CSR_TIE_MASK; |
|
uint32_t flags; |
|
|
|
flags = LPTMR_GetStatusFlags(config->base); |
|
|
|
return ((flags & mask) == mask); |
|
} |
|
|
|
static uint32_t mcux_lptmr_get_top_value(const struct device *dev) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
|
|
return (config->base->CMR & LPTMR_CMR_COMPARE_MASK) + 1U; |
|
} |
|
|
|
static void mcux_lptmr_isr(const struct device *dev) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
struct mcux_lptmr_data *data = dev->data; |
|
uint32_t flags; |
|
|
|
flags = LPTMR_GetStatusFlags(config->base); |
|
LPTMR_ClearStatusFlags(config->base, flags); |
|
|
|
if (data->top_callback) { |
|
data->top_callback(dev, data->top_user_data); |
|
} |
|
} |
|
|
|
static int mcux_lptmr_init(const struct device *dev) |
|
{ |
|
const struct mcux_lptmr_config *config = dev->config; |
|
lptmr_config_t lptmr_config; |
|
|
|
LPTMR_GetDefaultConfig(&lptmr_config); |
|
lptmr_config.timerMode = config->mode; |
|
lptmr_config.enableFreeRunning = false; |
|
lptmr_config.prescalerClockSource = config->clk_source; |
|
lptmr_config.bypassPrescaler = config->bypass_prescaler_glitch; |
|
lptmr_config.value = config->prescaler_glitch; |
|
|
|
if (config->mode == kLPTMR_TimerModePulseCounter) { |
|
lptmr_config.pinSelect = config->pin; |
|
lptmr_config.pinPolarity = config->polarity; |
|
} |
|
|
|
LPTMR_Init(config->base, &lptmr_config); |
|
|
|
LPTMR_SetTimerPeriod(config->base, config->info.max_top_value); |
|
|
|
config->irq_config_func(dev); |
|
|
|
return 0; |
|
} |
|
|
|
static DEVICE_API(counter, mcux_lptmr_driver_api) = { |
|
.start = mcux_lptmr_start, |
|
.stop = mcux_lptmr_stop, |
|
.get_value = mcux_lptmr_get_value, |
|
.set_top_value = mcux_lptmr_set_top_value, |
|
.get_pending_int = mcux_lptmr_get_pending_int, |
|
.get_top_value = mcux_lptmr_get_top_value, |
|
}; |
|
|
|
#define COUNTER_MCUX_LPTMR_DEVICE_INIT(n) \ |
|
static void mcux_lptmr_irq_config_##n(const struct device *dev) \ |
|
{ \ |
|
IRQ_CONNECT(DT_INST_IRQN(n), DT_INST_IRQ(n, priority), \ |
|
mcux_lptmr_isr, DEVICE_DT_INST_GET(n), 0); \ |
|
irq_enable(DT_INST_IRQN(n)); \ |
|
} \ |
|
\ |
|
static struct mcux_lptmr_data mcux_lptmr_data_##n; \ |
|
static void mcux_lptmr_irq_config_##n(const struct device *dev); \ |
|
\ |
|
BUILD_ASSERT(!(DT_INST_PROP(n, timer_mode_sel) == 1 && \ |
|
DT_INST_PROP(n, prescale_glitch_filter) == 16), \ |
|
"Pulse mode cannot have a glitch value of 16"); \ |
|
\ |
|
BUILD_ASSERT(DT_INST_PROP(n, resolution) <= 32 && \ |
|
DT_INST_PROP(n, resolution) > 0, \ |
|
"LPTMR resolution property should be a width between 0 and 32");\ |
|
\ |
|
static struct mcux_lptmr_config mcux_lptmr_config_##n = { \ |
|
.info = { \ |
|
.max_top_value = \ |
|
GENMASK(DT_INST_PROP(n, resolution) - 1, 0), \ |
|
.freq = DT_INST_PROP(n, clock_frequency) / \ |
|
DT_INST_PROP(n, prescaler), \ |
|
.flags = COUNTER_CONFIG_INFO_COUNT_UP, \ |
|
.channels = 0, \ |
|
}, \ |
|
.base = (LPTMR_Type *)DT_INST_REG_ADDR(n), \ |
|
.clk_source = DT_INST_PROP(n, clk_source), \ |
|
.bypass_prescaler_glitch = \ |
|
1 - DT_INST_PROP(n, timer_mode_sel), \ |
|
.mode = DT_INST_PROP(n, timer_mode_sel), \ |
|
.pin = DT_INST_PROP_OR(n, input_pin, 0), \ |
|
.polarity = DT_INST_PROP(n, active_low), \ |
|
.prescaler_glitch = DT_INST_PROP(n, prescale_glitch_filter) + \ |
|
DT_INST_PROP(n, timer_mode_sel) - 1, \ |
|
.irq_config_func = mcux_lptmr_irq_config_##n, \ |
|
}; \ |
|
\ |
|
DEVICE_DT_INST_DEFINE(n, &mcux_lptmr_init, NULL, \ |
|
&mcux_lptmr_data_##n, \ |
|
&mcux_lptmr_config_##n, \ |
|
POST_KERNEL, CONFIG_COUNTER_INIT_PRIORITY, \ |
|
&mcux_lptmr_driver_api); |
|
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(COUNTER_MCUX_LPTMR_DEVICE_INIT)
|
|
|