1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (c) 2017-2018 Vasily Khoruzhick <anarsoul@gmail.com>
13 #include <asm/global_data.h>
15 #include <asm/arch/pwm.h>
16 #include <power/regulator.h>
18 DECLARE_GLOBAL_DATA_PTR;
20 #define OSC_24MHZ 24000000
22 struct sunxi_pwm_priv {
23 struct sunxi_pwm *regs;
28 static const u32 prescaler_table[] = {
47 static int sunxi_pwm_set_invert(struct udevice *dev, uint channel,
50 struct sunxi_pwm_priv *priv = dev_get_priv(dev);
52 debug("%s: polarity=%u\n", __func__, polarity);
53 priv->invert = polarity;
58 static int sunxi_pwm_set_config(struct udevice *dev, uint channel,
59 uint period_ns, uint duty_ns)
61 struct sunxi_pwm_priv *priv = dev_get_priv(dev);
62 struct sunxi_pwm *regs = priv->regs;
63 int best_prescaler = 0;
64 u32 v, best_period = 0, duty;
65 u64 best_scaled_freq = 0;
66 const u32 nsecs_per_sec = 1000000000U;
68 debug("%s: period_ns=%u, duty_ns=%u\n", __func__, period_ns, duty_ns);
70 for (int prescaler = 0; prescaler <= SUNXI_PWM_CTRL_PRESCALE0_MASK;
74 if (!prescaler_table[prescaler])
76 scaled_freq = lldiv(OSC_24MHZ, prescaler_table[prescaler]);
77 period = lldiv(scaled_freq * period_ns, nsecs_per_sec);
78 if ((period - 1 <= SUNXI_PWM_CH0_PERIOD_MAX) &&
79 best_period < period) {
81 best_scaled_freq = scaled_freq;
82 best_prescaler = prescaler;
86 if (best_period - 1 > SUNXI_PWM_CH0_PERIOD_MAX) {
87 debug("%s: failed to find prescaler value\n", __func__);
91 duty = lldiv(best_scaled_freq * duty_ns, nsecs_per_sec);
93 if (priv->prescaler != best_prescaler) {
94 /* Mask clock to update prescaler */
95 v = readl(®s->ctrl);
96 v &= ~SUNXI_PWM_CTRL_CLK_GATE;
97 writel(v, ®s->ctrl);
98 v &= ~SUNXI_PWM_CTRL_PRESCALE0_MASK;
99 v |= (best_prescaler & SUNXI_PWM_CTRL_PRESCALE0_MASK);
100 writel(v, ®s->ctrl);
101 v |= SUNXI_PWM_CTRL_CLK_GATE;
102 writel(v, ®s->ctrl);
103 priv->prescaler = best_prescaler;
106 writel(SUNXI_PWM_CH0_PERIOD_PRD(best_period) |
107 SUNXI_PWM_CH0_PERIOD_DUTY(duty), ®s->ch0_period);
109 debug("%s: prescaler: %d, period: %d, duty: %d\n",
110 __func__, priv->prescaler,
116 static int sunxi_pwm_set_enable(struct udevice *dev, uint channel, bool enable)
118 struct sunxi_pwm_priv *priv = dev_get_priv(dev);
119 struct sunxi_pwm *regs = priv->regs;
122 debug("%s: Enable '%s'\n", __func__, dev->name);
124 v = readl(®s->ctrl);
126 v &= ~SUNXI_PWM_CTRL_ENABLE0;
127 writel(v, ®s->ctrl);
132 v &= ~SUNXI_PWM_CTRL_CH0_ACT_STA;
134 v |= SUNXI_PWM_CTRL_CH0_ACT_STA;
135 v |= SUNXI_PWM_CTRL_ENABLE0;
136 writel(v, ®s->ctrl);
141 static int sunxi_pwm_of_to_plat(struct udevice *dev)
143 struct sunxi_pwm_priv *priv = dev_get_priv(dev);
145 priv->regs = dev_read_addr_ptr(dev);
150 static int sunxi_pwm_probe(struct udevice *dev)
155 static const struct pwm_ops sunxi_pwm_ops = {
156 .set_invert = sunxi_pwm_set_invert,
157 .set_config = sunxi_pwm_set_config,
158 .set_enable = sunxi_pwm_set_enable,
161 static const struct udevice_id sunxi_pwm_ids[] = {
162 { .compatible = "allwinner,sun5i-a13-pwm" },
163 { .compatible = "allwinner,sun50i-a64-pwm" },
167 U_BOOT_DRIVER(sunxi_pwm) = {
170 .of_match = sunxi_pwm_ids,
171 .ops = &sunxi_pwm_ops,
172 .of_to_plat = sunxi_pwm_of_to_plat,
173 .probe = sunxi_pwm_probe,
174 .priv_auto = sizeof(struct sunxi_pwm_priv),