pwm-imx.c 1.3 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071
  1. /*
  2. * (C) Copyright 2014
  3. * Heiko Schocher, DENX Software Engineering, hs@denx.de.
  4. *
  5. * Basic support for the pwm module on imx6.
  6. *
  7. * SPDX-License-Identifier: GPL-2.0+
  8. */
  9. #include <common.h>
  10. #include <div64.h>
  11. #include <pwm.h>
  12. #include <asm/arch/imx-regs.h>
  13. #include <asm/io.h>
  14. #include "pwm-imx-util.h"
  15. int pwm_init(int pwm_id, int div, int invert)
  16. {
  17. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  18. if (!pwm)
  19. return -1;
  20. writel(0, &pwm->ir);
  21. return 0;
  22. }
  23. int pwm_config(int pwm_id, int duty_ns, int period_ns)
  24. {
  25. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  26. unsigned long period_cycles, duty_cycles, prescale;
  27. u32 cr;
  28. if (!pwm)
  29. return -1;
  30. pwm_imx_get_parms(period_ns, duty_ns, &period_cycles, &duty_cycles,
  31. &prescale);
  32. cr = PWMCR_PRESCALER(prescale) |
  33. PWMCR_DOZEEN | PWMCR_WAITEN |
  34. PWMCR_DBGEN | PWMCR_CLKSRC_IPG_HIGH;
  35. writel(cr, &pwm->cr);
  36. /* set duty cycles */
  37. writel(duty_cycles, &pwm->sar);
  38. /* set period cycles */
  39. writel(period_cycles, &pwm->pr);
  40. return 0;
  41. }
  42. int pwm_enable(int pwm_id)
  43. {
  44. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  45. if (!pwm)
  46. return -1;
  47. setbits_le32(&pwm->cr, PWMCR_EN);
  48. return 0;
  49. }
  50. void pwm_disable(int pwm_id)
  51. {
  52. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  53. if (!pwm)
  54. return;
  55. clrbits_le32(&pwm->cr, PWMCR_EN);
  56. }