pwm-imx.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2014
  4. * Heiko Schocher, DENX Software Engineering, hs@denx.de.
  5. *
  6. * Basic support for the pwm module on imx6.
  7. */
  8. #include <common.h>
  9. #include <div64.h>
  10. #include <dm.h>
  11. #include <log.h>
  12. #include <pwm.h>
  13. #include <asm/arch/imx-regs.h>
  14. #include <asm/io.h>
  15. #include "pwm-imx-util.h"
  16. int pwm_init(int pwm_id, int div, int invert)
  17. {
  18. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  19. if (!pwm)
  20. return -1;
  21. writel(0, &pwm->ir);
  22. return 0;
  23. }
  24. int pwm_config_internal(struct pwm_regs *pwm, unsigned long period_cycles,
  25. unsigned long duty_cycles, unsigned long prescale)
  26. {
  27. u32 cr;
  28. writel(0, &pwm->ir);
  29. cr = PWMCR_PRESCALER(prescale) |
  30. PWMCR_DOZEEN | PWMCR_WAITEN |
  31. PWMCR_DBGEN | PWMCR_CLKSRC_IPG_HIGH;
  32. writel(cr, &pwm->cr);
  33. /* set duty cycles */
  34. writel(duty_cycles, &pwm->sar);
  35. /* set period cycles */
  36. writel(period_cycles, &pwm->pr);
  37. return 0;
  38. }
  39. int pwm_config(int pwm_id, int duty_ns, int period_ns)
  40. {
  41. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  42. unsigned long period_cycles, duty_cycles, prescale;
  43. if (!pwm)
  44. return -1;
  45. pwm_imx_get_parms(period_ns, duty_ns, &period_cycles, &duty_cycles,
  46. &prescale);
  47. return pwm_config_internal(pwm, period_cycles, duty_cycles, prescale);
  48. }
  49. int pwm_enable(int pwm_id)
  50. {
  51. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  52. if (!pwm)
  53. return -1;
  54. setbits_le32(&pwm->cr, PWMCR_EN);
  55. return 0;
  56. }
  57. void pwm_disable(int pwm_id)
  58. {
  59. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  60. if (!pwm)
  61. return;
  62. clrbits_le32(&pwm->cr, PWMCR_EN);
  63. }
  64. #if defined(CONFIG_DM_PWM)
  65. struct imx_pwm_priv {
  66. struct pwm_regs *regs;
  67. bool invert;
  68. };
  69. static int imx_pwm_set_invert(struct udevice *dev, uint channel,
  70. bool polarity)
  71. {
  72. struct imx_pwm_priv *priv = dev_get_priv(dev);
  73. debug("%s: polarity=%u\n", __func__, polarity);
  74. priv->invert = polarity;
  75. return 0;
  76. }
  77. static int imx_pwm_set_config(struct udevice *dev, uint channel,
  78. uint period_ns, uint duty_ns)
  79. {
  80. struct imx_pwm_priv *priv = dev_get_priv(dev);
  81. struct pwm_regs *regs = priv->regs;
  82. unsigned long period_cycles, duty_cycles, prescale;
  83. debug("%s: Config '%s' channel: %d\n", __func__, dev->name, channel);
  84. pwm_imx_get_parms(period_ns, duty_ns, &period_cycles, &duty_cycles,
  85. &prescale);
  86. return pwm_config_internal(regs, period_cycles, duty_cycles, prescale);
  87. };
  88. static int imx_pwm_set_enable(struct udevice *dev, uint channel, bool enable)
  89. {
  90. struct imx_pwm_priv *priv = dev_get_priv(dev);
  91. struct pwm_regs *regs = priv->regs;
  92. debug("%s: Enable '%s' state: %d\n", __func__, dev->name, enable);
  93. if (enable)
  94. setbits_le32(&regs->cr, PWMCR_EN);
  95. else
  96. clrbits_le32(&regs->cr, PWMCR_EN);
  97. return 0;
  98. };
  99. static int imx_pwm_ofdata_to_platdata(struct udevice *dev)
  100. {
  101. struct imx_pwm_priv *priv = dev_get_priv(dev);
  102. priv->regs = dev_read_addr_ptr(dev);
  103. return 0;
  104. }
  105. static int imx_pwm_probe(struct udevice *dev)
  106. {
  107. return 0;
  108. }
  109. static const struct pwm_ops imx_pwm_ops = {
  110. .set_invert = imx_pwm_set_invert,
  111. .set_config = imx_pwm_set_config,
  112. .set_enable = imx_pwm_set_enable,
  113. };
  114. static const struct udevice_id imx_pwm_ids[] = {
  115. { .compatible = "fsl,imx27-pwm" },
  116. { }
  117. };
  118. U_BOOT_DRIVER(imx_pwm) = {
  119. .name = "imx_pwm",
  120. .id = UCLASS_PWM,
  121. .of_match = imx_pwm_ids,
  122. .ops = &imx_pwm_ops,
  123. .ofdata_to_platdata = imx_pwm_ofdata_to_platdata,
  124. .probe = imx_pwm_probe,
  125. .priv_auto_alloc_size = sizeof(struct imx_pwm_priv),
  126. };
  127. #endif