diff options
Diffstat (limited to 'zephyr/shim/src/pwm.c')
| -rw-r--r-- | zephyr/shim/src/pwm.c | 295 |
1 files changed, 0 insertions, 295 deletions
diff --git a/zephyr/shim/src/pwm.c b/zephyr/shim/src/pwm.c deleted file mode 100644 index 5f76878b12..0000000000 --- a/zephyr/shim/src/pwm.c +++ /dev/null @@ -1,295 +0,0 @@ -/* Copyright 2021 The Chromium OS Authors. All rights reserved. - * Use of this source code is governed by a BSD-style license that can be - * found in the LICENSE file. - */ - -#include <device.h> -#include <devicetree.h> -#include <drivers/pwm.h> -#include <logging/log.h> - -#include "common.h" -#include "console.h" -#include "drivers/cros_displight.h" -#include "ec_commands.h" -#include "host_command.h" -#include "pwm.h" -#include "keyboard_backlight.h" -#include "util.h" - -#include "pwm/pwm.h" - -LOG_MODULE_REGISTER(pwm_shim, LOG_LEVEL_ERR); - -#define PWM_RAW_TO_PERCENT(v) \ - DIV_ROUND_NEAREST((uint32_t)(v) * 100, UINT16_MAX) -#define PWM_PERCENT_TO_RAW(v) ((uint32_t)(v) * UINT16_MAX / 100) - -/* TODO(b/217741090): drop the PWM shim code once all callers have been - * converted. - */ -#if DT_HAS_COMPAT_STATUS_OKAY(named_pwms) - -/* - * Initialize the device bindings in pwm_channels. - * This macro is called from within DT_FOREACH_CHILD - */ -#define INIT_DEV_BINDING(id) { \ - pwm_configs[PWM_CHANNEL(id)].name = DT_NODE_FULL_NAME(id); \ - pwm_configs[PWM_CHANNEL(id)].dev = DEVICE_DT_GET( \ - DT_PHANDLE(id, pwms)); \ - pwm_configs[PWM_CHANNEL(id)].pin = DT_PWMS_CHANNEL(id); \ - pwm_configs[PWM_CHANNEL(id)].flags = DT_PWMS_FLAGS(id); \ - pwm_configs[PWM_CHANNEL(id)].freq = DT_PROP(id, frequency); \ - } - -struct pwm_config { - /* Name */ - const char *name; - /* PWM pin */ - uint32_t pin; - /* PWM channel flags. See dt-bindings/pwm/pwm.h */ - pwm_flags_t flags; - /* PWM operating frequency. Configured by the devicetree */ - uint32_t freq; - - /* PWM period in microseconds. Automatically set to 1/frequency */ - uint32_t period_us; - /* PWM pulse in microseconds. Set by pwm_set_raw_duty */ - uint32_t pulse_us; - /* Saves whether the PWM channel is currently enabled */ - bool enabled; - - /* Runtime device for PWM */ - const struct device *dev; -}; - -static struct pwm_config pwm_configs[PWM_CH_COUNT]; - -static int init_pwms(const struct device *unused) -{ - struct pwm_config *pwm; - int rv = 0; - - ARG_UNUSED(unused); - - /* Initialize PWM data from the device tree */ - DT_FOREACH_CHILD(DT_PATH(named_pwms), INIT_DEV_BINDING) - - /* Read the PWM operating frequency, set by the chip driver */ - for (size_t i = 0; i < PWM_CH_COUNT; ++i) { - pwm = &pwm_configs[i]; - - if (pwm->dev == NULL) { - LOG_ERR("Not found (%s)", pwm->name); - rv = -ENODEV; - continue; - } - - /* - * TODO - check that devicetree frequency is less than 1/2 - * max frequency from the chip driver. - */ - pwm->period_us = USEC_PER_SEC / pwm->freq; - } - - return rv; -} -#if CONFIG_PLATFORM_EC_PWM_INIT_PRIORITY <= CONFIG_KERNEL_INIT_PRIORITY_DEVICE -#error "PWM init priority must be > KERNEL_INIT_PRIORITY_DEVICE" -#endif -SYS_INIT(init_pwms, PRE_KERNEL_1, CONFIG_PLATFORM_EC_PWM_INIT_PRIORITY); - -static struct pwm_config* pwm_lookup(enum pwm_channel ch) -{ - __ASSERT(ch < ARRAY_SIZE(pwm_configs), "Invalid PWM channel %d", ch); - - return &pwm_configs[ch]; -} - -void pwm_enable(enum pwm_channel ch, int enabled) -{ - struct pwm_config *pwm; - uint32_t pulse_us; - int rv; - - pwm = pwm_lookup(ch); - pwm->enabled = enabled; - - /* - * The Zephyr API doesn't provide explicit enable and disable - * commands. However, setting the pulse width to zero disables - * the PWM. - */ - if (enabled) - pulse_us = pwm->pulse_us; - else - pulse_us = 0; - - rv = pwm_pin_set_usec(pwm->dev, pwm->pin, pwm->period_us, pulse_us, - pwm->flags); - - if (rv) - LOG_ERR("pwm_pin_set_usec() failed %s (%d)", pwm->name, rv); -} - -int pwm_get_enabled(enum pwm_channel ch) -{ - struct pwm_config *pwm; - - pwm = pwm_lookup(ch); - return pwm->enabled; -} - -void pwm_set_raw_duty(enum pwm_channel ch, uint16_t duty) -{ - struct pwm_config *pwm; - int rv; - - pwm = pwm_lookup(ch); - - pwm->pulse_us = - DIV_ROUND_NEAREST(pwm->period_us * duty, EC_PWM_MAX_DUTY); - - LOG_DBG("PWM %s set raw duty (0x%04x), pulse %d", pwm->name, duty, - pwm->pulse_us); - - rv = pwm_pin_set_usec(pwm->dev, pwm->pin, pwm->period_us, pwm->pulse_us, - pwm->flags); - - if (rv) - LOG_ERR("pwm_pin_set_usec() failed %s (%d)", pwm->name, rv); -} - -uint16_t pwm_get_raw_duty(enum pwm_channel ch) -{ - struct pwm_config *pwm; - - pwm = pwm_lookup(ch); - - return DIV_ROUND_NEAREST(pwm->pulse_us * EC_PWM_MAX_DUTY, - pwm->period_us); -} - -void pwm_set_duty(enum pwm_channel ch, int percent) -{ - struct pwm_config *pwm; - int rv; - - pwm = pwm_lookup(ch); - - pwm->pulse_us = DIV_ROUND_NEAREST(pwm->period_us * percent, 100); - - LOG_DBG("PWM %s set percent (%d), pulse %d", pwm->name, percent, - pwm->pulse_us); - - rv = pwm_pin_set_usec(pwm->dev, pwm->pin, pwm->period_us, pwm->pulse_us, - pwm->flags); - - if (rv) - LOG_ERR("pwm_pin_set_usec() failed %s (%d)", pwm->name, rv); -} - -int pwm_get_duty(enum pwm_channel ch) -{ - struct pwm_config *pwm; - - pwm = pwm_lookup(ch); - - return DIV_ROUND_NEAREST(pwm->pulse_us * 100, pwm->period_us); -} - -#endif /* DT_HAS_COMPAT_STATUS_OKAY(named_pwm) */ - -#define HAS_PWM_GENERIC_CHANNEL(compat) \ - DT_NODE_HAS_PROP(DT_COMPAT_GET_ANY_STATUS_OKAY(compat), \ - generic_pwm_channel) - -#define PWM_GENERIC_CHANNEL_ID(compat) \ - DT_PROP(DT_COMPAT_GET_ANY_STATUS_OKAY(compat), \ - generic_pwm_channel) - -#ifdef CONFIG_PWM_KBLIGHT -static bool pwm_is_kblight(int type, int index) -{ - if (type == EC_PWM_TYPE_KB_LIGHT) - return true; - -#if HAS_PWM_GENERIC_CHANNEL(cros_ec_kblight_pwm) - if (type == EC_PWM_TYPE_GENERIC && - index == PWM_GENERIC_CHANNEL_ID(cros_ec_kblight_pwm)) - return true; -#endif /* HAS_PWM_GENERIC_CHANNEL(cros_ec_kblight_pwm) */ - - return false; -} -#endif /* CONFIG_PWM_KBLIGHT */ - -#ifdef CONFIG_PLATFORM_EC_PWM_DISPLIGHT -static bool pwm_is_displight(int type, int index) -{ - if (type == EC_PWM_TYPE_DISPLAY_LIGHT) - return true; - -#if HAS_PWM_GENERIC_CHANNEL(cros_ec_displight) - if (type == EC_PWM_TYPE_GENERIC && - index == PWM_GENERIC_CHANNEL_ID(cros_ec_displight)) - return true; -#endif /* HAS_PWM_GENERIC_CHANNEL(cros_ec_displight) */ - - return false; -} -#endif /* CONFIG_PLATFORM_EC_PWM_DISPLIGHT */ - - -static enum ec_status host_command_pwm_set_duty( - struct host_cmd_handler_args *args) -{ - __maybe_unused const struct ec_params_pwm_set_duty *p = args->params; - -#ifdef CONFIG_PLATFORM_EC_PWM_KBLIGHT - if (pwm_is_kblight(p->pwm_type, p->index)) { - kblight_set(PWM_RAW_TO_PERCENT(p->duty)); - kblight_enable(p->duty > 0); - return EC_RES_SUCCESS; - } -#endif -#ifdef CONFIG_PLATFORM_EC_PWM_DISPLIGHT - if (pwm_is_displight(p->pwm_type, p->index)) { - displight_set(PWM_RAW_TO_PERCENT(p->duty)); - return EC_RES_SUCCESS; - } -#endif - - return EC_RES_INVALID_PARAM; -} -DECLARE_HOST_COMMAND(EC_CMD_PWM_SET_DUTY, - host_command_pwm_set_duty, - EC_VER_MASK(0)); - -static enum ec_status host_command_pwm_get_duty( - struct host_cmd_handler_args *args) -{ - __maybe_unused const struct ec_params_pwm_get_duty *p = args->params; - __maybe_unused struct ec_response_pwm_get_duty *r = args->response; - -#ifdef CONFIG_PLATFORM_EC_PWM_KBLIGHT - if (pwm_is_kblight(p->pwm_type, p->index)) { - r->duty = PWM_PERCENT_TO_RAW(kblight_get()); - args->response_size = sizeof(*r); - return EC_RES_SUCCESS; - } -#endif -#ifdef CONFIG_PLATFORM_EC_PWM_DISPLIGHT - if (pwm_is_displight(p->pwm_type, p->index)) { - r->duty = PWM_PERCENT_TO_RAW(displight_get()); - args->response_size = sizeof(*r); - return EC_RES_SUCCESS; - } -#endif - - return EC_RES_INVALID_PARAM; -} -DECLARE_HOST_COMMAND(EC_CMD_PWM_GET_DUTY, - host_command_pwm_get_duty, - EC_VER_MASK(0)); |