| /* |
| * Copyright (c) 2019, Linaro |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #define DT_DRV_COMPAT nxp_imx_pwm |
| |
| #include <errno.h> |
| #include <zephyr/drivers/pwm.h> |
| #include <zephyr/drivers/clock_control.h> |
| #include <soc.h> |
| #include <fsl_pwm.h> |
| #include <zephyr/drivers/pinctrl.h> |
| |
| #include <zephyr/logging/log.h> |
| |
| LOG_MODULE_REGISTER(pwm_mcux, CONFIG_PWM_LOG_LEVEL); |
| |
| #define CHANNEL_COUNT 2 |
| |
| struct pwm_mcux_config { |
| PWM_Type *base; |
| uint8_t index; |
| const struct device *clock_dev; |
| clock_control_subsys_t clock_subsys; |
| pwm_clock_prescale_t prescale; |
| pwm_register_reload_t reload; |
| pwm_mode_t mode; |
| bool run_wait; |
| bool run_debug; |
| const struct pinctrl_dev_config *pincfg; |
| }; |
| |
| struct pwm_mcux_data { |
| uint32_t period_cycles[CHANNEL_COUNT]; |
| pwm_signal_param_t channel[CHANNEL_COUNT]; |
| }; |
| |
| static int mcux_pwm_set_cycles(const struct device *dev, uint32_t channel, |
| uint32_t period_cycles, uint32_t pulse_cycles, |
| pwm_flags_t flags) |
| { |
| const struct pwm_mcux_config *config = dev->config; |
| struct pwm_mcux_data *data = dev->data; |
| uint8_t duty_cycle; |
| pwm_level_select_t level; |
| |
| if (channel >= CHANNEL_COUNT) { |
| LOG_ERR("Invalid channel"); |
| return -EINVAL; |
| } |
| |
| if (period_cycles == 0) { |
| LOG_ERR("Channel can not be set to inactive level"); |
| return -ENOTSUP; |
| } |
| |
| if (period_cycles > UINT16_MAX) { |
| /* 16-bit resolution */ |
| LOG_ERR("Too long period (%u), adjust pwm prescaler!", |
| period_cycles); |
| /* TODO: dynamically adjust prescaler */ |
| return -EINVAL; |
| } |
| |
| duty_cycle = 100 * pulse_cycles / period_cycles; |
| |
| if (flags & PWM_POLARITY_INVERTED) { |
| level = kPWM_LowTrue; |
| } else { |
| level = kPWM_HighTrue; |
| } |
| |
| /* FIXME: Force re-setup even for duty-cycle update */ |
| if (period_cycles != data->period_cycles[channel] |
| || level != data->channel[channel].level) { |
| uint32_t clock_freq; |
| uint32_t pwm_freq; |
| status_t status; |
| |
| data->period_cycles[channel] = period_cycles; |
| |
| LOG_DBG("SETUP dutycycle to %u", duty_cycle); |
| |
| if (clock_control_get_rate(config->clock_dev, config->clock_subsys, |
| &clock_freq)) { |
| return -EINVAL; |
| } |
| |
| pwm_freq = DIV_ROUND_UP(clock_freq >> config->prescale, period_cycles); |
| |
| if (pwm_freq == 0) { |
| LOG_ERR("Could not set up pwm_freq=%d", pwm_freq); |
| return -EINVAL; |
| } |
| data->channel[channel].pwmchannelenable = true; |
| |
| PWM_StopTimer(config->base, 1U << config->index); |
| |
| data->channel[channel].dutyCyclePercent = duty_cycle; |
| data->channel[channel].level = level; |
| |
| status = PWM_SetupPwm(config->base, config->index, |
| &data->channel[0], CHANNEL_COUNT, |
| config->mode, pwm_freq, clock_freq); |
| if (status != kStatus_Success) { |
| LOG_ERR("Could not set up pwm"); |
| return -ENOTSUP; |
| } |
| |
| PWM_SetPwmLdok(config->base, 1U << config->index, true); |
| |
| PWM_StartTimer(config->base, 1U << config->index); |
| } else { |
| PWM_UpdatePwmDutycycle(config->base, config->index, |
| (channel == 0) ? kPWM_PwmA : kPWM_PwmB, |
| config->mode, duty_cycle); |
| PWM_SetPwmLdok(config->base, 1U << config->index, true); |
| } |
| |
| return 0; |
| } |
| |
| static int mcux_pwm_get_cycles_per_sec(const struct device *dev, |
| uint32_t channel, uint64_t *cycles) |
| { |
| const struct pwm_mcux_config *config = dev->config; |
| uint32_t clock_freq; |
| |
| if (clock_control_get_rate(config->clock_dev, config->clock_subsys, |
| &clock_freq)) { |
| return -EINVAL; |
| } |
| *cycles = clock_freq >> config->prescale; |
| |
| return 0; |
| } |
| |
| static int pwm_mcux_init(const struct device *dev) |
| { |
| const struct pwm_mcux_config *config = dev->config; |
| struct pwm_mcux_data *data = dev->data; |
| pwm_config_t pwm_config; |
| status_t status; |
| int i, err; |
| |
| if (!device_is_ready(config->clock_dev)) { |
| LOG_ERR("clock control device not ready"); |
| return -ENODEV; |
| } |
| |
| err = pinctrl_apply_state(config->pincfg, PINCTRL_STATE_DEFAULT); |
| if (err < 0) { |
| return err; |
| } |
| |
| LOG_DBG("Set prescaler %d, reload mode %d", |
| 1 << config->prescale, config->reload); |
| |
| PWM_GetDefaultConfig(&pwm_config); |
| pwm_config.prescale = config->prescale; |
| pwm_config.reloadLogic = config->reload; |
| pwm_config.clockSource = kPWM_BusClock; |
| pwm_config.enableDebugMode = config->run_debug; |
| pwm_config.enableWait = config->run_wait; |
| |
| status = PWM_Init(config->base, config->index, &pwm_config); |
| if (status != kStatus_Success) { |
| LOG_ERR("Unable to init PWM"); |
| return -EIO; |
| } |
| |
| /* Disable fault sources */ |
| for (i = 0; i < FSL_FEATURE_PWM_FAULT_CH_COUNT; i++) { |
| config->base->SM[config->index].DISMAP[i] = 0x0000; |
| } |
| |
| data->channel[0].pwmChannel = kPWM_PwmA; |
| data->channel[0].level = kPWM_HighTrue; |
| data->channel[1].pwmChannel = kPWM_PwmB; |
| data->channel[1].level = kPWM_HighTrue; |
| |
| return 0; |
| } |
| |
| static const struct pwm_driver_api pwm_mcux_driver_api = { |
| .set_cycles = mcux_pwm_set_cycles, |
| .get_cycles_per_sec = mcux_pwm_get_cycles_per_sec, |
| }; |
| |
| #define PWM_DEVICE_INIT_MCUX(n) \ |
| static struct pwm_mcux_data pwm_mcux_data_ ## n; \ |
| PINCTRL_DT_INST_DEFINE(n); \ |
| \ |
| static const struct pwm_mcux_config pwm_mcux_config_ ## n = { \ |
| .base = (PWM_Type *)DT_REG_ADDR(DT_INST_PARENT(n)), \ |
| .index = DT_INST_PROP(n, index), \ |
| .mode = kPWM_EdgeAligned, \ |
| .prescale = _CONCAT(kPWM_Prescale_Divide_, DT_INST_PROP(n, nxp_prescaler)),\ |
| .reload = DT_ENUM_IDX_OR(DT_DRV_INST(n), nxp_reload,\ |
| kPWM_ReloadPwmFullCycle),\ |
| .clock_dev = DEVICE_DT_GET(DT_INST_CLOCKS_CTLR(n)), \ |
| .clock_subsys = (clock_control_subsys_t)DT_INST_CLOCKS_CELL(n, name),\ |
| .run_wait = DT_INST_PROP(n, run_in_wait), \ |
| .run_debug = DT_INST_PROP(n, run_in_debug), \ |
| .pincfg = PINCTRL_DT_INST_DEV_CONFIG_GET(n), \ |
| }; \ |
| \ |
| DEVICE_DT_INST_DEFINE(n, \ |
| pwm_mcux_init, \ |
| NULL, \ |
| &pwm_mcux_data_ ## n, \ |
| &pwm_mcux_config_ ## n, \ |
| POST_KERNEL, CONFIG_PWM_INIT_PRIORITY, \ |
| &pwm_mcux_driver_api); |
| |
| DT_INST_FOREACH_STATUS_OKAY(PWM_DEVICE_INIT_MCUX) |