drivers: pwm: add driver for the RV32M1 Timer/PWM module
Add driver for the OpenISA Timer/PWM (TPM) module present in the RV32M1 SoC. Signed-off-by: Henrik Brix Andersen <henrik@brixandersen.dk>
This commit is contained in:
Henrik Brix Andersen
Maureen Helm
parent
f3144644bd
commit
3e7ca8f2ad
4 changed files with 228 additions and 0 deletions
|
|
@ -15,6 +15,7 @@ zephyr_library_sources_ifdef(CONFIG_PWM_SAM pwm_sam.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_PWM_MCUX pwm_mcux.c)
|
zephyr_library_sources_ifdef(CONFIG_PWM_MCUX pwm_mcux.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_PWM_XEC pwm_mchp_xec.c)
|
zephyr_library_sources_ifdef(CONFIG_PWM_XEC pwm_mchp_xec.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_PWM_LITEX pwm_litex.c)
|
zephyr_library_sources_ifdef(CONFIG_PWM_LITEX pwm_litex.c)
|
||||||
|
zephyr_library_sources_ifdef(CONFIG_PWM_RV32M1_TPM pwm_rv32m1_tpm.c)
|
||||||
|
|
||||||
zephyr_library_sources_ifdef(CONFIG_USERSPACE pwm_handlers.c)
|
zephyr_library_sources_ifdef(CONFIG_USERSPACE pwm_handlers.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_PWM_SHELL pwm_shell.c)
|
zephyr_library_sources_ifdef(CONFIG_PWM_SHELL pwm_shell.c)
|
||||||
|
|
|
||||||
|
|
@ -61,4 +61,6 @@ source "drivers/pwm/Kconfig.xec"
|
||||||
|
|
||||||
source "drivers/pwm/Kconfig.litex"
|
source "drivers/pwm/Kconfig.litex"
|
||||||
|
|
||||||
|
source "drivers/pwm/Kconfig.rv32m1_tpm"
|
||||||
|
|
||||||
endif # PWM
|
endif # PWM
|
||||||
|
|
|
||||||
10
drivers/pwm/Kconfig.rv32m1_tpm
Normal file
10
drivers/pwm/Kconfig.rv32m1_tpm
Normal file
|
|
@ -0,0 +1,10 @@
|
||||||
|
# RV32M1 TPM PWM
|
||||||
|
|
||||||
|
# Copyright (c) 2019 Henrik Brix Andersen <henrik@brixandersen.dk>
|
||||||
|
# SPDX-License-Identifier: Apache-2.0
|
||||||
|
|
||||||
|
config PWM_RV32M1_TPM
|
||||||
|
bool "RV32M1 TPM PWM driver"
|
||||||
|
depends on HAS_RV32M1_TPM && CLOCK_CONTROL
|
||||||
|
help
|
||||||
|
Enable the RV32M1 TPM PWM driver.
|
||||||
215
drivers/pwm/pwm_rv32m1_tpm.c
Normal file
215
drivers/pwm/pwm_rv32m1_tpm.c
Normal file
|
|
@ -0,0 +1,215 @@
|
||||||
|
/*
|
||||||
|
* Copyright 2019 Henrik Brix Andersen <henrik@brixandersen.dk>
|
||||||
|
*
|
||||||
|
* Heavily based on pwm_mcux_ftm.c, which is:
|
||||||
|
* Copyright (c) 2017, NXP
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <drivers/clock_control.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <drivers/pwm.h>
|
||||||
|
#include <soc.h>
|
||||||
|
#include <fsl_tpm.h>
|
||||||
|
#include <fsl_clock.h>
|
||||||
|
|
||||||
|
#define LOG_LEVEL CONFIG_PWM_LOG_LEVEL
|
||||||
|
#include <logging/log.h>
|
||||||
|
LOG_MODULE_REGISTER(pwm_rv32m1_tpm);
|
||||||
|
|
||||||
|
#define MAX_CHANNELS ARRAY_SIZE(TPM0->CONTROLS)
|
||||||
|
|
||||||
|
struct rv32m1_tpm_config {
|
||||||
|
TPM_Type *base;
|
||||||
|
char *clock_name;
|
||||||
|
clock_control_subsys_t clock_subsys;
|
||||||
|
tpm_clock_source_t tpm_clock_source;
|
||||||
|
tpm_clock_prescale_t prescale;
|
||||||
|
u8_t channel_count;
|
||||||
|
tpm_pwm_mode_t mode;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct rv32m1_tpm_data {
|
||||||
|
u32_t clock_freq;
|
||||||
|
u32_t period_cycles;
|
||||||
|
tpm_chnl_pwm_signal_param_t channel[MAX_CHANNELS];
|
||||||
|
};
|
||||||
|
|
||||||
|
static int rv32m1_tpm_pin_set(struct device *dev, u32_t pwm,
|
||||||
|
u32_t period_cycles, u32_t pulse_cycles,
|
||||||
|
pwm_flags_t flags)
|
||||||
|
{
|
||||||
|
const struct rv32m1_tpm_config *config = dev->config->config_info;
|
||||||
|
struct rv32m1_tpm_data *data = dev->driver_data;
|
||||||
|
u8_t duty_cycle;
|
||||||
|
|
||||||
|
if ((period_cycles == 0U) || (pulse_cycles > period_cycles)) {
|
||||||
|
LOG_ERR("Invalid combination: period_cycles=%d, "
|
||||||
|
"pulse_cycles=%d", period_cycles, pulse_cycles);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (pwm >= config->channel_count) {
|
||||||
|
LOG_ERR("Invalid channel");
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
|
||||||
|
duty_cycle = pulse_cycles * 100U / period_cycles;
|
||||||
|
data->channel[pwm].dutyCyclePercent = duty_cycle;
|
||||||
|
|
||||||
|
if ((flags & PWM_POLARITY_INVERTED) == 0) {
|
||||||
|
data->channel[pwm].level = kTPM_HighTrue;
|
||||||
|
} else {
|
||||||
|
data->channel[pwm].level = kTPM_LowTrue;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOG_DBG("pulse_cycles=%d, period_cycles=%d, duty_cycle=%d, flags=%d",
|
||||||
|
pulse_cycles, period_cycles, duty_cycle, flags);
|
||||||
|
|
||||||
|
if (period_cycles != data->period_cycles) {
|
||||||
|
u32_t pwm_freq;
|
||||||
|
status_t status;
|
||||||
|
|
||||||
|
if (data->period_cycles != 0) {
|
||||||
|
/* Only warn when not changing from zero */
|
||||||
|
LOG_WRN("Changing period cycles from %d to %d"
|
||||||
|
" affects all %d channels in %s",
|
||||||
|
data->period_cycles, period_cycles,
|
||||||
|
config->channel_count, dev->config->name);
|
||||||
|
}
|
||||||
|
|
||||||
|
data->period_cycles = period_cycles;
|
||||||
|
|
||||||
|
pwm_freq = (data->clock_freq >> config->prescale) /
|
||||||
|
period_cycles;
|
||||||
|
|
||||||
|
LOG_DBG("pwm_freq=%d, clock_freq=%d", pwm_freq,
|
||||||
|
data->clock_freq);
|
||||||
|
|
||||||
|
if (pwm_freq == 0U) {
|
||||||
|
LOG_ERR("Could not set up pwm_freq=%d", pwm_freq);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
TPM_StopTimer(config->base);
|
||||||
|
|
||||||
|
status = TPM_SetupPwm(config->base, data->channel,
|
||||||
|
config->channel_count, config->mode,
|
||||||
|
pwm_freq, data->clock_freq);
|
||||||
|
|
||||||
|
if (status != kStatus_Success) {
|
||||||
|
LOG_ERR("Could not set up pwm");
|
||||||
|
return -ENOTSUP;
|
||||||
|
}
|
||||||
|
TPM_StartTimer(config->base, config->tpm_clock_source);
|
||||||
|
} else {
|
||||||
|
TPM_UpdateChnlEdgeLevelSelect(config->base, pwm,
|
||||||
|
data->channel[pwm].level);
|
||||||
|
TPM_UpdatePwmDutycycle(config->base, pwm, config->mode,
|
||||||
|
duty_cycle);
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int rv32m1_tpm_get_cycles_per_sec(struct device *dev, u32_t pwm,
|
||||||
|
u64_t *cycles)
|
||||||
|
{
|
||||||
|
const struct rv32m1_tpm_config *config = dev->config->config_info;
|
||||||
|
struct rv32m1_tpm_data *data = dev->driver_data;
|
||||||
|
|
||||||
|
*cycles = data->clock_freq >> config->prescale;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int rv32m1_tpm_init(struct device *dev)
|
||||||
|
{
|
||||||
|
const struct rv32m1_tpm_config *config = dev->config->config_info;
|
||||||
|
struct rv32m1_tpm_data *data = dev->driver_data;
|
||||||
|
tpm_chnl_pwm_signal_param_t *channel = data->channel;
|
||||||
|
struct device *clock_dev;
|
||||||
|
tpm_config_t tpm_config;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
if (config->channel_count > ARRAY_SIZE(data->channel)) {
|
||||||
|
LOG_ERR("Invalid channel count");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
clock_dev = device_get_binding(config->clock_name);
|
||||||
|
if (clock_dev == NULL) {
|
||||||
|
LOG_ERR("Could not get clock device");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (clock_control_on(clock_dev, config->clock_subsys)) {
|
||||||
|
LOG_ERR("Could not turn on clock");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (clock_control_get_rate(clock_dev, config->clock_subsys,
|
||||||
|
&data->clock_freq)) {
|
||||||
|
LOG_ERR("Could not get clock frequency");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < config->channel_count; i++) {
|
||||||
|
channel->chnlNumber = i;
|
||||||
|
channel->level = kTPM_NoPwmSignal;
|
||||||
|
channel->dutyCyclePercent = 0;
|
||||||
|
channel->firstEdgeDelayPercent = 0;
|
||||||
|
channel++;
|
||||||
|
}
|
||||||
|
|
||||||
|
TPM_GetDefaultConfig(&tpm_config);
|
||||||
|
tpm_config.prescale = config->prescale;
|
||||||
|
|
||||||
|
TPM_Init(config->base, &tpm_config);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct pwm_driver_api rv32m1_tpm_driver_api = {
|
||||||
|
.pin_set = rv32m1_tpm_pin_set,
|
||||||
|
.get_cycles_per_sec = rv32m1_tpm_get_cycles_per_sec,
|
||||||
|
};
|
||||||
|
|
||||||
|
#define TPM_DEVICE(n) \
|
||||||
|
static const struct rv32m1_tpm_config rv32m1_tpm_config_##n = { \
|
||||||
|
.base = (TPM_Type *) \
|
||||||
|
DT_INST_##n##_OPENISA_RV32M1_TPM_BASE_ADDRESS, \
|
||||||
|
.clock_name = \
|
||||||
|
DT_INST_##n##_OPENISA_RV32M1_TPM_CLOCK_CONTROLLER, \
|
||||||
|
.clock_subsys = (clock_control_subsys_t) \
|
||||||
|
DT_INST_##n##_OPENISA_RV32M1_TPM_CLOCK_NAME, \
|
||||||
|
.tpm_clock_source = kTPM_SystemClock, \
|
||||||
|
.prescale = kTPM_Prescale_Divide_16, \
|
||||||
|
.channel_count = FSL_FEATURE_TPM_CHANNEL_COUNTn((TPM_Type *) \
|
||||||
|
DT_INST_##n##_OPENISA_RV32M1_TPM_BASE_ADDRESS), \
|
||||||
|
.mode = kTPM_EdgeAlignedPwm, \
|
||||||
|
}; \
|
||||||
|
static struct rv32m1_tpm_data rv32m1_tpm_data_##n; \
|
||||||
|
DEVICE_AND_API_INIT(rv32m1_tpm_##n, \
|
||||||
|
DT_INST_##n##_OPENISA_RV32M1_TPM_LABEL, \
|
||||||
|
&rv32m1_tpm_init, &rv32m1_tpm_data_##n, \
|
||||||
|
&rv32m1_tpm_config_##n, \
|
||||||
|
POST_KERNEL, CONFIG_KERNEL_INIT_PRIORITY_DEVICE, \
|
||||||
|
&rv32m1_tpm_driver_api)
|
||||||
|
|
||||||
|
#if DT_INST_0_OPENISA_RV32M1_TPM
|
||||||
|
TPM_DEVICE(0);
|
||||||
|
#endif /* DT_INST_0_OPENISA_RV32M1_TPM */
|
||||||
|
|
||||||
|
#if DT_INST_1_OPENISA_RV32M1_TPM
|
||||||
|
TPM_DEVICE(1);
|
||||||
|
#endif /* DT_INST_1_OPENISA_RV32M1_TPM */
|
||||||
|
|
||||||
|
#if DT_INST_2_OPENISA_RV32M1_TPM
|
||||||
|
TPM_DEVICE(2);
|
||||||
|
#endif /* DT_INST_2_OPENISA_RV32M1_TPM */
|
||||||
|
|
||||||
|
#if DT_INST_3_OPENISA_RV32M1_TPM
|
||||||
|
TPM_DEVICE(3);
|
||||||
|
#endif /* DT_INST_3_OPENISA_RV32M1_TPM */
|
||||||
Loading…
Add table
Add a link
Reference in a new issue