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
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
pwm_init(int pwm_id,int div,int invert)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
20 if (!pwm)
21 return -1;
22
23 writel(0, &pwm->ir);
24 return 0;
25 }
26
pwm_config(int pwm_id,int duty_ns,int period_ns)27 int pwm_config(int pwm_id, int duty_ns, int period_ns)
28 {
29 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
30 unsigned long period_cycles, duty_cycles, prescale;
31 u32 cr;
32
33 if (!pwm)
34 return -1;
35
36 pwm_imx_get_parms(period_ns, duty_ns, &period_cycles, &duty_cycles,
37 &prescale);
38
39 cr = PWMCR_PRESCALER(prescale) |
40 PWMCR_DOZEEN | PWMCR_WAITEN |
41 PWMCR_DBGEN | PWMCR_CLKSRC_IPG_HIGH;
42
43 writel(cr, &pwm->cr);
44 /* set duty cycles */
45 writel(duty_cycles, &pwm->sar);
46 /* set period cycles */
47 writel(period_cycles, &pwm->pr);
48 return 0;
49 }
50
pwm_enable(int pwm_id)51 int pwm_enable(int pwm_id)
52 {
53 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
54
55 if (!pwm)
56 return -1;
57
58 setbits_le32(&pwm->cr, PWMCR_EN);
59 return 0;
60 }
61
pwm_disable(int pwm_id)62 void pwm_disable(int pwm_id)
63 {
64 struct pwm_regs *pwm = (struct pwm_regs *)pwm_id_to_reg(pwm_id);
65
66 if (!pwm)
67 return;
68
69 clrbits_le32(&pwm->cr, PWMCR_EN);
70 }
71