cros_ec_pwm.c 1.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384
  1. // SPDX-License-Identifier: GPL-2.0+
  2. #include <common.h>
  3. #include <cros_ec.h>
  4. #include <dm.h>
  5. #include <errno.h>
  6. #include <log.h>
  7. #include <pwm.h>
  8. struct cros_ec_pwm_priv {
  9. bool enabled;
  10. uint duty;
  11. };
  12. static int cros_ec_pwm_set_config(struct udevice *dev, uint channel,
  13. uint period_ns, uint duty_ns)
  14. {
  15. struct cros_ec_pwm_priv *priv = dev_get_priv(dev);
  16. uint duty;
  17. int ret;
  18. debug("%s: period_ns=%u, duty_ns=%u asked\n", __func__,
  19. period_ns, duty_ns);
  20. /* No way to set the period, only a relative duty cycle */
  21. duty = EC_PWM_MAX_DUTY * duty_ns / period_ns;
  22. if (duty > EC_PWM_MAX_DUTY)
  23. duty = EC_PWM_MAX_DUTY;
  24. if (!priv->enabled) {
  25. priv->duty = duty;
  26. debug("%s: duty=%#x to-be-set\n", __func__, duty);
  27. return 0;
  28. }
  29. ret = cros_ec_set_pwm_duty(dev->parent, channel, duty);
  30. if (ret) {
  31. debug("%s: duty=%#x failed\n", __func__, duty);
  32. return ret;
  33. }
  34. priv->duty = duty;
  35. debug("%s: duty=%#x set\n", __func__, duty);
  36. return 0;
  37. }
  38. static int cros_ec_pwm_set_enable(struct udevice *dev, uint channel,
  39. bool enable)
  40. {
  41. struct cros_ec_pwm_priv *priv = dev_get_priv(dev);
  42. int ret;
  43. ret = cros_ec_set_pwm_duty(dev->parent, channel,
  44. enable ? priv->duty : 0);
  45. if (ret) {
  46. debug("%s: enable=%d failed\n", __func__, enable);
  47. return ret;
  48. }
  49. priv->enabled = enable;
  50. debug("%s: enable=%d (duty=%#x) set\n", __func__,
  51. enable, priv->duty);
  52. return 0;
  53. }
  54. static const struct pwm_ops cros_ec_pwm_ops = {
  55. .set_config = cros_ec_pwm_set_config,
  56. .set_enable = cros_ec_pwm_set_enable,
  57. };
  58. static const struct udevice_id cros_ec_pwm_ids[] = {
  59. { .compatible = "google,cros-ec-pwm" },
  60. { }
  61. };
  62. U_BOOT_DRIVER(cros_ec_pwm) = {
  63. .name = "cros_ec_pwm",
  64. .id = UCLASS_PWM,
  65. .of_match = cros_ec_pwm_ids,
  66. .ops = &cros_ec_pwm_ops,
  67. .priv_auto = sizeof(struct cros_ec_pwm_priv),
  68. };