Loading...
1/*
2 * This file is provided under a dual BSD/GPLv2 license. When using or
3 * redistributing this file, you may do so under either license.
4 *
5 * GPL LICENSE SUMMARY
6 *
7 * Copyright (c) 2016 BayLibre, SAS.
8 * Author: Neil Armstrong <narmstrong@baylibre.com>
9 * Copyright (C) 2014 Amlogic, Inc.
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of version 2 of the GNU General Public License as
13 * published by the Free Software Foundation.
14 *
15 * This program is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, see <http://www.gnu.org/licenses/>.
22 * The full GNU General Public License is included in this distribution
23 * in the file called COPYING.
24 *
25 * BSD LICENSE
26 *
27 * Copyright (c) 2016 BayLibre, SAS.
28 * Author: Neil Armstrong <narmstrong@baylibre.com>
29 * Copyright (C) 2014 Amlogic, Inc.
30 *
31 * Redistribution and use in source and binary forms, with or without
32 * modification, are permitted provided that the following conditions
33 * are met:
34 *
35 * * Redistributions of source code must retain the above copyright
36 * notice, this list of conditions and the following disclaimer.
37 * * Redistributions in binary form must reproduce the above copyright
38 * notice, this list of conditions and the following disclaimer in
39 * the documentation and/or other materials provided with the
40 * distribution.
41 * * Neither the name of Intel Corporation nor the names of its
42 * contributors may be used to endorse or promote products derived
43 * from this software without specific prior written permission.
44 *
45 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
46 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
47 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
48 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
49 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
50 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
51 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
52 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
53 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
54 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
55 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
56 */
57
58#include <linux/clk.h>
59#include <linux/clk-provider.h>
60#include <linux/err.h>
61#include <linux/io.h>
62#include <linux/kernel.h>
63#include <linux/module.h>
64#include <linux/of.h>
65#include <linux/of_device.h>
66#include <linux/platform_device.h>
67#include <linux/pwm.h>
68#include <linux/slab.h>
69#include <linux/spinlock.h>
70
71#define REG_PWM_A 0x0
72#define REG_PWM_B 0x4
73#define PWM_HIGH_SHIFT 16
74
75#define REG_MISC_AB 0x8
76#define MISC_B_CLK_EN BIT(23)
77#define MISC_A_CLK_EN BIT(15)
78#define MISC_CLK_DIV_MASK 0x7f
79#define MISC_B_CLK_DIV_SHIFT 16
80#define MISC_A_CLK_DIV_SHIFT 8
81#define MISC_B_CLK_SEL_SHIFT 6
82#define MISC_A_CLK_SEL_SHIFT 4
83#define MISC_CLK_SEL_WIDTH 2
84#define MISC_B_EN BIT(1)
85#define MISC_A_EN BIT(0)
86
87static const unsigned int mux_reg_shifts[] = {
88 MISC_A_CLK_SEL_SHIFT,
89 MISC_B_CLK_SEL_SHIFT
90};
91
92struct meson_pwm_channel {
93 unsigned int hi;
94 unsigned int lo;
95 u8 pre_div;
96
97 struct pwm_state state;
98
99 struct clk *clk_parent;
100 struct clk_mux mux;
101 struct clk *clk;
102};
103
104struct meson_pwm_data {
105 const char * const *parent_names;
106 unsigned int num_parents;
107};
108
109struct meson_pwm {
110 struct pwm_chip chip;
111 const struct meson_pwm_data *data;
112 void __iomem *base;
113 u8 inverter_mask;
114 spinlock_t lock;
115};
116
117static inline struct meson_pwm *to_meson_pwm(struct pwm_chip *chip)
118{
119 return container_of(chip, struct meson_pwm, chip);
120}
121
122static int meson_pwm_request(struct pwm_chip *chip, struct pwm_device *pwm)
123{
124 struct meson_pwm_channel *channel = pwm_get_chip_data(pwm);
125 struct device *dev = chip->dev;
126 int err;
127
128 if (!channel)
129 return -ENODEV;
130
131 if (channel->clk_parent) {
132 err = clk_set_parent(channel->clk, channel->clk_parent);
133 if (err < 0) {
134 dev_err(dev, "failed to set parent %s for %s: %d\n",
135 __clk_get_name(channel->clk_parent),
136 __clk_get_name(channel->clk), err);
137 return err;
138 }
139 }
140
141 err = clk_prepare_enable(channel->clk);
142 if (err < 0) {
143 dev_err(dev, "failed to enable clock %s: %d\n",
144 __clk_get_name(channel->clk), err);
145 return err;
146 }
147
148 chip->ops->get_state(chip, pwm, &channel->state);
149
150 return 0;
151}
152
153static void meson_pwm_free(struct pwm_chip *chip, struct pwm_device *pwm)
154{
155 struct meson_pwm_channel *channel = pwm_get_chip_data(pwm);
156
157 if (channel)
158 clk_disable_unprepare(channel->clk);
159}
160
161static int meson_pwm_calc(struct meson_pwm *meson,
162 struct meson_pwm_channel *channel, unsigned int id,
163 unsigned int duty, unsigned int period)
164{
165 unsigned int pre_div, cnt, duty_cnt;
166 unsigned long fin_freq = -1;
167 u64 fin_ps;
168
169 if (~(meson->inverter_mask >> id) & 0x1)
170 duty = period - duty;
171
172 if (period == channel->state.period &&
173 duty == channel->state.duty_cycle)
174 return 0;
175
176 fin_freq = clk_get_rate(channel->clk);
177 if (fin_freq == 0) {
178 dev_err(meson->chip.dev, "invalid source clock frequency\n");
179 return -EINVAL;
180 }
181
182 dev_dbg(meson->chip.dev, "fin_freq: %lu Hz\n", fin_freq);
183 fin_ps = (u64)NSEC_PER_SEC * 1000;
184 do_div(fin_ps, fin_freq);
185
186 /* Calc pre_div with the period */
187 for (pre_div = 0; pre_div < MISC_CLK_DIV_MASK; pre_div++) {
188 cnt = DIV_ROUND_CLOSEST_ULL((u64)period * 1000,
189 fin_ps * (pre_div + 1));
190 dev_dbg(meson->chip.dev, "fin_ps=%llu pre_div=%u cnt=%u\n",
191 fin_ps, pre_div, cnt);
192 if (cnt <= 0xffff)
193 break;
194 }
195
196 if (pre_div == MISC_CLK_DIV_MASK) {
197 dev_err(meson->chip.dev, "unable to get period pre_div\n");
198 return -EINVAL;
199 }
200
201 dev_dbg(meson->chip.dev, "period=%u pre_div=%u cnt=%u\n", period,
202 pre_div, cnt);
203
204 if (duty == period) {
205 channel->pre_div = pre_div;
206 channel->hi = cnt;
207 channel->lo = 0;
208 } else if (duty == 0) {
209 channel->pre_div = pre_div;
210 channel->hi = 0;
211 channel->lo = cnt;
212 } else {
213 /* Then check is we can have the duty with the same pre_div */
214 duty_cnt = DIV_ROUND_CLOSEST_ULL((u64)duty * 1000,
215 fin_ps * (pre_div + 1));
216 if (duty_cnt > 0xffff) {
217 dev_err(meson->chip.dev, "unable to get duty cycle\n");
218 return -EINVAL;
219 }
220
221 dev_dbg(meson->chip.dev, "duty=%u pre_div=%u duty_cnt=%u\n",
222 duty, pre_div, duty_cnt);
223
224 channel->pre_div = pre_div;
225 channel->hi = duty_cnt;
226 channel->lo = cnt - duty_cnt;
227 }
228
229 return 0;
230}
231
232static void meson_pwm_enable(struct meson_pwm *meson,
233 struct meson_pwm_channel *channel,
234 unsigned int id)
235{
236 u32 value, clk_shift, clk_enable, enable;
237 unsigned int offset;
238
239 switch (id) {
240 case 0:
241 clk_shift = MISC_A_CLK_DIV_SHIFT;
242 clk_enable = MISC_A_CLK_EN;
243 enable = MISC_A_EN;
244 offset = REG_PWM_A;
245 break;
246
247 case 1:
248 clk_shift = MISC_B_CLK_DIV_SHIFT;
249 clk_enable = MISC_B_CLK_EN;
250 enable = MISC_B_EN;
251 offset = REG_PWM_B;
252 break;
253
254 default:
255 return;
256 }
257
258 value = readl(meson->base + REG_MISC_AB);
259 value &= ~(MISC_CLK_DIV_MASK << clk_shift);
260 value |= channel->pre_div << clk_shift;
261 value |= clk_enable;
262 writel(value, meson->base + REG_MISC_AB);
263
264 value = (channel->hi << PWM_HIGH_SHIFT) | channel->lo;
265 writel(value, meson->base + offset);
266
267 value = readl(meson->base + REG_MISC_AB);
268 value |= enable;
269 writel(value, meson->base + REG_MISC_AB);
270}
271
272static void meson_pwm_disable(struct meson_pwm *meson, unsigned int id)
273{
274 u32 value, enable;
275
276 switch (id) {
277 case 0:
278 enable = MISC_A_EN;
279 break;
280
281 case 1:
282 enable = MISC_B_EN;
283 break;
284
285 default:
286 return;
287 }
288
289 value = readl(meson->base + REG_MISC_AB);
290 value &= ~enable;
291 writel(value, meson->base + REG_MISC_AB);
292}
293
294static int meson_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
295 struct pwm_state *state)
296{
297 struct meson_pwm_channel *channel = pwm_get_chip_data(pwm);
298 struct meson_pwm *meson = to_meson_pwm(chip);
299 unsigned long flags;
300 int err = 0;
301
302 if (!state)
303 return -EINVAL;
304
305 spin_lock_irqsave(&meson->lock, flags);
306
307 if (!state->enabled) {
308 meson_pwm_disable(meson, pwm->hwpwm);
309 channel->state.enabled = false;
310
311 goto unlock;
312 }
313
314 if (state->period != channel->state.period ||
315 state->duty_cycle != channel->state.duty_cycle ||
316 state->polarity != channel->state.polarity) {
317 if (channel->state.enabled) {
318 meson_pwm_disable(meson, pwm->hwpwm);
319 channel->state.enabled = false;
320 }
321
322 if (state->polarity != channel->state.polarity) {
323 if (state->polarity == PWM_POLARITY_NORMAL)
324 meson->inverter_mask |= BIT(pwm->hwpwm);
325 else
326 meson->inverter_mask &= ~BIT(pwm->hwpwm);
327 }
328
329 err = meson_pwm_calc(meson, channel, pwm->hwpwm,
330 state->duty_cycle, state->period);
331 if (err < 0)
332 goto unlock;
333
334 channel->state.polarity = state->polarity;
335 channel->state.period = state->period;
336 channel->state.duty_cycle = state->duty_cycle;
337 }
338
339 if (state->enabled && !channel->state.enabled) {
340 meson_pwm_enable(meson, channel, pwm->hwpwm);
341 channel->state.enabled = true;
342 }
343
344unlock:
345 spin_unlock_irqrestore(&meson->lock, flags);
346 return err;
347}
348
349static void meson_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
350 struct pwm_state *state)
351{
352 struct meson_pwm *meson = to_meson_pwm(chip);
353 u32 value, mask;
354
355 if (!state)
356 return;
357
358 switch (pwm->hwpwm) {
359 case 0:
360 mask = MISC_A_EN;
361 break;
362
363 case 1:
364 mask = MISC_B_EN;
365 break;
366
367 default:
368 return;
369 }
370
371 value = readl(meson->base + REG_MISC_AB);
372 state->enabled = (value & mask) != 0;
373}
374
375static const struct pwm_ops meson_pwm_ops = {
376 .request = meson_pwm_request,
377 .free = meson_pwm_free,
378 .apply = meson_pwm_apply,
379 .get_state = meson_pwm_get_state,
380 .owner = THIS_MODULE,
381};
382
383static const char * const pwm_meson8b_parent_names[] = {
384 "xtal", "vid_pll", "fclk_div4", "fclk_div3"
385};
386
387static const struct meson_pwm_data pwm_meson8b_data = {
388 .parent_names = pwm_meson8b_parent_names,
389 .num_parents = ARRAY_SIZE(pwm_meson8b_parent_names),
390};
391
392static const char * const pwm_gxbb_parent_names[] = {
393 "xtal", "hdmi_pll", "fclk_div4", "fclk_div3"
394};
395
396static const struct meson_pwm_data pwm_gxbb_data = {
397 .parent_names = pwm_gxbb_parent_names,
398 .num_parents = ARRAY_SIZE(pwm_gxbb_parent_names),
399};
400
401/*
402 * Only the 2 first inputs of the GXBB AO PWMs are valid
403 * The last 2 are grounded
404 */
405static const char * const pwm_gxbb_ao_parent_names[] = {
406 "xtal", "clk81"
407};
408
409static const struct meson_pwm_data pwm_gxbb_ao_data = {
410 .parent_names = pwm_gxbb_ao_parent_names,
411 .num_parents = ARRAY_SIZE(pwm_gxbb_ao_parent_names),
412};
413
414static const char * const pwm_axg_ee_parent_names[] = {
415 "xtal", "fclk_div5", "fclk_div4", "fclk_div3"
416};
417
418static const struct meson_pwm_data pwm_axg_ee_data = {
419 .parent_names = pwm_axg_ee_parent_names,
420 .num_parents = ARRAY_SIZE(pwm_axg_ee_parent_names),
421};
422
423static const char * const pwm_axg_ao_parent_names[] = {
424 "aoclk81", "xtal", "fclk_div4", "fclk_div5"
425};
426
427static const struct meson_pwm_data pwm_axg_ao_data = {
428 .parent_names = pwm_axg_ao_parent_names,
429 .num_parents = ARRAY_SIZE(pwm_axg_ao_parent_names),
430};
431
432static const struct of_device_id meson_pwm_matches[] = {
433 {
434 .compatible = "amlogic,meson8b-pwm",
435 .data = &pwm_meson8b_data
436 },
437 {
438 .compatible = "amlogic,meson-gxbb-pwm",
439 .data = &pwm_gxbb_data
440 },
441 {
442 .compatible = "amlogic,meson-gxbb-ao-pwm",
443 .data = &pwm_gxbb_ao_data
444 },
445 {
446 .compatible = "amlogic,meson-axg-ee-pwm",
447 .data = &pwm_axg_ee_data
448 },
449 {
450 .compatible = "amlogic,meson-axg-ao-pwm",
451 .data = &pwm_axg_ao_data
452 },
453 {},
454};
455MODULE_DEVICE_TABLE(of, meson_pwm_matches);
456
457static int meson_pwm_init_channels(struct meson_pwm *meson,
458 struct meson_pwm_channel *channels)
459{
460 struct device *dev = meson->chip.dev;
461 struct device_node *np = dev->of_node;
462 struct clk_init_data init;
463 unsigned int i;
464 char name[255];
465 int err;
466
467 for (i = 0; i < meson->chip.npwm; i++) {
468 struct meson_pwm_channel *channel = &channels[i];
469
470 snprintf(name, sizeof(name), "%pOF#mux%u", np, i);
471
472 init.name = name;
473 init.ops = &clk_mux_ops;
474 init.flags = CLK_IS_BASIC;
475 init.parent_names = meson->data->parent_names;
476 init.num_parents = meson->data->num_parents;
477
478 channel->mux.reg = meson->base + REG_MISC_AB;
479 channel->mux.shift = mux_reg_shifts[i];
480 channel->mux.mask = BIT(MISC_CLK_SEL_WIDTH) - 1;
481 channel->mux.flags = 0;
482 channel->mux.lock = &meson->lock;
483 channel->mux.table = NULL;
484 channel->mux.hw.init = &init;
485
486 channel->clk = devm_clk_register(dev, &channel->mux.hw);
487 if (IS_ERR(channel->clk)) {
488 err = PTR_ERR(channel->clk);
489 dev_err(dev, "failed to register %s: %d\n", name, err);
490 return err;
491 }
492
493 snprintf(name, sizeof(name), "clkin%u", i);
494
495 channel->clk_parent = devm_clk_get(dev, name);
496 if (IS_ERR(channel->clk_parent)) {
497 err = PTR_ERR(channel->clk_parent);
498 if (err == -EPROBE_DEFER)
499 return err;
500
501 channel->clk_parent = NULL;
502 }
503 }
504
505 return 0;
506}
507
508static void meson_pwm_add_channels(struct meson_pwm *meson,
509 struct meson_pwm_channel *channels)
510{
511 unsigned int i;
512
513 for (i = 0; i < meson->chip.npwm; i++)
514 pwm_set_chip_data(&meson->chip.pwms[i], &channels[i]);
515}
516
517static int meson_pwm_probe(struct platform_device *pdev)
518{
519 struct meson_pwm_channel *channels;
520 struct meson_pwm *meson;
521 struct resource *regs;
522 int err;
523
524 meson = devm_kzalloc(&pdev->dev, sizeof(*meson), GFP_KERNEL);
525 if (!meson)
526 return -ENOMEM;
527
528 regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
529 meson->base = devm_ioremap_resource(&pdev->dev, regs);
530 if (IS_ERR(meson->base))
531 return PTR_ERR(meson->base);
532
533 spin_lock_init(&meson->lock);
534 meson->chip.dev = &pdev->dev;
535 meson->chip.ops = &meson_pwm_ops;
536 meson->chip.base = -1;
537 meson->chip.npwm = 2;
538 meson->chip.of_xlate = of_pwm_xlate_with_flags;
539 meson->chip.of_pwm_n_cells = 3;
540
541 meson->data = of_device_get_match_data(&pdev->dev);
542 meson->inverter_mask = BIT(meson->chip.npwm) - 1;
543
544 channels = devm_kcalloc(&pdev->dev, meson->chip.npwm, sizeof(*meson),
545 GFP_KERNEL);
546 if (!channels)
547 return -ENOMEM;
548
549 err = meson_pwm_init_channels(meson, channels);
550 if (err < 0)
551 return err;
552
553 err = pwmchip_add(&meson->chip);
554 if (err < 0) {
555 dev_err(&pdev->dev, "failed to register PWM chip: %d\n", err);
556 return err;
557 }
558
559 meson_pwm_add_channels(meson, channels);
560
561 platform_set_drvdata(pdev, meson);
562
563 return 0;
564}
565
566static int meson_pwm_remove(struct platform_device *pdev)
567{
568 struct meson_pwm *meson = platform_get_drvdata(pdev);
569
570 return pwmchip_remove(&meson->chip);
571}
572
573static struct platform_driver meson_pwm_driver = {
574 .driver = {
575 .name = "meson-pwm",
576 .of_match_table = meson_pwm_matches,
577 },
578 .probe = meson_pwm_probe,
579 .remove = meson_pwm_remove,
580};
581module_platform_driver(meson_pwm_driver);
582
583MODULE_DESCRIPTION("Amlogic Meson PWM Generator driver");
584MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
585MODULE_LICENSE("Dual BSD/GPL");
1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2/*
3 * PWM controller driver for Amlogic Meson SoCs.
4 *
5 * This PWM is only a set of Gates, Dividers and Counters:
6 * PWM output is achieved by calculating a clock that permits calculating
7 * two periods (low and high). The counter then has to be set to switch after
8 * N cycles for the first half period.
9 * The hardware has no "polarity" setting. This driver reverses the period
10 * cycles (the low length is inverted with the high length) for
11 * PWM_POLARITY_INVERSED. This means that .get_state cannot read the polarity
12 * from the hardware.
13 * Setting the duty cycle will disable and re-enable the PWM output.
14 * Disabling the PWM stops the output immediately (without waiting for the
15 * current period to complete first).
16 *
17 * The public S912 (GXM) datasheet contains some documentation for this PWM
18 * controller starting on page 543:
19 * https://dl.khadas.com/Hardware/VIM2/Datasheet/S912_Datasheet_V0.220170314publicversion-Wesion.pdf
20 * An updated version of this IP block is found in S922X (G12B) SoCs. The
21 * datasheet contains the description for this IP block revision starting at
22 * page 1084:
23 * https://dn.odroid.com/S922X/ODROID-N2/Datasheet/S922X_Public_Datasheet_V0.2.pdf
24 *
25 * Copyright (c) 2016 BayLibre, SAS.
26 * Author: Neil Armstrong <narmstrong@baylibre.com>
27 * Copyright (C) 2014 Amlogic, Inc.
28 */
29
30#include <linux/bitfield.h>
31#include <linux/bits.h>
32#include <linux/clk.h>
33#include <linux/clk-provider.h>
34#include <linux/err.h>
35#include <linux/io.h>
36#include <linux/kernel.h>
37#include <linux/math64.h>
38#include <linux/module.h>
39#include <linux/of.h>
40#include <linux/platform_device.h>
41#include <linux/pwm.h>
42#include <linux/slab.h>
43#include <linux/spinlock.h>
44
45#define REG_PWM_A 0x0
46#define REG_PWM_B 0x4
47#define PWM_LOW_MASK GENMASK(15, 0)
48#define PWM_HIGH_MASK GENMASK(31, 16)
49
50#define REG_MISC_AB 0x8
51#define MISC_B_CLK_EN_SHIFT 23
52#define MISC_A_CLK_EN_SHIFT 15
53#define MISC_CLK_DIV_WIDTH 7
54#define MISC_B_CLK_DIV_SHIFT 16
55#define MISC_A_CLK_DIV_SHIFT 8
56#define MISC_B_CLK_SEL_SHIFT 6
57#define MISC_A_CLK_SEL_SHIFT 4
58#define MISC_CLK_SEL_MASK 0x3
59#define MISC_B_EN BIT(1)
60#define MISC_A_EN BIT(0)
61
62#define MESON_NUM_PWMS 2
63#define MESON_MAX_MUX_PARENTS 4
64
65static struct meson_pwm_channel_data {
66 u8 reg_offset;
67 u8 clk_sel_shift;
68 u8 clk_div_shift;
69 u8 clk_en_shift;
70 u32 pwm_en_mask;
71} meson_pwm_per_channel_data[MESON_NUM_PWMS] = {
72 {
73 .reg_offset = REG_PWM_A,
74 .clk_sel_shift = MISC_A_CLK_SEL_SHIFT,
75 .clk_div_shift = MISC_A_CLK_DIV_SHIFT,
76 .clk_en_shift = MISC_A_CLK_EN_SHIFT,
77 .pwm_en_mask = MISC_A_EN,
78 },
79 {
80 .reg_offset = REG_PWM_B,
81 .clk_sel_shift = MISC_B_CLK_SEL_SHIFT,
82 .clk_div_shift = MISC_B_CLK_DIV_SHIFT,
83 .clk_en_shift = MISC_B_CLK_EN_SHIFT,
84 .pwm_en_mask = MISC_B_EN,
85 }
86};
87
88struct meson_pwm_channel {
89 unsigned long rate;
90 unsigned int hi;
91 unsigned int lo;
92
93 struct clk_mux mux;
94 struct clk_divider div;
95 struct clk_gate gate;
96 struct clk *clk;
97};
98
99struct meson_pwm_data {
100 const char * const *parent_names;
101 unsigned int num_parents;
102};
103
104struct meson_pwm {
105 struct pwm_chip chip;
106 const struct meson_pwm_data *data;
107 struct meson_pwm_channel channels[MESON_NUM_PWMS];
108 void __iomem *base;
109 /*
110 * Protects register (write) access to the REG_MISC_AB register
111 * that is shared between the two PWMs.
112 */
113 spinlock_t lock;
114};
115
116static inline struct meson_pwm *to_meson_pwm(struct pwm_chip *chip)
117{
118 return container_of(chip, struct meson_pwm, chip);
119}
120
121static int meson_pwm_request(struct pwm_chip *chip, struct pwm_device *pwm)
122{
123 struct meson_pwm *meson = to_meson_pwm(chip);
124 struct meson_pwm_channel *channel = &meson->channels[pwm->hwpwm];
125 struct device *dev = chip->dev;
126 int err;
127
128 err = clk_prepare_enable(channel->clk);
129 if (err < 0) {
130 dev_err(dev, "failed to enable clock %s: %d\n",
131 __clk_get_name(channel->clk), err);
132 return err;
133 }
134
135 return 0;
136}
137
138static void meson_pwm_free(struct pwm_chip *chip, struct pwm_device *pwm)
139{
140 struct meson_pwm *meson = to_meson_pwm(chip);
141 struct meson_pwm_channel *channel = &meson->channels[pwm->hwpwm];
142
143 clk_disable_unprepare(channel->clk);
144}
145
146static int meson_pwm_calc(struct meson_pwm *meson, struct pwm_device *pwm,
147 const struct pwm_state *state)
148{
149 struct meson_pwm_channel *channel = &meson->channels[pwm->hwpwm];
150 unsigned int cnt, duty_cnt;
151 unsigned long fin_freq;
152 u64 duty, period, freq;
153
154 duty = state->duty_cycle;
155 period = state->period;
156
157 /*
158 * Note this is wrong. The result is an output wave that isn't really
159 * inverted and so is wrongly identified by .get_state as normal.
160 * Fixing this needs some care however as some machines might rely on
161 * this.
162 */
163 if (state->polarity == PWM_POLARITY_INVERSED)
164 duty = period - duty;
165
166 freq = div64_u64(NSEC_PER_SEC * 0xffffULL, period);
167 if (freq > ULONG_MAX)
168 freq = ULONG_MAX;
169
170 fin_freq = clk_round_rate(channel->clk, freq);
171 if (fin_freq == 0) {
172 dev_err(meson->chip.dev, "invalid source clock frequency\n");
173 return -EINVAL;
174 }
175
176 dev_dbg(meson->chip.dev, "fin_freq: %lu Hz\n", fin_freq);
177
178 cnt = div_u64(fin_freq * period, NSEC_PER_SEC);
179 if (cnt > 0xffff) {
180 dev_err(meson->chip.dev, "unable to get period cnt\n");
181 return -EINVAL;
182 }
183
184 dev_dbg(meson->chip.dev, "period=%llu cnt=%u\n", period, cnt);
185
186 if (duty == period) {
187 channel->hi = cnt;
188 channel->lo = 0;
189 } else if (duty == 0) {
190 channel->hi = 0;
191 channel->lo = cnt;
192 } else {
193 duty_cnt = div_u64(fin_freq * duty, NSEC_PER_SEC);
194
195 dev_dbg(meson->chip.dev, "duty=%llu duty_cnt=%u\n", duty, duty_cnt);
196
197 channel->hi = duty_cnt;
198 channel->lo = cnt - duty_cnt;
199 }
200
201 channel->rate = fin_freq;
202
203 return 0;
204}
205
206static void meson_pwm_enable(struct meson_pwm *meson, struct pwm_device *pwm)
207{
208 struct meson_pwm_channel *channel = &meson->channels[pwm->hwpwm];
209 struct meson_pwm_channel_data *channel_data;
210 unsigned long flags;
211 u32 value;
212 int err;
213
214 channel_data = &meson_pwm_per_channel_data[pwm->hwpwm];
215
216 err = clk_set_rate(channel->clk, channel->rate);
217 if (err)
218 dev_err(meson->chip.dev, "setting clock rate failed\n");
219
220 spin_lock_irqsave(&meson->lock, flags);
221
222 value = FIELD_PREP(PWM_HIGH_MASK, channel->hi) |
223 FIELD_PREP(PWM_LOW_MASK, channel->lo);
224 writel(value, meson->base + channel_data->reg_offset);
225
226 value = readl(meson->base + REG_MISC_AB);
227 value |= channel_data->pwm_en_mask;
228 writel(value, meson->base + REG_MISC_AB);
229
230 spin_unlock_irqrestore(&meson->lock, flags);
231}
232
233static void meson_pwm_disable(struct meson_pwm *meson, struct pwm_device *pwm)
234{
235 unsigned long flags;
236 u32 value;
237
238 spin_lock_irqsave(&meson->lock, flags);
239
240 value = readl(meson->base + REG_MISC_AB);
241 value &= ~meson_pwm_per_channel_data[pwm->hwpwm].pwm_en_mask;
242 writel(value, meson->base + REG_MISC_AB);
243
244 spin_unlock_irqrestore(&meson->lock, flags);
245}
246
247static int meson_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
248 const struct pwm_state *state)
249{
250 struct meson_pwm *meson = to_meson_pwm(chip);
251 struct meson_pwm_channel *channel = &meson->channels[pwm->hwpwm];
252 int err = 0;
253
254 if (!state->enabled) {
255 if (state->polarity == PWM_POLARITY_INVERSED) {
256 /*
257 * This IP block revision doesn't have an "always high"
258 * setting which we can use for "inverted disabled".
259 * Instead we achieve this by setting mux parent with
260 * highest rate and minimum divider value, resulting
261 * in the shortest possible duration for one "count"
262 * and "period == duty_cycle". This results in a signal
263 * which is LOW for one "count", while being HIGH for
264 * the rest of the (so the signal is HIGH for slightly
265 * less than 100% of the period, but this is the best
266 * we can achieve).
267 */
268 channel->rate = ULONG_MAX;
269 channel->hi = ~0;
270 channel->lo = 0;
271
272 meson_pwm_enable(meson, pwm);
273 } else {
274 meson_pwm_disable(meson, pwm);
275 }
276 } else {
277 err = meson_pwm_calc(meson, pwm, state);
278 if (err < 0)
279 return err;
280
281 meson_pwm_enable(meson, pwm);
282 }
283
284 return 0;
285}
286
287static u64 meson_pwm_cnt_to_ns(struct pwm_chip *chip, struct pwm_device *pwm,
288 u32 cnt)
289{
290 struct meson_pwm *meson = to_meson_pwm(chip);
291 struct meson_pwm_channel *channel;
292 unsigned long fin_freq;
293
294 /* to_meson_pwm() can only be used after .get_state() is called */
295 channel = &meson->channels[pwm->hwpwm];
296
297 fin_freq = clk_get_rate(channel->clk);
298 if (fin_freq == 0)
299 return 0;
300
301 return div64_ul(NSEC_PER_SEC * (u64)cnt, fin_freq);
302}
303
304static int meson_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
305 struct pwm_state *state)
306{
307 struct meson_pwm *meson = to_meson_pwm(chip);
308 struct meson_pwm_channel_data *channel_data;
309 struct meson_pwm_channel *channel;
310 u32 value;
311
312 if (!state)
313 return 0;
314
315 channel = &meson->channels[pwm->hwpwm];
316 channel_data = &meson_pwm_per_channel_data[pwm->hwpwm];
317
318 value = readl(meson->base + REG_MISC_AB);
319 state->enabled = value & channel_data->pwm_en_mask;
320
321 value = readl(meson->base + channel_data->reg_offset);
322 channel->lo = FIELD_GET(PWM_LOW_MASK, value);
323 channel->hi = FIELD_GET(PWM_HIGH_MASK, value);
324
325 state->period = meson_pwm_cnt_to_ns(chip, pwm, channel->lo + channel->hi);
326 state->duty_cycle = meson_pwm_cnt_to_ns(chip, pwm, channel->hi);
327
328 state->polarity = PWM_POLARITY_NORMAL;
329
330 return 0;
331}
332
333static const struct pwm_ops meson_pwm_ops = {
334 .request = meson_pwm_request,
335 .free = meson_pwm_free,
336 .apply = meson_pwm_apply,
337 .get_state = meson_pwm_get_state,
338};
339
340static const char * const pwm_meson8b_parent_names[] = {
341 "xtal", NULL, "fclk_div4", "fclk_div3"
342};
343
344static const struct meson_pwm_data pwm_meson8b_data = {
345 .parent_names = pwm_meson8b_parent_names,
346 .num_parents = ARRAY_SIZE(pwm_meson8b_parent_names),
347};
348
349/*
350 * Only the 2 first inputs of the GXBB AO PWMs are valid
351 * The last 2 are grounded
352 */
353static const char * const pwm_gxbb_ao_parent_names[] = {
354 "xtal", "clk81"
355};
356
357static const struct meson_pwm_data pwm_gxbb_ao_data = {
358 .parent_names = pwm_gxbb_ao_parent_names,
359 .num_parents = ARRAY_SIZE(pwm_gxbb_ao_parent_names),
360};
361
362static const char * const pwm_axg_ee_parent_names[] = {
363 "xtal", "fclk_div5", "fclk_div4", "fclk_div3"
364};
365
366static const struct meson_pwm_data pwm_axg_ee_data = {
367 .parent_names = pwm_axg_ee_parent_names,
368 .num_parents = ARRAY_SIZE(pwm_axg_ee_parent_names),
369};
370
371static const char * const pwm_axg_ao_parent_names[] = {
372 "xtal", "axg_ao_clk81", "fclk_div4", "fclk_div5"
373};
374
375static const struct meson_pwm_data pwm_axg_ao_data = {
376 .parent_names = pwm_axg_ao_parent_names,
377 .num_parents = ARRAY_SIZE(pwm_axg_ao_parent_names),
378};
379
380static const char * const pwm_g12a_ao_ab_parent_names[] = {
381 "xtal", "g12a_ao_clk81", "fclk_div4", "fclk_div5"
382};
383
384static const struct meson_pwm_data pwm_g12a_ao_ab_data = {
385 .parent_names = pwm_g12a_ao_ab_parent_names,
386 .num_parents = ARRAY_SIZE(pwm_g12a_ao_ab_parent_names),
387};
388
389static const char * const pwm_g12a_ao_cd_parent_names[] = {
390 "xtal", "g12a_ao_clk81",
391};
392
393static const struct meson_pwm_data pwm_g12a_ao_cd_data = {
394 .parent_names = pwm_g12a_ao_cd_parent_names,
395 .num_parents = ARRAY_SIZE(pwm_g12a_ao_cd_parent_names),
396};
397
398static const struct of_device_id meson_pwm_matches[] = {
399 {
400 .compatible = "amlogic,meson8b-pwm",
401 .data = &pwm_meson8b_data
402 },
403 {
404 .compatible = "amlogic,meson-gxbb-pwm",
405 .data = &pwm_meson8b_data
406 },
407 {
408 .compatible = "amlogic,meson-gxbb-ao-pwm",
409 .data = &pwm_gxbb_ao_data
410 },
411 {
412 .compatible = "amlogic,meson-axg-ee-pwm",
413 .data = &pwm_axg_ee_data
414 },
415 {
416 .compatible = "amlogic,meson-axg-ao-pwm",
417 .data = &pwm_axg_ao_data
418 },
419 {
420 .compatible = "amlogic,meson-g12a-ee-pwm",
421 .data = &pwm_meson8b_data
422 },
423 {
424 .compatible = "amlogic,meson-g12a-ao-pwm-ab",
425 .data = &pwm_g12a_ao_ab_data
426 },
427 {
428 .compatible = "amlogic,meson-g12a-ao-pwm-cd",
429 .data = &pwm_g12a_ao_cd_data
430 },
431 {},
432};
433MODULE_DEVICE_TABLE(of, meson_pwm_matches);
434
435static int meson_pwm_init_channels(struct meson_pwm *meson)
436{
437 struct clk_parent_data mux_parent_data[MESON_MAX_MUX_PARENTS] = {};
438 struct device *dev = meson->chip.dev;
439 unsigned int i;
440 char name[255];
441 int err;
442
443 for (i = 0; i < meson->data->num_parents; i++) {
444 mux_parent_data[i].index = -1;
445 mux_parent_data[i].name = meson->data->parent_names[i];
446 }
447
448 for (i = 0; i < meson->chip.npwm; i++) {
449 struct meson_pwm_channel *channel = &meson->channels[i];
450 struct clk_parent_data div_parent = {}, gate_parent = {};
451 struct clk_init_data init = {};
452
453 snprintf(name, sizeof(name), "%s#mux%u", dev_name(dev), i);
454
455 init.name = name;
456 init.ops = &clk_mux_ops;
457 init.flags = 0;
458 init.parent_data = mux_parent_data;
459 init.num_parents = meson->data->num_parents;
460
461 channel->mux.reg = meson->base + REG_MISC_AB;
462 channel->mux.shift =
463 meson_pwm_per_channel_data[i].clk_sel_shift;
464 channel->mux.mask = MISC_CLK_SEL_MASK;
465 channel->mux.flags = 0;
466 channel->mux.lock = &meson->lock;
467 channel->mux.table = NULL;
468 channel->mux.hw.init = &init;
469
470 err = devm_clk_hw_register(dev, &channel->mux.hw);
471 if (err)
472 return dev_err_probe(dev, err,
473 "failed to register %s\n", name);
474
475 snprintf(name, sizeof(name), "%s#div%u", dev_name(dev), i);
476
477 init.name = name;
478 init.ops = &clk_divider_ops;
479 init.flags = CLK_SET_RATE_PARENT;
480 div_parent.index = -1;
481 div_parent.hw = &channel->mux.hw;
482 init.parent_data = &div_parent;
483 init.num_parents = 1;
484
485 channel->div.reg = meson->base + REG_MISC_AB;
486 channel->div.shift = meson_pwm_per_channel_data[i].clk_div_shift;
487 channel->div.width = MISC_CLK_DIV_WIDTH;
488 channel->div.hw.init = &init;
489 channel->div.flags = 0;
490 channel->div.lock = &meson->lock;
491
492 err = devm_clk_hw_register(dev, &channel->div.hw);
493 if (err)
494 return dev_err_probe(dev, err,
495 "failed to register %s\n", name);
496
497 snprintf(name, sizeof(name), "%s#gate%u", dev_name(dev), i);
498
499 init.name = name;
500 init.ops = &clk_gate_ops;
501 init.flags = CLK_SET_RATE_PARENT | CLK_IGNORE_UNUSED;
502 gate_parent.index = -1;
503 gate_parent.hw = &channel->div.hw;
504 init.parent_data = &gate_parent;
505 init.num_parents = 1;
506
507 channel->gate.reg = meson->base + REG_MISC_AB;
508 channel->gate.bit_idx = meson_pwm_per_channel_data[i].clk_en_shift;
509 channel->gate.hw.init = &init;
510 channel->gate.flags = 0;
511 channel->gate.lock = &meson->lock;
512
513 err = devm_clk_hw_register(dev, &channel->gate.hw);
514 if (err)
515 return dev_err_probe(dev, err, "failed to register %s\n", name);
516
517 channel->clk = devm_clk_hw_get_clk(dev, &channel->gate.hw, NULL);
518 if (IS_ERR(channel->clk))
519 return dev_err_probe(dev, PTR_ERR(channel->clk),
520 "failed to register %s\n", name);
521 }
522
523 return 0;
524}
525
526static int meson_pwm_probe(struct platform_device *pdev)
527{
528 struct meson_pwm *meson;
529 int err;
530
531 meson = devm_kzalloc(&pdev->dev, sizeof(*meson), GFP_KERNEL);
532 if (!meson)
533 return -ENOMEM;
534
535 meson->base = devm_platform_ioremap_resource(pdev, 0);
536 if (IS_ERR(meson->base))
537 return PTR_ERR(meson->base);
538
539 spin_lock_init(&meson->lock);
540 meson->chip.dev = &pdev->dev;
541 meson->chip.ops = &meson_pwm_ops;
542 meson->chip.npwm = MESON_NUM_PWMS;
543
544 meson->data = of_device_get_match_data(&pdev->dev);
545
546 err = meson_pwm_init_channels(meson);
547 if (err < 0)
548 return err;
549
550 err = devm_pwmchip_add(&pdev->dev, &meson->chip);
551 if (err < 0)
552 return dev_err_probe(&pdev->dev, err,
553 "failed to register PWM chip\n");
554
555 return 0;
556}
557
558static struct platform_driver meson_pwm_driver = {
559 .driver = {
560 .name = "meson-pwm",
561 .of_match_table = meson_pwm_matches,
562 },
563 .probe = meson_pwm_probe,
564};
565module_platform_driver(meson_pwm_driver);
566
567MODULE_DESCRIPTION("Amlogic Meson PWM Generator driver");
568MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
569MODULE_LICENSE("Dual BSD/GPL");