xref: /linux/drivers/clk/clk-sp7021.c (revision 55a42f78ffd386e01a5404419f8c5ded7db70a21)
1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
2 /*
3  * Copyright (C) Sunplus Technology Co., Ltd.
4  *       All rights reserved.
5  */
6 #include <linux/module.h>
7 #include <linux/clk-provider.h>
8 #include <linux/of.h>
9 #include <linux/bitfield.h>
10 #include <linux/hw_bitfield.h>
11 #include <linux/slab.h>
12 #include <linux/io.h>
13 #include <linux/err.h>
14 #include <linux/platform_device.h>
15 
16 #include <dt-bindings/clock/sunplus,sp7021-clkc.h>
17 
18 /* special div_width values for PLLTV/PLLA */
19 #define DIV_TV		33
20 #define DIV_A		34
21 
22 /* PLLTV parameters */
23 enum {
24 	SEL_FRA,
25 	SDM_MOD,
26 	PH_SEL,
27 	NFRA,
28 	DIVR,
29 	DIVN,
30 	DIVM,
31 	P_MAX
32 };
33 
34 #define MASK_SEL_FRA	GENMASK(1, 1)
35 #define MASK_SDM_MOD	GENMASK(2, 2)
36 #define MASK_PH_SEL	GENMASK(4, 4)
37 #define MASK_NFRA	GENMASK(12, 6)
38 #define MASK_DIVR	GENMASK(8, 7)
39 #define MASK_DIVN	GENMASK(7, 0)
40 #define MASK_DIVM	GENMASK(14, 8)
41 
42 struct sp_pll {
43 	struct clk_hw hw;
44 	void __iomem *reg;
45 	spinlock_t lock;	/* lock for reg */
46 	int div_shift;
47 	int div_width;
48 	int pd_bit;		/* power down bit idx */
49 	int bp_bit;		/* bypass bit idx */
50 	unsigned long brate;	/* base rate, TODO: replace brate with muldiv */
51 	u32 p[P_MAX];		/* for hold PLLTV/PLLA parameters */
52 };
53 
54 #define to_sp_pll(_hw)	container_of(_hw, struct sp_pll, hw)
55 
56 struct sp_clk_gate_info {
57 	u16	reg;		/* reg_index_shift */
58 	u16	ext_parent;	/* parent is extclk */
59 };
60 
61 static const struct sp_clk_gate_info sp_clk_gates[] = {
62 	{ 0x02 },
63 	{ 0x05 },
64 	{ 0x06 },
65 	{ 0x07 },
66 	{ 0x09 },
67 	{ 0x0b, 1 },
68 	{ 0x0f, 1 },
69 	{ 0x14 },
70 	{ 0x15 },
71 	{ 0x16 },
72 	{ 0x17 },
73 	{ 0x18, 1 },
74 	{ 0x19, 1 },
75 	{ 0x1a, 1 },
76 	{ 0x1b, 1 },
77 	{ 0x1c, 1 },
78 	{ 0x1d, 1 },
79 	{ 0x1e },
80 	{ 0x1f, 1 },
81 	{ 0x20 },
82 	{ 0x21 },
83 	{ 0x22 },
84 	{ 0x23 },
85 	{ 0x24 },
86 	{ 0x25 },
87 	{ 0x26 },
88 	{ 0x2a },
89 	{ 0x2b },
90 	{ 0x2d },
91 	{ 0x2e },
92 	{ 0x30 },
93 	{ 0x31 },
94 	{ 0x32 },
95 	{ 0x33 },
96 	{ 0x3d },
97 	{ 0x3e },
98 	{ 0x3f },
99 	{ 0x42 },
100 	{ 0x44 },
101 	{ 0x4b },
102 	{ 0x4c },
103 	{ 0x4d },
104 	{ 0x4e },
105 	{ 0x4f },
106 	{ 0x50 },
107 	{ 0x55 },
108 	{ 0x60 },
109 	{ 0x61 },
110 	{ 0x6a },
111 	{ 0x73 },
112 	{ 0x86 },
113 	{ 0x8a },
114 	{ 0x8b },
115 	{ 0x8d },
116 	{ 0x8e },
117 	{ 0x8f },
118 	{ 0x90 },
119 	{ 0x92 },
120 	{ 0x93 },
121 	{ 0x95 },
122 	{ 0x96 },
123 	{ 0x97 },
124 	{ 0x98 },
125 	{ 0x99 },
126 };
127 
128 #define _M		1000000UL
129 #define F_27M		(27 * _M)
130 
131 /*********************************** PLL_TV **********************************/
132 
133 /* TODO: set proper FVCO range */
134 #define FVCO_MIN	(100 * _M)
135 #define FVCO_MAX	(200 * _M)
136 
137 #define F_MIN		(FVCO_MIN / 8)
138 #define F_MAX		(FVCO_MAX)
139 
140 static long plltv_integer_div(struct sp_pll *clk, unsigned long freq)
141 {
142 	/* valid m values: 27M must be divisible by m */
143 	static const u32 m_table[] = {
144 		1, 2, 3, 4, 5, 6, 8, 9, 10, 12, 15, 16, 18, 20, 24, 25, 27, 30, 32
145 	};
146 	u32 m, n, r;
147 	unsigned long fvco, nf;
148 	long ret;
149 
150 	freq = clamp(freq, F_MIN, F_MAX);
151 
152 	/* DIVR 0~3 */
153 	for (r = 0; r <= 3; r++) {
154 		fvco = freq << r;
155 		if (fvco <= FVCO_MAX)
156 			break;
157 	}
158 
159 	/* DIVM */
160 	for (m = 0; m < ARRAY_SIZE(m_table); m++) {
161 		nf = fvco * m_table[m];
162 		n = nf / F_27M;
163 		if ((n * F_27M) == nf)
164 			break;
165 	}
166 	if (m >= ARRAY_SIZE(m_table)) {
167 		ret = -EINVAL;
168 		goto err_not_found;
169 	}
170 
171 	/* save parameters */
172 	clk->p[SEL_FRA] = 0;
173 	clk->p[DIVR]    = r;
174 	clk->p[DIVN]    = n;
175 	clk->p[DIVM]    = m_table[m];
176 
177 	return freq;
178 
179 err_not_found:
180 	pr_err("%s: %s freq:%lu not found a valid setting\n",
181 	       __func__, clk_hw_get_name(&clk->hw), freq);
182 
183 	return ret;
184 }
185 
186 /* parameters for PLLTV fractional divider */
187 static const u32 pt[][5] = {
188 	/* conventional fractional */
189 	{
190 		1,			/* factor */
191 		5,			/* 5 * p0 (nint) */
192 		1,			/* 1 * p0 */
193 		F_27M,			/* F_27M / p0 */
194 		1,			/* p0 / p2 */
195 	},
196 	/* phase rotation */
197 	{
198 		10,			/* factor */
199 		54,			/* 5.4 * p0 (nint) */
200 		2,			/* 0.2 * p0 */
201 		F_27M / 10,		/* F_27M / p0 */
202 		5,			/* p0 / p2 */
203 	},
204 };
205 
206 static const u32 sdm_mod_vals[] = { 91, 55 };
207 
208 static long plltv_fractional_div(struct sp_pll *clk, unsigned long freq)
209 {
210 	u32 m, r;
211 	u32 nint, nfra;
212 	u32 df_quotient_min = 210000000;
213 	u32 df_remainder_min = 0;
214 	unsigned long fvco, nf, f, fout = 0;
215 	int sdm, ph;
216 
217 	freq = clamp(freq, F_MIN, F_MAX);
218 
219 	/* DIVR 0~3 */
220 	for (r = 0; r <= 3; r++) {
221 		fvco = freq << r;
222 		if (fvco <= FVCO_MAX)
223 			break;
224 	}
225 	f = F_27M >> r;
226 
227 	/* PH_SEL */
228 	for (ph = ARRAY_SIZE(pt) - 1; ph >= 0; ph--) {
229 		const u32 *pp = pt[ph];
230 
231 		/* SDM_MOD */
232 		for (sdm = 0; sdm < ARRAY_SIZE(sdm_mod_vals); sdm++) {
233 			u32 mod = sdm_mod_vals[sdm];
234 
235 			/* DIVM 1~32 */
236 			for (m = 1; m <= 32; m++) {
237 				u32 df; /* diff freq */
238 				u32 df_quotient, df_remainder;
239 
240 				nf = fvco * m;
241 				nint = nf / pp[3];
242 
243 				if (nint < pp[1])
244 					continue;
245 				if (nint > pp[1])
246 					break;
247 
248 				nfra = (((nf % pp[3]) * mod * pp[4]) + (F_27M / 2)) / F_27M;
249 				if (nfra) {
250 					u32 df0 = f * (nint + pp[2]) / pp[0];
251 					u32 df1 = f * (mod - nfra) / mod / pp[4];
252 
253 					df = df0 - df1;
254 				} else {
255 					df = f * (nint) / pp[0];
256 				}
257 
258 				df_quotient  = df / m;
259 				df_remainder = ((df % m) * 1000) / m;
260 
261 				if (freq > df_quotient) {
262 					df_quotient  = freq - df_quotient - 1;
263 					df_remainder = 1000 - df_remainder;
264 				} else {
265 					df_quotient = df_quotient - freq;
266 				}
267 
268 				if (df_quotient_min > df_quotient ||
269 				    (df_quotient_min == df_quotient &&
270 				    df_remainder_min > df_remainder)) {
271 					/* found a closer freq, save parameters */
272 					clk->p[SEL_FRA] = 1;
273 					clk->p[SDM_MOD] = sdm;
274 					clk->p[PH_SEL]  = ph;
275 					clk->p[NFRA]    = nfra;
276 					clk->p[DIVR]    = r;
277 					clk->p[DIVM]    = m;
278 
279 					fout = df / m;
280 					df_quotient_min = df_quotient;
281 					df_remainder_min = df_remainder;
282 				}
283 			}
284 		}
285 	}
286 
287 	if (!fout) {
288 		pr_err("%s: %s freq:%lu not found a valid setting\n",
289 		       __func__, clk_hw_get_name(&clk->hw), freq);
290 		return -EINVAL;
291 	}
292 
293 	return fout;
294 }
295 
296 static long plltv_div(struct sp_pll *clk, unsigned long freq)
297 {
298 	if (freq % 100)
299 		return plltv_fractional_div(clk, freq);
300 
301 	return plltv_integer_div(clk, freq);
302 }
303 
304 static int plltv_set_rate(struct sp_pll *clk)
305 {
306 	unsigned long flags;
307 	u32 r0, r1, r2;
308 
309 	r0  = BIT(clk->bp_bit + 16);
310 	r0 |= FIELD_PREP_WM16(MASK_SEL_FRA, clk->p[SEL_FRA]);
311 	r0 |= FIELD_PREP_WM16(MASK_SDM_MOD, clk->p[SDM_MOD]);
312 	r0 |= FIELD_PREP_WM16(MASK_PH_SEL, clk->p[PH_SEL]);
313 	r0 |= FIELD_PREP_WM16(MASK_NFRA, clk->p[NFRA]);
314 
315 	r1  = FIELD_PREP_WM16(MASK_DIVR, clk->p[DIVR]);
316 
317 	r2  = FIELD_PREP_WM16(MASK_DIVN, clk->p[DIVN] - 1);
318 	r2 |= FIELD_PREP_WM16(MASK_DIVM, clk->p[DIVM] - 1);
319 
320 	spin_lock_irqsave(&clk->lock, flags);
321 	writel(r0, clk->reg);
322 	writel(r1, clk->reg + 4);
323 	writel(r2, clk->reg + 8);
324 	spin_unlock_irqrestore(&clk->lock, flags);
325 
326 	return 0;
327 }
328 
329 /*********************************** PLL_A ***********************************/
330 
331 /* from Q628_PLLs_REG_setting.xlsx */
332 static const struct {
333 	u32 rate;
334 	u32 regs[5];
335 } pa[] = {
336 	{
337 		.rate = 135475200,
338 		.regs = {
339 			0x4801,
340 			0x02df,
341 			0x248f,
342 			0x0211,
343 			0x33e9
344 		}
345 	},
346 	{
347 		.rate = 147456000,
348 		.regs = {
349 			0x4801,
350 			0x1adf,
351 			0x2490,
352 			0x0349,
353 			0x33e9
354 		}
355 	},
356 	{
357 		.rate = 196608000,
358 		.regs = {
359 			0x4801,
360 			0x42ef,
361 			0x2495,
362 			0x01c6,
363 			0x33e9
364 		}
365 	},
366 };
367 
368 static int plla_set_rate(struct sp_pll *clk)
369 {
370 	const u32 *pp = pa[clk->p[0]].regs;
371 	unsigned long flags;
372 	int i;
373 
374 	spin_lock_irqsave(&clk->lock, flags);
375 	for (i = 0; i < ARRAY_SIZE(pa->regs); i++)
376 		writel(0xffff0000 | pp[i], clk->reg + (i * 4));
377 	spin_unlock_irqrestore(&clk->lock, flags);
378 
379 	return 0;
380 }
381 
382 static long plla_round_rate(struct sp_pll *clk, unsigned long rate)
383 {
384 	int i = ARRAY_SIZE(pa);
385 
386 	while (--i) {
387 		if (rate >= pa[i].rate)
388 			break;
389 	}
390 	clk->p[0] = i;
391 
392 	return pa[i].rate;
393 }
394 
395 /********************************** SP_PLL ***********************************/
396 
397 static long sp_pll_calc_div(struct sp_pll *clk, unsigned long rate)
398 {
399 	u32 fbdiv;
400 	u32 max = 1 << clk->div_width;
401 
402 	fbdiv = DIV_ROUND_CLOSEST(rate, clk->brate);
403 	if (fbdiv > max)
404 		fbdiv = max;
405 
406 	return fbdiv;
407 }
408 
409 static long sp_pll_round_rate(struct clk_hw *hw, unsigned long rate,
410 			      unsigned long *prate)
411 {
412 	struct sp_pll *clk = to_sp_pll(hw);
413 	long ret;
414 
415 	if (rate == *prate) {
416 		ret = *prate; /* bypass */
417 	} else if (clk->div_width == DIV_A) {
418 		ret = plla_round_rate(clk, rate);
419 	} else if (clk->div_width == DIV_TV) {
420 		ret = plltv_div(clk, rate);
421 		if (ret < 0)
422 			ret = *prate;
423 	} else {
424 		ret = sp_pll_calc_div(clk, rate) * clk->brate;
425 	}
426 
427 	return ret;
428 }
429 
430 static unsigned long sp_pll_recalc_rate(struct clk_hw *hw,
431 					unsigned long prate)
432 {
433 	struct sp_pll *clk = to_sp_pll(hw);
434 	u32 reg = readl(clk->reg);
435 	unsigned long ret;
436 
437 	if (reg & BIT(clk->bp_bit)) {
438 		ret = prate; /* bypass */
439 	} else if (clk->div_width == DIV_A) {
440 		ret = pa[clk->p[0]].rate;
441 	} else if (clk->div_width == DIV_TV) {
442 		u32 m, r, reg2;
443 
444 		r = FIELD_GET(MASK_DIVR, readl(clk->reg + 4));
445 		reg2 = readl(clk->reg + 8);
446 		m = FIELD_GET(MASK_DIVM, reg2) + 1;
447 
448 		if (reg & MASK_SEL_FRA) {
449 			/* fractional divider */
450 			u32 sdm  = FIELD_GET(MASK_SDM_MOD, reg);
451 			u32 ph   = FIELD_GET(MASK_PH_SEL, reg);
452 			u32 nfra = FIELD_GET(MASK_NFRA, reg);
453 			const u32 *pp = pt[ph];
454 			unsigned long r0, r1;
455 
456 			ret = prate >> r;
457 			r0  = ret * (pp[1] + pp[2]) / pp[0];
458 			r1  = ret * (sdm_mod_vals[sdm] - nfra) / sdm_mod_vals[sdm] / pp[4];
459 			ret = (r0 - r1) / m;
460 		} else {
461 			/* integer divider */
462 			u32 n = FIELD_GET(MASK_DIVN, reg2) + 1;
463 
464 			ret = (prate / m * n) >> r;
465 		}
466 	} else {
467 		u32 fbdiv = ((reg >> clk->div_shift) & ((1 << clk->div_width) - 1)) + 1;
468 
469 		ret = clk->brate * fbdiv;
470 	}
471 
472 	return ret;
473 }
474 
475 static int sp_pll_set_rate(struct clk_hw *hw, unsigned long rate,
476 			   unsigned long prate)
477 {
478 	struct sp_pll *clk = to_sp_pll(hw);
479 	unsigned long flags;
480 	u32 reg;
481 
482 	reg = BIT(clk->bp_bit + 16); /* HIWORD_MASK */
483 
484 	if (rate == prate) {
485 		reg |= BIT(clk->bp_bit); /* bypass */
486 	} else if (clk->div_width == DIV_A) {
487 		return plla_set_rate(clk);
488 	} else if (clk->div_width == DIV_TV) {
489 		return plltv_set_rate(clk);
490 	} else if (clk->div_width) {
491 		u32 fbdiv = sp_pll_calc_div(clk, rate);
492 		u32 mask = GENMASK(clk->div_shift + clk->div_width - 1, clk->div_shift);
493 
494 		reg |= mask << 16;
495 		reg |= ((fbdiv - 1) << clk->div_shift) & mask;
496 	}
497 
498 	spin_lock_irqsave(&clk->lock, flags);
499 	writel(reg, clk->reg);
500 	spin_unlock_irqrestore(&clk->lock, flags);
501 
502 	return 0;
503 }
504 
505 static int sp_pll_enable(struct clk_hw *hw)
506 {
507 	struct sp_pll *clk = to_sp_pll(hw);
508 
509 	writel(BIT(clk->pd_bit + 16) | BIT(clk->pd_bit), clk->reg);
510 
511 	return 0;
512 }
513 
514 static void sp_pll_disable(struct clk_hw *hw)
515 {
516 	struct sp_pll *clk = to_sp_pll(hw);
517 
518 	writel(BIT(clk->pd_bit + 16), clk->reg);
519 }
520 
521 static int sp_pll_is_enabled(struct clk_hw *hw)
522 {
523 	struct sp_pll *clk = to_sp_pll(hw);
524 
525 	return readl(clk->reg) & BIT(clk->pd_bit);
526 }
527 
528 static const struct clk_ops sp_pll_ops = {
529 	.enable = sp_pll_enable,
530 	.disable = sp_pll_disable,
531 	.is_enabled = sp_pll_is_enabled,
532 	.round_rate = sp_pll_round_rate,
533 	.recalc_rate = sp_pll_recalc_rate,
534 	.set_rate = sp_pll_set_rate
535 };
536 
537 static const struct clk_ops sp_pll_sub_ops = {
538 	.enable = sp_pll_enable,
539 	.disable = sp_pll_disable,
540 	.is_enabled = sp_pll_is_enabled,
541 	.recalc_rate = sp_pll_recalc_rate,
542 };
543 
544 static struct clk_hw *sp_pll_register(struct device *dev, const char *name,
545 				      const struct clk_parent_data *parent_data,
546 				      void __iomem *reg, int pd_bit, int bp_bit,
547 				      unsigned long brate, int shift, int width,
548 				      unsigned long flags)
549 {
550 	struct sp_pll *pll;
551 	struct clk_hw *hw;
552 	struct clk_init_data initd = {
553 		.name = name,
554 		.parent_data = parent_data,
555 		.ops = (bp_bit >= 0) ? &sp_pll_ops : &sp_pll_sub_ops,
556 		.num_parents = 1,
557 		.flags = flags,
558 	};
559 	int ret;
560 
561 	pll = devm_kzalloc(dev, sizeof(*pll), GFP_KERNEL);
562 	if (!pll)
563 		return ERR_PTR(-ENOMEM);
564 
565 	pll->hw.init = &initd;
566 	pll->reg = reg;
567 	pll->pd_bit = pd_bit;
568 	pll->bp_bit = bp_bit;
569 	pll->brate = brate;
570 	pll->div_shift = shift;
571 	pll->div_width = width;
572 	spin_lock_init(&pll->lock);
573 
574 	hw = &pll->hw;
575 	ret = devm_clk_hw_register(dev, hw);
576 	if (ret)
577 		return ERR_PTR(ret);
578 
579 	return hw;
580 }
581 
582 #define PLLA_CTL	(pll_base + 0x1c)
583 #define PLLE_CTL	(pll_base + 0x30)
584 #define PLLF_CTL	(pll_base + 0x34)
585 #define PLLTV_CTL	(pll_base + 0x38)
586 
587 static int sp7021_clk_probe(struct platform_device *pdev)
588 {
589 	static const u32 sp_clken[] = {
590 		0x67ef, 0x03ff, 0xff03, 0xfff0, 0x0004, /* G0.1~5  */
591 		0x0000, 0x8000, 0xffff, 0x0040, 0x0000, /* G0.6~10 */
592 	};
593 	static struct clk_parent_data pd_ext, pd_sys, pd_e;
594 	struct device *dev = &pdev->dev;
595 	void __iomem *clk_base, *pll_base, *sys_base;
596 	struct clk_hw_onecell_data *clk_data;
597 	struct clk_hw **hws;
598 	int i;
599 
600 	clk_base = devm_platform_ioremap_resource(pdev, 0);
601 	if (IS_ERR(clk_base))
602 		return PTR_ERR(clk_base);
603 	pll_base = devm_platform_ioremap_resource(pdev, 1);
604 	if (IS_ERR(pll_base))
605 		return PTR_ERR(pll_base);
606 	sys_base = devm_platform_ioremap_resource(pdev, 2);
607 	if (IS_ERR(sys_base))
608 		return PTR_ERR(sys_base);
609 
610 	/* enable default clks */
611 	for (i = 0; i < ARRAY_SIZE(sp_clken); i++)
612 		writel((sp_clken[i] << 16) | sp_clken[i], clk_base + i * 4);
613 
614 	clk_data = devm_kzalloc(dev, struct_size(clk_data, hws, CLK_MAX),
615 				GFP_KERNEL);
616 	if (!clk_data)
617 		return -ENOMEM;
618 	clk_data->num = CLK_MAX;
619 
620 	hws = clk_data->hws;
621 	pd_ext.index = 0;
622 
623 	/* PLLs */
624 	hws[PLL_A] = sp_pll_register(dev, "plla", &pd_ext, PLLA_CTL,
625 				     11, 12, 27000000, 0, DIV_A, 0);
626 	if (IS_ERR(hws[PLL_A]))
627 		return PTR_ERR(hws[PLL_A]);
628 
629 	hws[PLL_E] = sp_pll_register(dev, "plle", &pd_ext, PLLE_CTL,
630 				     6, 2, 50000000, 0, 0, 0);
631 	if (IS_ERR(hws[PLL_E]))
632 		return PTR_ERR(hws[PLL_E]);
633 	pd_e.hw = hws[PLL_E];
634 	hws[PLL_E_2P5] = sp_pll_register(dev, "plle_2p5", &pd_e, PLLE_CTL,
635 					 13, -1, 2500000, 0, 0, 0);
636 	if (IS_ERR(hws[PLL_E_2P5]))
637 		return PTR_ERR(hws[PLL_E_2P5]);
638 	hws[PLL_E_25] = sp_pll_register(dev, "plle_25", &pd_e, PLLE_CTL,
639 					12, -1, 25000000, 0, 0, 0);
640 	if (IS_ERR(hws[PLL_E_25]))
641 		return PTR_ERR(hws[PLL_E_25]);
642 	hws[PLL_E_112P5] = sp_pll_register(dev, "plle_112p5", &pd_e, PLLE_CTL,
643 					   11, -1, 112500000, 0, 0, 0);
644 	if (IS_ERR(hws[PLL_E_112P5]))
645 		return PTR_ERR(hws[PLL_E_112P5]);
646 
647 	hws[PLL_F] = sp_pll_register(dev, "pllf", &pd_ext, PLLF_CTL,
648 				     0, 10, 13500000, 1, 4, 0);
649 	if (IS_ERR(hws[PLL_F]))
650 		return PTR_ERR(hws[PLL_F]);
651 
652 	hws[PLL_TV] = sp_pll_register(dev, "plltv", &pd_ext, PLLTV_CTL,
653 				      0, 15, 27000000, 0, DIV_TV, 0);
654 	if (IS_ERR(hws[PLL_TV]))
655 		return PTR_ERR(hws[PLL_TV]);
656 	hws[PLL_TV_A] = devm_clk_hw_register_divider(dev, "plltv_a", "plltv", 0,
657 						     PLLTV_CTL + 4, 5, 1,
658 						     CLK_DIVIDER_POWER_OF_TWO,
659 						     &to_sp_pll(hws[PLL_TV])->lock);
660 	if (IS_ERR(hws[PLL_TV_A]))
661 		return PTR_ERR(hws[PLL_TV_A]);
662 
663 	/* system clock, should not be disabled */
664 	hws[PLL_SYS] = sp_pll_register(dev, "pllsys", &pd_ext, sys_base,
665 				       10, 9, 13500000, 0, 4, CLK_IS_CRITICAL);
666 	if (IS_ERR(hws[PLL_SYS]))
667 		return PTR_ERR(hws[PLL_SYS]);
668 	pd_sys.hw = hws[PLL_SYS];
669 
670 	/* gates */
671 	for (i = 0; i < ARRAY_SIZE(sp_clk_gates); i++) {
672 		char name[10];
673 		u32 j = sp_clk_gates[i].reg;
674 		struct clk_parent_data *pd = sp_clk_gates[i].ext_parent ? &pd_ext : &pd_sys;
675 
676 		sprintf(name, "%02d_0x%02x", i, j);
677 		hws[i] = devm_clk_hw_register_gate_parent_data(dev, name, pd, 0,
678 							       clk_base + (j >> 4) * 4,
679 							       j & 0x0f,
680 							       CLK_GATE_HIWORD_MASK,
681 							       NULL);
682 		if (IS_ERR(hws[i]))
683 			return PTR_ERR(hws[i]);
684 	}
685 
686 	return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, clk_data);
687 }
688 
689 static const struct of_device_id sp7021_clk_dt_ids[] = {
690 	{ .compatible = "sunplus,sp7021-clkc" },
691 	{ }
692 };
693 MODULE_DEVICE_TABLE(of, sp7021_clk_dt_ids);
694 
695 static struct platform_driver sp7021_clk_driver = {
696 	.probe  = sp7021_clk_probe,
697 	.driver = {
698 		.name = "sp7021-clk",
699 		.of_match_table = sp7021_clk_dt_ids,
700 	},
701 };
702 module_platform_driver(sp7021_clk_driver);
703 
704 MODULE_AUTHOR("Sunplus Technology");
705 MODULE_LICENSE("GPL");
706 MODULE_DESCRIPTION("Clock driver for Sunplus SP7021 SoC");
707