pwm-imx.c 1.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859
  1. /*
  2. * (C) Copyright 2014
  3. * Heiko Schocher, DENX Software Engineering, hs@denx.de.
  4. *
  5. * Basic support for the pwm modul 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. writel(0, &pwm->ir);
  19. return 0;
  20. }
  21. int pwm_config(int pwm_id, int duty_ns, int period_ns)
  22. {
  23. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  24. unsigned long period_cycles, duty_cycles, prescale;
  25. u32 cr;
  26. pwm_imx_get_parms(period_ns, duty_ns, &period_cycles, &duty_cycles,
  27. &prescale);
  28. cr = PWMCR_PRESCALER(prescale) |
  29. PWMCR_DOZEEN | PWMCR_WAITEN |
  30. PWMCR_DBGEN | PWMCR_CLKSRC_IPG_HIGH;
  31. writel(cr, &pwm->cr);
  32. /* set duty cycles */
  33. writel(duty_cycles, &pwm->sar);
  34. /* set period cycles */
  35. writel(period_cycles, &pwm->pr);
  36. return 0;
  37. }
  38. int pwm_enable(int pwm_id)
  39. {
  40. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  41. setbits_le32(&pwm->cr, PWMCR_EN);
  42. return 0;
  43. }
  44. void pwm_disable(int pwm_id)
  45. {
  46. struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
  47. clrbits_le32(&pwm->cr, PWMCR_EN);
  48. }