Loading...
Note: File does not exist in v3.1.
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * simple driver for PWM (Pulse Width Modulator) controller
4 *
5 * Derived from pxa PWM driver by eric miao <eric.miao@marvell.com>
6 *
7 * Limitations:
8 * - When disabled the output is driven to 0 independent of the configured
9 * polarity.
10 */
11
12#include <linux/bitfield.h>
13#include <linux/bitops.h>
14#include <linux/clk.h>
15#include <linux/delay.h>
16#include <linux/err.h>
17#include <linux/io.h>
18#include <linux/kernel.h>
19#include <linux/module.h>
20#include <linux/of.h>
21#include <linux/platform_device.h>
22#include <linux/pwm.h>
23#include <linux/slab.h>
24
25#define MX3_PWMCR 0x00 /* PWM Control Register */
26#define MX3_PWMSR 0x04 /* PWM Status Register */
27#define MX3_PWMSAR 0x0C /* PWM Sample Register */
28#define MX3_PWMPR 0x10 /* PWM Period Register */
29#define MX3_PWMCNR 0x14 /* PWM Counter Register */
30
31#define MX3_PWMCR_FWM GENMASK(27, 26)
32#define MX3_PWMCR_STOPEN BIT(25)
33#define MX3_PWMCR_DOZEN BIT(24)
34#define MX3_PWMCR_WAITEN BIT(23)
35#define MX3_PWMCR_DBGEN BIT(22)
36#define MX3_PWMCR_BCTR BIT(21)
37#define MX3_PWMCR_HCTR BIT(20)
38
39#define MX3_PWMCR_POUTC GENMASK(19, 18)
40#define MX3_PWMCR_POUTC_NORMAL 0
41#define MX3_PWMCR_POUTC_INVERTED 1
42#define MX3_PWMCR_POUTC_OFF 2
43
44#define MX3_PWMCR_CLKSRC GENMASK(17, 16)
45#define MX3_PWMCR_CLKSRC_OFF 0
46#define MX3_PWMCR_CLKSRC_IPG 1
47#define MX3_PWMCR_CLKSRC_IPG_HIGH 2
48#define MX3_PWMCR_CLKSRC_IPG_32K 3
49
50#define MX3_PWMCR_PRESCALER GENMASK(15, 4)
51
52#define MX3_PWMCR_SWR BIT(3)
53
54#define MX3_PWMCR_REPEAT GENMASK(2, 1)
55#define MX3_PWMCR_REPEAT_1X 0
56#define MX3_PWMCR_REPEAT_2X 1
57#define MX3_PWMCR_REPEAT_4X 2
58#define MX3_PWMCR_REPEAT_8X 3
59
60#define MX3_PWMCR_EN BIT(0)
61
62#define MX3_PWMSR_FWE BIT(6)
63#define MX3_PWMSR_CMP BIT(5)
64#define MX3_PWMSR_ROV BIT(4)
65#define MX3_PWMSR_FE BIT(3)
66
67#define MX3_PWMSR_FIFOAV GENMASK(2, 0)
68#define MX3_PWMSR_FIFOAV_EMPTY 0
69#define MX3_PWMSR_FIFOAV_1WORD 1
70#define MX3_PWMSR_FIFOAV_2WORDS 2
71#define MX3_PWMSR_FIFOAV_3WORDS 3
72#define MX3_PWMSR_FIFOAV_4WORDS 4
73
74#define MX3_PWMCR_PRESCALER_SET(x) FIELD_PREP(MX3_PWMCR_PRESCALER, (x) - 1)
75#define MX3_PWMCR_PRESCALER_GET(x) (FIELD_GET(MX3_PWMCR_PRESCALER, \
76 (x)) + 1)
77
78#define MX3_PWM_SWR_LOOP 5
79
80/* PWMPR register value of 0xffff has the same effect as 0xfffe */
81#define MX3_PWMPR_MAX 0xfffe
82
83static const char * const pwm_imx27_clks[] = {"ipg", "per"};
84#define PWM_IMX27_PER 1
85
86struct pwm_imx27_chip {
87 struct clk_bulk_data clks[ARRAY_SIZE(pwm_imx27_clks)];
88 int clks_cnt;
89 void __iomem *mmio_base;
90
91 /*
92 * The driver cannot read the current duty cycle from the hardware if
93 * the hardware is disabled. Cache the last programmed duty cycle
94 * value to return in that case.
95 */
96 unsigned int duty_cycle;
97};
98
99static inline struct pwm_imx27_chip *to_pwm_imx27_chip(struct pwm_chip *chip)
100{
101 return pwmchip_get_drvdata(chip);
102}
103
104static int pwm_imx27_get_state(struct pwm_chip *chip,
105 struct pwm_device *pwm, struct pwm_state *state)
106{
107 struct pwm_imx27_chip *imx = to_pwm_imx27_chip(chip);
108 u32 period, prescaler, pwm_clk, val;
109 u64 tmp;
110 int ret;
111
112 ret = clk_bulk_prepare_enable(imx->clks_cnt, imx->clks);
113 if (ret < 0)
114 return ret;
115
116 val = readl(imx->mmio_base + MX3_PWMCR);
117
118 if (val & MX3_PWMCR_EN)
119 state->enabled = true;
120 else
121 state->enabled = false;
122
123 switch (FIELD_GET(MX3_PWMCR_POUTC, val)) {
124 case MX3_PWMCR_POUTC_NORMAL:
125 state->polarity = PWM_POLARITY_NORMAL;
126 break;
127 case MX3_PWMCR_POUTC_INVERTED:
128 state->polarity = PWM_POLARITY_INVERSED;
129 break;
130 default:
131 dev_warn(pwmchip_parent(chip), "can't set polarity, output disconnected");
132 }
133
134 prescaler = MX3_PWMCR_PRESCALER_GET(val);
135 pwm_clk = clk_get_rate(imx->clks[PWM_IMX27_PER].clk);
136 val = readl(imx->mmio_base + MX3_PWMPR);
137 period = val >= MX3_PWMPR_MAX ? MX3_PWMPR_MAX : val;
138
139 /* PWMOUT (Hz) = PWMCLK / (PWMPR + 2) */
140 tmp = NSEC_PER_SEC * (u64)(period + 2) * prescaler;
141 state->period = DIV_ROUND_UP_ULL(tmp, pwm_clk);
142
143 /*
144 * PWMSAR can be read only if PWM is enabled. If the PWM is disabled,
145 * use the cached value.
146 */
147 if (state->enabled)
148 val = readl(imx->mmio_base + MX3_PWMSAR);
149 else
150 val = imx->duty_cycle;
151
152 tmp = NSEC_PER_SEC * (u64)(val) * prescaler;
153 state->duty_cycle = DIV_ROUND_UP_ULL(tmp, pwm_clk);
154
155 clk_bulk_disable_unprepare(imx->clks_cnt, imx->clks);
156
157 return 0;
158}
159
160static void pwm_imx27_sw_reset(struct pwm_chip *chip)
161{
162 struct pwm_imx27_chip *imx = to_pwm_imx27_chip(chip);
163 struct device *dev = pwmchip_parent(chip);
164 int wait_count = 0;
165 u32 cr;
166
167 writel(MX3_PWMCR_SWR, imx->mmio_base + MX3_PWMCR);
168 do {
169 usleep_range(200, 1000);
170 cr = readl(imx->mmio_base + MX3_PWMCR);
171 } while ((cr & MX3_PWMCR_SWR) &&
172 (wait_count++ < MX3_PWM_SWR_LOOP));
173
174 if (cr & MX3_PWMCR_SWR)
175 dev_warn(dev, "software reset timeout\n");
176}
177
178static void pwm_imx27_wait_fifo_slot(struct pwm_chip *chip,
179 struct pwm_device *pwm)
180{
181 struct pwm_imx27_chip *imx = to_pwm_imx27_chip(chip);
182 struct device *dev = pwmchip_parent(chip);
183 unsigned int period_ms;
184 int fifoav;
185 u32 sr;
186
187 sr = readl(imx->mmio_base + MX3_PWMSR);
188 fifoav = FIELD_GET(MX3_PWMSR_FIFOAV, sr);
189 if (fifoav == MX3_PWMSR_FIFOAV_4WORDS) {
190 period_ms = DIV_ROUND_UP_ULL(pwm->state.period,
191 NSEC_PER_MSEC);
192 msleep(period_ms);
193
194 sr = readl(imx->mmio_base + MX3_PWMSR);
195 if (fifoav == FIELD_GET(MX3_PWMSR_FIFOAV, sr))
196 dev_warn(dev, "there is no free FIFO slot\n");
197 }
198}
199
200static int pwm_imx27_apply(struct pwm_chip *chip, struct pwm_device *pwm,
201 const struct pwm_state *state)
202{
203 unsigned long period_cycles, duty_cycles, prescale, period_us, tmp;
204 struct pwm_imx27_chip *imx = to_pwm_imx27_chip(chip);
205 unsigned long long c;
206 unsigned long long clkrate;
207 unsigned long flags;
208 int val;
209 int ret;
210 u32 cr;
211
212 clkrate = clk_get_rate(imx->clks[PWM_IMX27_PER].clk);
213 c = clkrate * state->period;
214
215 do_div(c, NSEC_PER_SEC);
216 period_cycles = c;
217
218 prescale = period_cycles / 0x10000 + 1;
219
220 period_cycles /= prescale;
221 c = clkrate * state->duty_cycle;
222 do_div(c, NSEC_PER_SEC);
223 duty_cycles = c;
224 duty_cycles /= prescale;
225
226 /*
227 * according to imx pwm RM, the real period value should be PERIOD
228 * value in PWMPR plus 2.
229 */
230 if (period_cycles > 2)
231 period_cycles -= 2;
232 else
233 period_cycles = 0;
234
235 /*
236 * Wait for a free FIFO slot if the PWM is already enabled, and flush
237 * the FIFO if the PWM was disabled and is about to be enabled.
238 */
239 if (pwm->state.enabled) {
240 pwm_imx27_wait_fifo_slot(chip, pwm);
241 } else {
242 ret = clk_bulk_prepare_enable(imx->clks_cnt, imx->clks);
243 if (ret)
244 return ret;
245
246 pwm_imx27_sw_reset(chip);
247 }
248
249 val = readl(imx->mmio_base + MX3_PWMPR);
250 val = val >= MX3_PWMPR_MAX ? MX3_PWMPR_MAX : val;
251 cr = readl(imx->mmio_base + MX3_PWMCR);
252 tmp = NSEC_PER_SEC * (u64)(val + 2) * MX3_PWMCR_PRESCALER_GET(cr);
253 tmp = DIV_ROUND_UP_ULL(tmp, clkrate);
254 period_us = DIV_ROUND_UP_ULL(tmp, 1000);
255
256 /*
257 * ERR051198:
258 * PWM: PWM output may not function correctly if the FIFO is empty when
259 * a new SAR value is programmed
260 *
261 * Description:
262 * When the PWM FIFO is empty, a new value programmed to the PWM Sample
263 * register (PWM_PWMSAR) will be directly applied even if the current
264 * timer period has not expired.
265 *
266 * If the new SAMPLE value programmed in the PWM_PWMSAR register is
267 * less than the previous value, and the PWM counter register
268 * (PWM_PWMCNR) that contains the current COUNT value is greater than
269 * the new programmed SAMPLE value, the current period will not flip
270 * the level. This may result in an output pulse with a duty cycle of
271 * 100%.
272 *
273 * Consider a change from
274 * ________
275 * / \______/
276 * ^ * ^
277 * to
278 * ____
279 * / \__________/
280 * ^ ^
281 * At the time marked by *, the new write value will be directly applied
282 * to SAR even the current period is not over if FIFO is empty.
283 *
284 * ________ ____________________
285 * / \______/ \__________/
286 * ^ ^ * ^ ^
287 * |<-- old SAR -->| |<-- new SAR -->|
288 *
289 * That is the output is active for a whole period.
290 *
291 * Workaround:
292 * Check new SAR less than old SAR and current counter is in errata
293 * windows, write extra old SAR into FIFO and new SAR will effect at
294 * next period.
295 *
296 * Sometime period is quite long, such as over 1 second. If add old SAR
297 * into FIFO unconditional, new SAR have to wait for next period. It
298 * may be too long.
299 *
300 * Turn off the interrupt to ensure that not IRQ and schedule happen
301 * during above operations. If any irq and schedule happen, counter
302 * in PWM will be out of data and take wrong action.
303 *
304 * Add a safety margin 1.5us because it needs some time to complete
305 * IO write.
306 *
307 * Use writel_relaxed() to minimize the interval between two writes to
308 * the SAR register to increase the fastest PWM frequency supported.
309 *
310 * When the PWM period is longer than 2us(or <500kHz), this workaround
311 * can solve this problem. No software workaround is available if PWM
312 * period is shorter than IO write. Just try best to fill old data
313 * into FIFO.
314 */
315 c = clkrate * 1500;
316 do_div(c, NSEC_PER_SEC);
317
318 local_irq_save(flags);
319 val = FIELD_GET(MX3_PWMSR_FIFOAV, readl_relaxed(imx->mmio_base + MX3_PWMSR));
320
321 if (duty_cycles < imx->duty_cycle && (cr & MX3_PWMCR_EN)) {
322 if (period_us < 2) { /* 2us = 500 kHz */
323 /* Best effort attempt to fix up >500 kHz case */
324 udelay(3 * period_us);
325 writel_relaxed(imx->duty_cycle, imx->mmio_base + MX3_PWMSAR);
326 writel_relaxed(imx->duty_cycle, imx->mmio_base + MX3_PWMSAR);
327 } else if (val < MX3_PWMSR_FIFOAV_2WORDS) {
328 val = readl_relaxed(imx->mmio_base + MX3_PWMCNR);
329 /*
330 * If counter is close to period, controller may roll over when
331 * next IO write.
332 */
333 if ((val + c >= duty_cycles && val < imx->duty_cycle) ||
334 val + c >= period_cycles)
335 writel_relaxed(imx->duty_cycle, imx->mmio_base + MX3_PWMSAR);
336 }
337 }
338 writel_relaxed(duty_cycles, imx->mmio_base + MX3_PWMSAR);
339 local_irq_restore(flags);
340
341 writel(period_cycles, imx->mmio_base + MX3_PWMPR);
342
343 /*
344 * Store the duty cycle for future reference in cases where the
345 * MX3_PWMSAR register can't be read (i.e. when the PWM is disabled).
346 */
347 imx->duty_cycle = duty_cycles;
348
349 cr = MX3_PWMCR_PRESCALER_SET(prescale) |
350 MX3_PWMCR_STOPEN | MX3_PWMCR_DOZEN | MX3_PWMCR_WAITEN |
351 FIELD_PREP(MX3_PWMCR_CLKSRC, MX3_PWMCR_CLKSRC_IPG_HIGH) |
352 MX3_PWMCR_DBGEN;
353
354 if (state->polarity == PWM_POLARITY_INVERSED)
355 cr |= FIELD_PREP(MX3_PWMCR_POUTC,
356 MX3_PWMCR_POUTC_INVERTED);
357
358 if (state->enabled)
359 cr |= MX3_PWMCR_EN;
360
361 writel(cr, imx->mmio_base + MX3_PWMCR);
362
363 if (!state->enabled)
364 clk_bulk_disable_unprepare(imx->clks_cnt, imx->clks);
365
366 return 0;
367}
368
369static const struct pwm_ops pwm_imx27_ops = {
370 .apply = pwm_imx27_apply,
371 .get_state = pwm_imx27_get_state,
372};
373
374static const struct of_device_id pwm_imx27_dt_ids[] = {
375 { .compatible = "fsl,imx27-pwm", },
376 { /* sentinel */ }
377};
378MODULE_DEVICE_TABLE(of, pwm_imx27_dt_ids);
379
380static int pwm_imx27_probe(struct platform_device *pdev)
381{
382 struct pwm_chip *chip;
383 struct pwm_imx27_chip *imx;
384 int ret;
385 u32 pwmcr;
386 int i;
387
388 chip = devm_pwmchip_alloc(&pdev->dev, 1, sizeof(*imx));
389 if (IS_ERR(chip))
390 return PTR_ERR(chip);
391 imx = to_pwm_imx27_chip(chip);
392
393 imx->clks_cnt = ARRAY_SIZE(pwm_imx27_clks);
394 for (i = 0; i < imx->clks_cnt; ++i)
395 imx->clks[i].id = pwm_imx27_clks[i];
396
397 ret = devm_clk_bulk_get(&pdev->dev, imx->clks_cnt, imx->clks);
398
399 if (ret)
400 return dev_err_probe(&pdev->dev, ret,
401 "getting clocks failed\n");
402
403 chip->ops = &pwm_imx27_ops;
404
405 imx->mmio_base = devm_platform_ioremap_resource(pdev, 0);
406 if (IS_ERR(imx->mmio_base))
407 return PTR_ERR(imx->mmio_base);
408
409 ret = clk_bulk_prepare_enable(imx->clks_cnt, imx->clks);
410 if (ret)
411 return ret;
412
413 /* keep clks on if pwm is running */
414 pwmcr = readl(imx->mmio_base + MX3_PWMCR);
415 if (!(pwmcr & MX3_PWMCR_EN))
416 clk_bulk_disable_unprepare(imx->clks_cnt, imx->clks);
417
418 return devm_pwmchip_add(&pdev->dev, chip);
419}
420
421static struct platform_driver imx_pwm_driver = {
422 .driver = {
423 .name = "pwm-imx27",
424 .of_match_table = pwm_imx27_dt_ids,
425 },
426 .probe = pwm_imx27_probe,
427};
428module_platform_driver(imx_pwm_driver);
429
430MODULE_DESCRIPTION("i.MX27 and later i.MX SoCs Pulse Width Modulator driver");
431MODULE_LICENSE("GPL v2");
432MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");