]> git.ipfire.org Git - people/ms/u-boot.git/blob - drivers/clk/renesas/clk-rcar-gen3.c
Merge git://git.denx.de/u-boot-i2c
[people/ms/u-boot.git] / drivers / clk / renesas / clk-rcar-gen3.c
1 /*
2 * Renesas RCar Gen3 R8A7795/R8A7796 CPG MSSR driver
3 *
4 * Copyright (C) 2017 Marek Vasut <marek.vasut@gmail.com>
5 *
6 * Based on the following driver from Linux kernel:
7 * r8a7796 Clock Pulse Generator / Module Standby and Software Reset
8 *
9 * Copyright (C) 2016 Glider bvba
10 *
11 * SPDX-License-Identifier: GPL-2.0+
12 */
13
14 #include <common.h>
15 #include <clk-uclass.h>
16 #include <dm.h>
17 #include <errno.h>
18 #include <wait_bit.h>
19 #include <asm/io.h>
20
21 #include <dt-bindings/clock/r8a7795-cpg-mssr.h>
22 #include <dt-bindings/clock/r8a7796-cpg-mssr.h>
23
24 #define CPG_RST_MODEMR 0x0060
25
26 #define CPG_PLL0CR 0x00d8
27 #define CPG_PLL2CR 0x002c
28 #define CPG_PLL4CR 0x01f4
29
30 #define CPG_RPC_PREDIV_MASK 0x3
31 #define CPG_RPC_PREDIV_OFFSET 3
32 #define CPG_RPC_POSTDIV_MASK 0x7
33 #define CPG_RPC_POSTDIV_OFFSET 0
34
35 /*
36 * Module Standby and Software Reset register offets.
37 *
38 * If the registers exist, these are valid for SH-Mobile, R-Mobile,
39 * R-Car Gen2, R-Car Gen3, and RZ/G1.
40 * These are NOT valid for R-Car Gen1 and RZ/A1!
41 */
42
43 /*
44 * Module Stop Status Register offsets
45 */
46
47 static const u16 mstpsr[] = {
48 0x030, 0x038, 0x040, 0x048, 0x04C, 0x03C, 0x1C0, 0x1C4,
49 0x9A0, 0x9A4, 0x9A8, 0x9AC,
50 };
51
52 #define MSTPSR(i) mstpsr[i]
53
54
55 /*
56 * System Module Stop Control Register offsets
57 */
58
59 static const u16 smstpcr[] = {
60 0x130, 0x134, 0x138, 0x13C, 0x140, 0x144, 0x148, 0x14C,
61 0x990, 0x994, 0x998, 0x99C,
62 };
63
64 #define SMSTPCR(i) smstpcr[i]
65
66
67 /* Realtime Module Stop Control Register offsets */
68 #define RMSTPCR(i) (smstpcr[i] - 0x20)
69
70 /* Modem Module Stop Control Register offsets (r8a73a4) */
71 #define MMSTPCR(i) (smstpcr[i] + 0x20)
72
73 /* Software Reset Clearing Register offsets */
74 #define SRSTCLR(i) (0x940 + (i) * 4)
75
76 struct gen3_clk_priv {
77 void __iomem *base;
78 struct clk clk_extal;
79 struct clk clk_extalr;
80 const struct rcar_gen3_cpg_pll_config *cpg_pll_config;
81 const struct cpg_core_clk *core_clk;
82 u32 core_clk_size;
83 const struct mssr_mod_clk *mod_clk;
84 u32 mod_clk_size;
85 };
86
87 /*
88 * Definitions of CPG Core Clocks
89 *
90 * These include:
91 * - Clock outputs exported to DT
92 * - External input clocks
93 * - Internal CPG clocks
94 */
95 struct cpg_core_clk {
96 /* Common */
97 const char *name;
98 unsigned int id;
99 unsigned int type;
100 /* Depending on type */
101 unsigned int parent; /* Core Clocks only */
102 unsigned int div;
103 unsigned int mult;
104 unsigned int offset;
105 };
106
107 enum clk_types {
108 /* Generic */
109 CLK_TYPE_IN, /* External Clock Input */
110 CLK_TYPE_FF, /* Fixed Factor Clock */
111
112 /* Custom definitions start here */
113 CLK_TYPE_CUSTOM,
114 };
115
116 #define DEF_TYPE(_name, _id, _type...) \
117 { .name = _name, .id = _id, .type = _type }
118 #define DEF_BASE(_name, _id, _type, _parent...) \
119 DEF_TYPE(_name, _id, _type, .parent = _parent)
120
121 #define DEF_INPUT(_name, _id) \
122 DEF_TYPE(_name, _id, CLK_TYPE_IN)
123 #define DEF_FIXED(_name, _id, _parent, _div, _mult) \
124 DEF_BASE(_name, _id, CLK_TYPE_FF, _parent, .div = _div, .mult = _mult)
125 #define DEF_GEN3_SD(_name, _id, _parent, _offset) \
126 DEF_BASE(_name, _id, CLK_TYPE_GEN3_SD, _parent, .offset = _offset)
127 #define DEF_GEN3_RPC(_name, _id, _parent, _offset) \
128 DEF_BASE(_name, _id, CLK_TYPE_GEN3_RPC, _parent, .offset = _offset)
129
130 /*
131 * Definitions of Module Clocks
132 */
133 struct mssr_mod_clk {
134 const char *name;
135 unsigned int id;
136 unsigned int parent; /* Add MOD_CLK_BASE for Module Clocks */
137 };
138
139 /* Convert from sparse base-100 to packed index space */
140 #define MOD_CLK_PACK(x) ((x) - ((x) / 100) * (100 - 32))
141
142 #define MOD_CLK_ID(x) (MOD_CLK_BASE + MOD_CLK_PACK(x))
143
144 #define DEF_MOD(_name, _mod, _parent...) \
145 { .name = _name, .id = MOD_CLK_ID(_mod), .parent = _parent }
146
147 enum rcar_gen3_clk_types {
148 CLK_TYPE_GEN3_MAIN = CLK_TYPE_CUSTOM,
149 CLK_TYPE_GEN3_PLL0,
150 CLK_TYPE_GEN3_PLL1,
151 CLK_TYPE_GEN3_PLL2,
152 CLK_TYPE_GEN3_PLL3,
153 CLK_TYPE_GEN3_PLL4,
154 CLK_TYPE_GEN3_SD,
155 CLK_TYPE_GEN3_RPC,
156 CLK_TYPE_GEN3_R,
157 };
158
159 struct rcar_gen3_cpg_pll_config {
160 unsigned int extal_div;
161 unsigned int pll1_mult;
162 unsigned int pll3_mult;
163 };
164
165 enum clk_ids {
166 /* Core Clock Outputs exported to DT */
167 LAST_DT_CORE_CLK = R8A7796_CLK_OSC,
168
169 /* External Input Clocks */
170 CLK_EXTAL,
171 CLK_EXTALR,
172
173 /* Internal Core Clocks */
174 CLK_MAIN,
175 CLK_PLL0,
176 CLK_PLL1,
177 CLK_PLL2,
178 CLK_PLL3,
179 CLK_PLL4,
180 CLK_PLL1_DIV2,
181 CLK_PLL1_DIV4,
182 CLK_S0,
183 CLK_S1,
184 CLK_S2,
185 CLK_S3,
186 CLK_SDSRC,
187 CLK_RPCSRC,
188 CLK_SSPSRC,
189 CLK_RINT,
190
191 /* Module Clocks */
192 MOD_CLK_BASE
193 };
194
195 static const struct cpg_core_clk r8a7795_core_clks[] = {
196 /* External Clock Inputs */
197 DEF_INPUT("extal", CLK_EXTAL),
198 DEF_INPUT("extalr", CLK_EXTALR),
199
200 /* Internal Core Clocks */
201 DEF_BASE(".main", CLK_MAIN, CLK_TYPE_GEN3_MAIN, CLK_EXTAL),
202 DEF_BASE(".pll0", CLK_PLL0, CLK_TYPE_GEN3_PLL0, CLK_MAIN),
203 DEF_BASE(".pll1", CLK_PLL1, CLK_TYPE_GEN3_PLL1, CLK_MAIN),
204 DEF_BASE(".pll2", CLK_PLL2, CLK_TYPE_GEN3_PLL2, CLK_MAIN),
205 DEF_BASE(".pll3", CLK_PLL3, CLK_TYPE_GEN3_PLL3, CLK_MAIN),
206 DEF_BASE(".pll4", CLK_PLL4, CLK_TYPE_GEN3_PLL4, CLK_MAIN),
207
208 DEF_FIXED(".pll1_div2", CLK_PLL1_DIV2, CLK_PLL1, 2, 1),
209 DEF_FIXED(".pll1_div4", CLK_PLL1_DIV4, CLK_PLL1_DIV2, 2, 1),
210 DEF_FIXED(".s0", CLK_S0, CLK_PLL1_DIV2, 2, 1),
211 DEF_FIXED(".s1", CLK_S1, CLK_PLL1_DIV2, 3, 1),
212 DEF_FIXED(".s2", CLK_S2, CLK_PLL1_DIV2, 4, 1),
213 DEF_FIXED(".s3", CLK_S3, CLK_PLL1_DIV2, 6, 1),
214 DEF_FIXED(".sdsrc", CLK_SDSRC, CLK_PLL1_DIV2, 2, 1),
215 DEF_FIXED(".rpcsrc", CLK_RPCSRC, CLK_PLL1, 2, 1),
216
217 /* Core Clock Outputs */
218 DEF_FIXED("ztr", R8A7795_CLK_ZTR, CLK_PLL1_DIV2, 6, 1),
219 DEF_FIXED("ztrd2", R8A7795_CLK_ZTRD2, CLK_PLL1_DIV2, 12, 1),
220 DEF_FIXED("zt", R8A7795_CLK_ZT, CLK_PLL1_DIV2, 4, 1),
221 DEF_FIXED("zx", R8A7795_CLK_ZX, CLK_PLL1_DIV2, 2, 1),
222 DEF_FIXED("s0d1", R8A7795_CLK_S0D1, CLK_S0, 1, 1),
223 DEF_FIXED("s0d2", R8A7795_CLK_S0D2, CLK_S0, 2, 1),
224 DEF_FIXED("s0d3", R8A7795_CLK_S0D3, CLK_S0, 3, 1),
225 DEF_FIXED("s0d4", R8A7795_CLK_S0D4, CLK_S0, 4, 1),
226 DEF_FIXED("s0d6", R8A7795_CLK_S0D6, CLK_S0, 6, 1),
227 DEF_FIXED("s0d8", R8A7795_CLK_S0D8, CLK_S0, 8, 1),
228 DEF_FIXED("s0d12", R8A7795_CLK_S0D12, CLK_S0, 12, 1),
229 DEF_FIXED("s1d1", R8A7795_CLK_S1D1, CLK_S1, 1, 1),
230 DEF_FIXED("s1d2", R8A7795_CLK_S1D2, CLK_S1, 2, 1),
231 DEF_FIXED("s1d4", R8A7795_CLK_S1D4, CLK_S1, 4, 1),
232 DEF_FIXED("s2d1", R8A7795_CLK_S2D1, CLK_S2, 1, 1),
233 DEF_FIXED("s2d2", R8A7795_CLK_S2D2, CLK_S2, 2, 1),
234 DEF_FIXED("s2d4", R8A7795_CLK_S2D4, CLK_S2, 4, 1),
235 DEF_FIXED("s3d1", R8A7795_CLK_S3D1, CLK_S3, 1, 1),
236 DEF_FIXED("s3d2", R8A7795_CLK_S3D2, CLK_S3, 2, 1),
237 DEF_FIXED("s3d4", R8A7795_CLK_S3D4, CLK_S3, 4, 1),
238
239 DEF_GEN3_SD("sd0", R8A7795_CLK_SD0, CLK_SDSRC, 0x074),
240 DEF_GEN3_SD("sd1", R8A7795_CLK_SD1, CLK_SDSRC, 0x078),
241 DEF_GEN3_SD("sd2", R8A7795_CLK_SD2, CLK_SDSRC, 0x268),
242 DEF_GEN3_SD("sd3", R8A7795_CLK_SD3, CLK_SDSRC, 0x26c),
243
244 DEF_GEN3_RPC("rpc", R8A7795_CLK_RPC, CLK_RPCSRC, 0x238),
245
246 DEF_FIXED("cl", R8A7795_CLK_CL, CLK_PLL1_DIV2, 48, 1),
247 DEF_FIXED("cp", R8A7795_CLK_CP, CLK_EXTAL, 2, 1),
248
249 /* NOTE: HDMI, CSI, CAN etc. clock are missing */
250
251 DEF_BASE("r", R8A7795_CLK_R, CLK_TYPE_GEN3_R, CLK_RINT),
252 };
253
254 static const struct mssr_mod_clk r8a7795_mod_clks[] = {
255 DEF_MOD("fdp1-2", 117, R8A7795_CLK_S2D1), /* ES1.x */
256 DEF_MOD("fdp1-1", 118, R8A7795_CLK_S0D1),
257 DEF_MOD("fdp1-0", 119, R8A7795_CLK_S0D1),
258 DEF_MOD("scif5", 202, R8A7795_CLK_S3D4),
259 DEF_MOD("scif4", 203, R8A7795_CLK_S3D4),
260 DEF_MOD("scif3", 204, R8A7795_CLK_S3D4),
261 DEF_MOD("scif1", 206, R8A7795_CLK_S3D4),
262 DEF_MOD("scif0", 207, R8A7795_CLK_S3D4),
263 DEF_MOD("msiof3", 208, R8A7795_CLK_MSO),
264 DEF_MOD("msiof2", 209, R8A7795_CLK_MSO),
265 DEF_MOD("msiof1", 210, R8A7795_CLK_MSO),
266 DEF_MOD("msiof0", 211, R8A7795_CLK_MSO),
267 DEF_MOD("sys-dmac2", 217, R8A7795_CLK_S0D3),
268 DEF_MOD("sys-dmac1", 218, R8A7795_CLK_S0D3),
269 DEF_MOD("sys-dmac0", 219, R8A7795_CLK_S0D3),
270 DEF_MOD("cmt3", 300, R8A7795_CLK_R),
271 DEF_MOD("cmt2", 301, R8A7795_CLK_R),
272 DEF_MOD("cmt1", 302, R8A7795_CLK_R),
273 DEF_MOD("cmt0", 303, R8A7795_CLK_R),
274 DEF_MOD("scif2", 310, R8A7795_CLK_S3D4),
275 DEF_MOD("sdif3", 311, R8A7795_CLK_SD3),
276 DEF_MOD("sdif2", 312, R8A7795_CLK_SD2),
277 DEF_MOD("sdif1", 313, R8A7795_CLK_SD1),
278 DEF_MOD("sdif0", 314, R8A7795_CLK_SD0),
279 DEF_MOD("pcie1", 318, R8A7795_CLK_S3D1),
280 DEF_MOD("pcie0", 319, R8A7795_CLK_S3D1),
281 DEF_MOD("usb-dmac30", 326, R8A7795_CLK_S3D1),
282 DEF_MOD("usb3-if1", 327, R8A7795_CLK_S3D1), /* ES1.x */
283 DEF_MOD("usb3-if0", 328, R8A7795_CLK_S3D1),
284 DEF_MOD("usb-dmac31", 329, R8A7795_CLK_S3D1),
285 DEF_MOD("usb-dmac0", 330, R8A7795_CLK_S3D1),
286 DEF_MOD("usb-dmac1", 331, R8A7795_CLK_S3D1),
287 DEF_MOD("rwdt", 402, R8A7795_CLK_R),
288 DEF_MOD("intc-ex", 407, R8A7795_CLK_CP),
289 DEF_MOD("intc-ap", 408, R8A7795_CLK_S3D1),
290 DEF_MOD("audmac1", 501, R8A7795_CLK_S0D3),
291 DEF_MOD("audmac0", 502, R8A7795_CLK_S0D3),
292 DEF_MOD("drif7", 508, R8A7795_CLK_S3D2),
293 DEF_MOD("drif6", 509, R8A7795_CLK_S3D2),
294 DEF_MOD("drif5", 510, R8A7795_CLK_S3D2),
295 DEF_MOD("drif4", 511, R8A7795_CLK_S3D2),
296 DEF_MOD("drif3", 512, R8A7795_CLK_S3D2),
297 DEF_MOD("drif2", 513, R8A7795_CLK_S3D2),
298 DEF_MOD("drif1", 514, R8A7795_CLK_S3D2),
299 DEF_MOD("drif0", 515, R8A7795_CLK_S3D2),
300 DEF_MOD("hscif4", 516, R8A7795_CLK_S3D1),
301 DEF_MOD("hscif3", 517, R8A7795_CLK_S3D1),
302 DEF_MOD("hscif2", 518, R8A7795_CLK_S3D1),
303 DEF_MOD("hscif1", 519, R8A7795_CLK_S3D1),
304 DEF_MOD("hscif0", 520, R8A7795_CLK_S3D1),
305 DEF_MOD("thermal", 522, R8A7795_CLK_CP),
306 DEF_MOD("pwm", 523, R8A7795_CLK_S0D12),
307 DEF_MOD("fcpvd3", 600, R8A7795_CLK_S2D1), /* ES1.x */
308 DEF_MOD("fcpvd2", 601, R8A7795_CLK_S0D2),
309 DEF_MOD("fcpvd1", 602, R8A7795_CLK_S0D2),
310 DEF_MOD("fcpvd0", 603, R8A7795_CLK_S0D2),
311 DEF_MOD("fcpvb1", 606, R8A7795_CLK_S0D1),
312 DEF_MOD("fcpvb0", 607, R8A7795_CLK_S0D1),
313 DEF_MOD("fcpvi2", 609, R8A7795_CLK_S2D1), /* ES1.x */
314 DEF_MOD("fcpvi1", 610, R8A7795_CLK_S0D1),
315 DEF_MOD("fcpvi0", 611, R8A7795_CLK_S0D1),
316 DEF_MOD("fcpf2", 613, R8A7795_CLK_S2D1), /* ES1.x */
317 DEF_MOD("fcpf1", 614, R8A7795_CLK_S0D1),
318 DEF_MOD("fcpf0", 615, R8A7795_CLK_S0D1),
319 DEF_MOD("fcpci1", 616, R8A7795_CLK_S2D1), /* ES1.x */
320 DEF_MOD("fcpci0", 617, R8A7795_CLK_S2D1), /* ES1.x */
321 DEF_MOD("fcpcs", 619, R8A7795_CLK_S0D1),
322 DEF_MOD("vspd3", 620, R8A7795_CLK_S2D1), /* ES1.x */
323 DEF_MOD("vspd2", 621, R8A7795_CLK_S0D2),
324 DEF_MOD("vspd1", 622, R8A7795_CLK_S0D2),
325 DEF_MOD("vspd0", 623, R8A7795_CLK_S0D2),
326 DEF_MOD("vspbc", 624, R8A7795_CLK_S0D1),
327 DEF_MOD("vspbd", 626, R8A7795_CLK_S0D1),
328 DEF_MOD("vspi2", 629, R8A7795_CLK_S2D1), /* ES1.x */
329 DEF_MOD("vspi1", 630, R8A7795_CLK_S0D1),
330 DEF_MOD("vspi0", 631, R8A7795_CLK_S0D1),
331 DEF_MOD("ehci3", 700, R8A7795_CLK_S3D4),
332 DEF_MOD("ehci2", 701, R8A7795_CLK_S3D4),
333 DEF_MOD("ehci1", 702, R8A7795_CLK_S3D4),
334 DEF_MOD("ehci0", 703, R8A7795_CLK_S3D4),
335 DEF_MOD("hsusb", 704, R8A7795_CLK_S3D4),
336 DEF_MOD("hsusb3", 705, R8A7795_CLK_S3D4),
337 DEF_MOD("csi21", 713, R8A7795_CLK_CSI0), /* ES1.x */
338 DEF_MOD("csi20", 714, R8A7795_CLK_CSI0),
339 DEF_MOD("csi41", 715, R8A7795_CLK_CSI0),
340 DEF_MOD("csi40", 716, R8A7795_CLK_CSI0),
341 DEF_MOD("du3", 721, R8A7795_CLK_S2D1),
342 DEF_MOD("du2", 722, R8A7795_CLK_S2D1),
343 DEF_MOD("du1", 723, R8A7795_CLK_S2D1),
344 DEF_MOD("du0", 724, R8A7795_CLK_S2D1),
345 DEF_MOD("lvds", 727, R8A7795_CLK_S0D4),
346 DEF_MOD("hdmi1", 728, R8A7795_CLK_HDMI),
347 DEF_MOD("hdmi0", 729, R8A7795_CLK_HDMI),
348 DEF_MOD("vin7", 804, R8A7795_CLK_S0D2),
349 DEF_MOD("vin6", 805, R8A7795_CLK_S0D2),
350 DEF_MOD("vin5", 806, R8A7795_CLK_S0D2),
351 DEF_MOD("vin4", 807, R8A7795_CLK_S0D2),
352 DEF_MOD("vin3", 808, R8A7795_CLK_S0D2),
353 DEF_MOD("vin2", 809, R8A7795_CLK_S0D2),
354 DEF_MOD("vin1", 810, R8A7795_CLK_S0D2),
355 DEF_MOD("vin0", 811, R8A7795_CLK_S0D2),
356 DEF_MOD("etheravb", 812, R8A7795_CLK_S0D6),
357 DEF_MOD("sata0", 815, R8A7795_CLK_S3D2),
358 DEF_MOD("imr3", 820, R8A7795_CLK_S0D2),
359 DEF_MOD("imr2", 821, R8A7795_CLK_S0D2),
360 DEF_MOD("imr1", 822, R8A7795_CLK_S0D2),
361 DEF_MOD("imr0", 823, R8A7795_CLK_S0D2),
362 DEF_MOD("gpio7", 905, R8A7795_CLK_S3D4),
363 DEF_MOD("gpio6", 906, R8A7795_CLK_S3D4),
364 DEF_MOD("gpio5", 907, R8A7795_CLK_S3D4),
365 DEF_MOD("gpio4", 908, R8A7795_CLK_S3D4),
366 DEF_MOD("gpio3", 909, R8A7795_CLK_S3D4),
367 DEF_MOD("gpio2", 910, R8A7795_CLK_S3D4),
368 DEF_MOD("gpio1", 911, R8A7795_CLK_S3D4),
369 DEF_MOD("gpio0", 912, R8A7795_CLK_S3D4),
370 DEF_MOD("can-fd", 914, R8A7795_CLK_S3D2),
371 DEF_MOD("can-if1", 915, R8A7795_CLK_S3D4),
372 DEF_MOD("can-if0", 916, R8A7795_CLK_S3D4),
373 DEF_MOD("rpc", 917, R8A7795_CLK_RPC),
374 DEF_MOD("i2c6", 918, R8A7795_CLK_S0D6),
375 DEF_MOD("i2c5", 919, R8A7795_CLK_S0D6),
376 DEF_MOD("i2c-dvfs", 926, R8A7795_CLK_CP),
377 DEF_MOD("i2c4", 927, R8A7795_CLK_S0D6),
378 DEF_MOD("i2c3", 928, R8A7795_CLK_S0D6),
379 DEF_MOD("i2c2", 929, R8A7795_CLK_S3D2),
380 DEF_MOD("i2c1", 930, R8A7795_CLK_S3D2),
381 DEF_MOD("i2c0", 931, R8A7795_CLK_S3D2),
382 DEF_MOD("ssi-all", 1005, R8A7795_CLK_S3D4),
383 DEF_MOD("ssi9", 1006, MOD_CLK_ID(1005)),
384 DEF_MOD("ssi8", 1007, MOD_CLK_ID(1005)),
385 DEF_MOD("ssi7", 1008, MOD_CLK_ID(1005)),
386 DEF_MOD("ssi6", 1009, MOD_CLK_ID(1005)),
387 DEF_MOD("ssi5", 1010, MOD_CLK_ID(1005)),
388 DEF_MOD("ssi4", 1011, MOD_CLK_ID(1005)),
389 DEF_MOD("ssi3", 1012, MOD_CLK_ID(1005)),
390 DEF_MOD("ssi2", 1013, MOD_CLK_ID(1005)),
391 DEF_MOD("ssi1", 1014, MOD_CLK_ID(1005)),
392 DEF_MOD("ssi0", 1015, MOD_CLK_ID(1005)),
393 DEF_MOD("scu-all", 1017, R8A7795_CLK_S3D4),
394 DEF_MOD("scu-dvc1", 1018, MOD_CLK_ID(1017)),
395 DEF_MOD("scu-dvc0", 1019, MOD_CLK_ID(1017)),
396 DEF_MOD("scu-ctu1-mix1", 1020, MOD_CLK_ID(1017)),
397 DEF_MOD("scu-ctu0-mix0", 1021, MOD_CLK_ID(1017)),
398 DEF_MOD("scu-src9", 1022, MOD_CLK_ID(1017)),
399 DEF_MOD("scu-src8", 1023, MOD_CLK_ID(1017)),
400 DEF_MOD("scu-src7", 1024, MOD_CLK_ID(1017)),
401 DEF_MOD("scu-src6", 1025, MOD_CLK_ID(1017)),
402 DEF_MOD("scu-src5", 1026, MOD_CLK_ID(1017)),
403 DEF_MOD("scu-src4", 1027, MOD_CLK_ID(1017)),
404 DEF_MOD("scu-src3", 1028, MOD_CLK_ID(1017)),
405 DEF_MOD("scu-src2", 1029, MOD_CLK_ID(1017)),
406 DEF_MOD("scu-src1", 1030, MOD_CLK_ID(1017)),
407 DEF_MOD("scu-src0", 1031, MOD_CLK_ID(1017)),
408 };
409
410 static const struct cpg_core_clk r8a7796_core_clks[] = {
411 /* External Clock Inputs */
412 DEF_INPUT("extal", CLK_EXTAL),
413 DEF_INPUT("extalr", CLK_EXTALR),
414
415 /* Internal Core Clocks */
416 DEF_BASE(".main", CLK_MAIN, CLK_TYPE_GEN3_MAIN, CLK_EXTAL),
417 DEF_BASE(".pll0", CLK_PLL0, CLK_TYPE_GEN3_PLL0, CLK_MAIN),
418 DEF_BASE(".pll1", CLK_PLL1, CLK_TYPE_GEN3_PLL1, CLK_MAIN),
419 DEF_BASE(".pll2", CLK_PLL2, CLK_TYPE_GEN3_PLL2, CLK_MAIN),
420 DEF_BASE(".pll3", CLK_PLL3, CLK_TYPE_GEN3_PLL3, CLK_MAIN),
421 DEF_BASE(".pll4", CLK_PLL4, CLK_TYPE_GEN3_PLL4, CLK_MAIN),
422
423 DEF_FIXED(".pll1_div2", CLK_PLL1_DIV2, CLK_PLL1, 2, 1),
424 DEF_FIXED(".pll1_div4", CLK_PLL1_DIV4, CLK_PLL1_DIV2, 2, 1),
425 DEF_FIXED(".s0", CLK_S0, CLK_PLL1_DIV2, 2, 1),
426 DEF_FIXED(".s1", CLK_S1, CLK_PLL1_DIV2, 3, 1),
427 DEF_FIXED(".s2", CLK_S2, CLK_PLL1_DIV2, 4, 1),
428 DEF_FIXED(".s3", CLK_S3, CLK_PLL1_DIV2, 6, 1),
429 DEF_FIXED(".sdsrc", CLK_SDSRC, CLK_PLL1_DIV2, 2, 1),
430 DEF_FIXED(".rpcsrc", CLK_RPCSRC, CLK_PLL1, 2, 1),
431
432 /* Core Clock Outputs */
433 DEF_FIXED("ztr", R8A7796_CLK_ZTR, CLK_PLL1_DIV2, 6, 1),
434 DEF_FIXED("ztrd2", R8A7796_CLK_ZTRD2, CLK_PLL1_DIV2, 12, 1),
435 DEF_FIXED("zt", R8A7796_CLK_ZT, CLK_PLL1_DIV2, 4, 1),
436 DEF_FIXED("zx", R8A7796_CLK_ZX, CLK_PLL1_DIV2, 2, 1),
437 DEF_FIXED("s0d1", R8A7796_CLK_S0D1, CLK_S0, 1, 1),
438 DEF_FIXED("s0d2", R8A7796_CLK_S0D2, CLK_S0, 2, 1),
439 DEF_FIXED("s0d3", R8A7796_CLK_S0D3, CLK_S0, 3, 1),
440 DEF_FIXED("s0d4", R8A7796_CLK_S0D4, CLK_S0, 4, 1),
441 DEF_FIXED("s0d6", R8A7796_CLK_S0D6, CLK_S0, 6, 1),
442 DEF_FIXED("s0d8", R8A7796_CLK_S0D8, CLK_S0, 8, 1),
443 DEF_FIXED("s0d12", R8A7796_CLK_S0D12, CLK_S0, 12, 1),
444 DEF_FIXED("s1d1", R8A7796_CLK_S1D1, CLK_S1, 1, 1),
445 DEF_FIXED("s1d2", R8A7796_CLK_S1D2, CLK_S1, 2, 1),
446 DEF_FIXED("s1d4", R8A7796_CLK_S1D4, CLK_S1, 4, 1),
447 DEF_FIXED("s2d1", R8A7796_CLK_S2D1, CLK_S2, 1, 1),
448 DEF_FIXED("s2d2", R8A7796_CLK_S2D2, CLK_S2, 2, 1),
449 DEF_FIXED("s2d4", R8A7796_CLK_S2D4, CLK_S2, 4, 1),
450 DEF_FIXED("s3d1", R8A7796_CLK_S3D1, CLK_S3, 1, 1),
451 DEF_FIXED("s3d2", R8A7796_CLK_S3D2, CLK_S3, 2, 1),
452 DEF_FIXED("s3d4", R8A7796_CLK_S3D4, CLK_S3, 4, 1),
453
454 DEF_GEN3_SD("sd0", R8A7796_CLK_SD0, CLK_SDSRC, 0x074),
455 DEF_GEN3_SD("sd1", R8A7796_CLK_SD1, CLK_SDSRC, 0x078),
456 DEF_GEN3_SD("sd2", R8A7796_CLK_SD2, CLK_SDSRC, 0x268),
457 DEF_GEN3_SD("sd3", R8A7796_CLK_SD3, CLK_SDSRC, 0x26c),
458
459 DEF_GEN3_RPC("rpc", R8A7796_CLK_RPC, CLK_RPCSRC, 0x238),
460
461 DEF_FIXED("cl", R8A7796_CLK_CL, CLK_PLL1_DIV2, 48, 1),
462 DEF_FIXED("cp", R8A7796_CLK_CP, CLK_EXTAL, 2, 1),
463
464 /* NOTE: HDMI, CSI, CAN etc. clock are missing */
465
466 DEF_BASE("r", R8A7796_CLK_R, CLK_TYPE_GEN3_R, CLK_RINT),
467 };
468
469 static const struct mssr_mod_clk r8a7796_mod_clks[] = {
470 DEF_MOD("scif5", 202, R8A7796_CLK_S3D4),
471 DEF_MOD("scif4", 203, R8A7796_CLK_S3D4),
472 DEF_MOD("scif3", 204, R8A7796_CLK_S3D4),
473 DEF_MOD("scif1", 206, R8A7796_CLK_S3D4),
474 DEF_MOD("scif0", 207, R8A7796_CLK_S3D4),
475 DEF_MOD("msiof3", 208, R8A7796_CLK_MSO),
476 DEF_MOD("msiof2", 209, R8A7796_CLK_MSO),
477 DEF_MOD("msiof1", 210, R8A7796_CLK_MSO),
478 DEF_MOD("msiof0", 211, R8A7796_CLK_MSO),
479 DEF_MOD("sys-dmac2", 217, R8A7796_CLK_S0D3),
480 DEF_MOD("sys-dmac1", 218, R8A7796_CLK_S0D3),
481 DEF_MOD("sys-dmac0", 219, R8A7796_CLK_S0D3),
482 DEF_MOD("cmt3", 300, R8A7796_CLK_R),
483 DEF_MOD("cmt2", 301, R8A7796_CLK_R),
484 DEF_MOD("cmt1", 302, R8A7796_CLK_R),
485 DEF_MOD("cmt0", 303, R8A7796_CLK_R),
486 DEF_MOD("scif2", 310, R8A7796_CLK_S3D4),
487 DEF_MOD("sdif3", 311, R8A7796_CLK_SD3),
488 DEF_MOD("sdif2", 312, R8A7796_CLK_SD2),
489 DEF_MOD("sdif1", 313, R8A7796_CLK_SD1),
490 DEF_MOD("sdif0", 314, R8A7796_CLK_SD0),
491 DEF_MOD("pcie1", 318, R8A7796_CLK_S3D1),
492 DEF_MOD("pcie0", 319, R8A7796_CLK_S3D1),
493 DEF_MOD("usb-dmac0", 330, R8A7796_CLK_S3D1),
494 DEF_MOD("usb-dmac1", 331, R8A7796_CLK_S3D1),
495 DEF_MOD("rwdt", 402, R8A7796_CLK_R),
496 DEF_MOD("intc-ex", 407, R8A7796_CLK_CP),
497 DEF_MOD("intc-ap", 408, R8A7796_CLK_S3D1),
498 DEF_MOD("audmac1", 501, R8A7796_CLK_S0D3),
499 DEF_MOD("audmac0", 502, R8A7796_CLK_S0D3),
500 DEF_MOD("drif7", 508, R8A7796_CLK_S3D2),
501 DEF_MOD("drif6", 509, R8A7796_CLK_S3D2),
502 DEF_MOD("drif5", 510, R8A7796_CLK_S3D2),
503 DEF_MOD("drif4", 511, R8A7796_CLK_S3D2),
504 DEF_MOD("drif3", 512, R8A7796_CLK_S3D2),
505 DEF_MOD("drif2", 513, R8A7796_CLK_S3D2),
506 DEF_MOD("drif1", 514, R8A7796_CLK_S3D2),
507 DEF_MOD("drif0", 515, R8A7796_CLK_S3D2),
508 DEF_MOD("hscif4", 516, R8A7796_CLK_S3D1),
509 DEF_MOD("hscif3", 517, R8A7796_CLK_S3D1),
510 DEF_MOD("hscif2", 518, R8A7796_CLK_S3D1),
511 DEF_MOD("hscif1", 519, R8A7796_CLK_S3D1),
512 DEF_MOD("hscif0", 520, R8A7796_CLK_S3D1),
513 DEF_MOD("thermal", 522, R8A7796_CLK_CP),
514 DEF_MOD("pwm", 523, R8A7796_CLK_S0D12),
515 DEF_MOD("fcpvd2", 601, R8A7796_CLK_S0D2),
516 DEF_MOD("fcpvd1", 602, R8A7796_CLK_S0D2),
517 DEF_MOD("fcpvd0", 603, R8A7796_CLK_S0D2),
518 DEF_MOD("fcpvb0", 607, R8A7796_CLK_S0D1),
519 DEF_MOD("fcpvi0", 611, R8A7796_CLK_S0D1),
520 DEF_MOD("fcpf0", 615, R8A7796_CLK_S0D1),
521 DEF_MOD("fcpci0", 617, R8A7796_CLK_S0D2),
522 DEF_MOD("fcpcs", 619, R8A7796_CLK_S0D2),
523 DEF_MOD("vspd2", 621, R8A7796_CLK_S0D2),
524 DEF_MOD("vspd1", 622, R8A7796_CLK_S0D2),
525 DEF_MOD("vspd0", 623, R8A7796_CLK_S0D2),
526 DEF_MOD("vspb", 626, R8A7796_CLK_S0D1),
527 DEF_MOD("vspi0", 631, R8A7796_CLK_S0D1),
528 DEF_MOD("ehci1", 702, R8A7796_CLK_S3D4),
529 DEF_MOD("ehci0", 703, R8A7796_CLK_S3D4),
530 DEF_MOD("hsusb", 704, R8A7796_CLK_S3D4),
531 DEF_MOD("csi20", 714, R8A7796_CLK_CSI0),
532 DEF_MOD("csi40", 716, R8A7796_CLK_CSI0),
533 DEF_MOD("du2", 722, R8A7796_CLK_S2D1),
534 DEF_MOD("du1", 723, R8A7796_CLK_S2D1),
535 DEF_MOD("du0", 724, R8A7796_CLK_S2D1),
536 DEF_MOD("lvds", 727, R8A7796_CLK_S2D1),
537 DEF_MOD("hdmi0", 729, R8A7796_CLK_HDMI),
538 DEF_MOD("vin7", 804, R8A7796_CLK_S0D2),
539 DEF_MOD("vin6", 805, R8A7796_CLK_S0D2),
540 DEF_MOD("vin5", 806, R8A7796_CLK_S0D2),
541 DEF_MOD("vin4", 807, R8A7796_CLK_S0D2),
542 DEF_MOD("vin3", 808, R8A7796_CLK_S0D2),
543 DEF_MOD("vin2", 809, R8A7796_CLK_S0D2),
544 DEF_MOD("vin1", 810, R8A7796_CLK_S0D2),
545 DEF_MOD("vin0", 811, R8A7796_CLK_S0D2),
546 DEF_MOD("etheravb", 812, R8A7796_CLK_S0D6),
547 DEF_MOD("imr1", 822, R8A7796_CLK_S0D2),
548 DEF_MOD("imr0", 823, R8A7796_CLK_S0D2),
549 DEF_MOD("gpio7", 905, R8A7796_CLK_S3D4),
550 DEF_MOD("gpio6", 906, R8A7796_CLK_S3D4),
551 DEF_MOD("gpio5", 907, R8A7796_CLK_S3D4),
552 DEF_MOD("gpio4", 908, R8A7796_CLK_S3D4),
553 DEF_MOD("gpio3", 909, R8A7796_CLK_S3D4),
554 DEF_MOD("gpio2", 910, R8A7796_CLK_S3D4),
555 DEF_MOD("gpio1", 911, R8A7796_CLK_S3D4),
556 DEF_MOD("gpio0", 912, R8A7796_CLK_S3D4),
557 DEF_MOD("can-fd", 914, R8A7796_CLK_S3D2),
558 DEF_MOD("can-if1", 915, R8A7796_CLK_S3D4),
559 DEF_MOD("can-if0", 916, R8A7796_CLK_S3D4),
560 DEF_MOD("rpc", 917, R8A7795_CLK_RPC),
561 DEF_MOD("i2c6", 918, R8A7796_CLK_S0D6),
562 DEF_MOD("i2c5", 919, R8A7796_CLK_S0D6),
563 DEF_MOD("i2c-dvfs", 926, R8A7796_CLK_CP),
564 DEF_MOD("i2c4", 927, R8A7796_CLK_S0D6),
565 DEF_MOD("i2c3", 928, R8A7796_CLK_S0D6),
566 DEF_MOD("i2c2", 929, R8A7796_CLK_S3D2),
567 DEF_MOD("i2c1", 930, R8A7796_CLK_S3D2),
568 DEF_MOD("i2c0", 931, R8A7796_CLK_S3D2),
569 DEF_MOD("ssi-all", 1005, R8A7796_CLK_S3D4),
570 DEF_MOD("ssi9", 1006, MOD_CLK_ID(1005)),
571 DEF_MOD("ssi8", 1007, MOD_CLK_ID(1005)),
572 DEF_MOD("ssi7", 1008, MOD_CLK_ID(1005)),
573 DEF_MOD("ssi6", 1009, MOD_CLK_ID(1005)),
574 DEF_MOD("ssi5", 1010, MOD_CLK_ID(1005)),
575 DEF_MOD("ssi4", 1011, MOD_CLK_ID(1005)),
576 DEF_MOD("ssi3", 1012, MOD_CLK_ID(1005)),
577 DEF_MOD("ssi2", 1013, MOD_CLK_ID(1005)),
578 DEF_MOD("ssi1", 1014, MOD_CLK_ID(1005)),
579 DEF_MOD("ssi0", 1015, MOD_CLK_ID(1005)),
580 DEF_MOD("scu-all", 1017, R8A7796_CLK_S3D4),
581 DEF_MOD("scu-dvc1", 1018, MOD_CLK_ID(1017)),
582 DEF_MOD("scu-dvc0", 1019, MOD_CLK_ID(1017)),
583 DEF_MOD("scu-ctu1-mix1", 1020, MOD_CLK_ID(1017)),
584 DEF_MOD("scu-ctu0-mix0", 1021, MOD_CLK_ID(1017)),
585 DEF_MOD("scu-src9", 1022, MOD_CLK_ID(1017)),
586 DEF_MOD("scu-src8", 1023, MOD_CLK_ID(1017)),
587 DEF_MOD("scu-src7", 1024, MOD_CLK_ID(1017)),
588 DEF_MOD("scu-src6", 1025, MOD_CLK_ID(1017)),
589 DEF_MOD("scu-src5", 1026, MOD_CLK_ID(1017)),
590 DEF_MOD("scu-src4", 1027, MOD_CLK_ID(1017)),
591 DEF_MOD("scu-src3", 1028, MOD_CLK_ID(1017)),
592 DEF_MOD("scu-src2", 1029, MOD_CLK_ID(1017)),
593 DEF_MOD("scu-src1", 1030, MOD_CLK_ID(1017)),
594 DEF_MOD("scu-src0", 1031, MOD_CLK_ID(1017)),
595 };
596
597 /*
598 * CPG Clock Data
599 */
600
601 /*
602 * MD EXTAL PLL0 PLL1 PLL2 PLL3 PLL4
603 * 14 13 19 17 (MHz)
604 *-------------------------------------------------------------------
605 * 0 0 0 0 16.66 x 1 x180 x192 x144 x192 x144
606 * 0 0 0 1 16.66 x 1 x180 x192 x144 x128 x144
607 * 0 0 1 0 Prohibited setting
608 * 0 0 1 1 16.66 x 1 x180 x192 x144 x192 x144
609 * 0 1 0 0 20 x 1 x150 x160 x120 x160 x120
610 * 0 1 0 1 20 x 1 x150 x160 x120 x106 x120
611 * 0 1 1 0 Prohibited setting
612 * 0 1 1 1 20 x 1 x150 x160 x120 x160 x120
613 * 1 0 0 0 25 x 1 x120 x128 x96 x128 x96
614 * 1 0 0 1 25 x 1 x120 x128 x96 x84 x96
615 * 1 0 1 0 Prohibited setting
616 * 1 0 1 1 25 x 1 x120 x128 x96 x128 x96
617 * 1 1 0 0 33.33 / 2 x180 x192 x144 x192 x144
618 * 1 1 0 1 33.33 / 2 x180 x192 x144 x128 x144
619 * 1 1 1 0 Prohibited setting
620 * 1 1 1 1 33.33 / 2 x180 x192 x144 x192 x144
621 */
622 #define CPG_PLL_CONFIG_INDEX(md) ((((md) & BIT(14)) >> 11) | \
623 (((md) & BIT(13)) >> 11) | \
624 (((md) & BIT(19)) >> 18) | \
625 (((md) & BIT(17)) >> 17))
626
627 static const struct rcar_gen3_cpg_pll_config cpg_pll_configs[16] = {
628 /* EXTAL div PLL1 mult PLL3 mult */
629 { 1, 192, 192, },
630 { 1, 192, 128, },
631 { 0, /* Prohibited setting */ },
632 { 1, 192, 192, },
633 { 1, 160, 160, },
634 { 1, 160, 106, },
635 { 0, /* Prohibited setting */ },
636 { 1, 160, 160, },
637 { 1, 128, 128, },
638 { 1, 128, 84, },
639 { 0, /* Prohibited setting */ },
640 { 1, 128, 128, },
641 { 2, 192, 192, },
642 { 2, 192, 128, },
643 { 0, /* Prohibited setting */ },
644 { 2, 192, 192, },
645 };
646
647 /*
648 * SDn Clock
649 */
650 #define CPG_SD_STP_HCK BIT(9)
651 #define CPG_SD_STP_CK BIT(8)
652
653 #define CPG_SD_STP_MASK (CPG_SD_STP_HCK | CPG_SD_STP_CK)
654 #define CPG_SD_FC_MASK (0x7 << 2 | 0x3 << 0)
655
656 #define CPG_SD_DIV_TABLE_DATA(stp_hck, stp_ck, sd_srcfc, sd_fc, sd_div) \
657 { \
658 .val = ((stp_hck) ? CPG_SD_STP_HCK : 0) | \
659 ((stp_ck) ? CPG_SD_STP_CK : 0) | \
660 ((sd_srcfc) << 2) | \
661 ((sd_fc) << 0), \
662 .div = (sd_div), \
663 }
664
665 struct sd_div_table {
666 u32 val;
667 unsigned int div;
668 };
669
670 /* SDn divider
671 * sd_srcfc sd_fc div
672 * stp_hck stp_ck (div) (div) = sd_srcfc x sd_fc
673 *-------------------------------------------------------------------
674 * 0 0 0 (1) 1 (4) 4
675 * 0 0 1 (2) 1 (4) 8
676 * 1 0 2 (4) 1 (4) 16
677 * 1 0 3 (8) 1 (4) 32
678 * 1 0 4 (16) 1 (4) 64
679 * 0 0 0 (1) 0 (2) 2
680 * 0 0 1 (2) 0 (2) 4
681 * 1 0 2 (4) 0 (2) 8
682 * 1 0 3 (8) 0 (2) 16
683 * 1 0 4 (16) 0 (2) 32
684 */
685 static const struct sd_div_table cpg_sd_div_table[] = {
686 /* CPG_SD_DIV_TABLE_DATA(stp_hck, stp_ck, sd_srcfc, sd_fc, sd_div) */
687 CPG_SD_DIV_TABLE_DATA(0, 0, 0, 1, 4),
688 CPG_SD_DIV_TABLE_DATA(0, 0, 1, 1, 8),
689 CPG_SD_DIV_TABLE_DATA(1, 0, 2, 1, 16),
690 CPG_SD_DIV_TABLE_DATA(1, 0, 3, 1, 32),
691 CPG_SD_DIV_TABLE_DATA(1, 0, 4, 1, 64),
692 CPG_SD_DIV_TABLE_DATA(0, 0, 0, 0, 2),
693 CPG_SD_DIV_TABLE_DATA(0, 0, 1, 0, 4),
694 CPG_SD_DIV_TABLE_DATA(1, 0, 2, 0, 8),
695 CPG_SD_DIV_TABLE_DATA(1, 0, 3, 0, 16),
696 CPG_SD_DIV_TABLE_DATA(1, 0, 4, 0, 32),
697 };
698
699 static bool gen3_clk_is_mod(struct clk *clk)
700 {
701 return (clk->id >> 16) == CPG_MOD;
702 }
703
704 static int gen3_clk_get_mod(struct clk *clk, const struct mssr_mod_clk **mssr)
705 {
706 struct gen3_clk_priv *priv = dev_get_priv(clk->dev);
707 const unsigned long clkid = clk->id & 0xffff;
708 int i;
709
710 if (!gen3_clk_is_mod(clk))
711 return -EINVAL;
712
713 for (i = 0; i < priv->mod_clk_size; i++) {
714 if (priv->mod_clk[i].id != MOD_CLK_ID(clkid))
715 continue;
716
717 *mssr = &priv->mod_clk[i];
718 return 0;
719 }
720
721 return -ENODEV;
722 }
723
724 static int gen3_clk_get_core(struct clk *clk, const struct cpg_core_clk **core)
725 {
726 struct gen3_clk_priv *priv = dev_get_priv(clk->dev);
727 const unsigned long clkid = clk->id & 0xffff;
728 int i;
729
730 if (gen3_clk_is_mod(clk))
731 return -EINVAL;
732
733 for (i = 0; i < priv->core_clk_size; i++) {
734 if (priv->core_clk[i].id != clkid)
735 continue;
736
737 *core = &priv->core_clk[i];
738 return 0;
739 }
740
741 return -ENODEV;
742 }
743
744 static int gen3_clk_get_parent(struct clk *clk, struct clk *parent)
745 {
746 const struct cpg_core_clk *core;
747 const struct mssr_mod_clk *mssr;
748 int ret;
749
750 if (gen3_clk_is_mod(clk)) {
751 ret = gen3_clk_get_mod(clk, &mssr);
752 if (ret)
753 return ret;
754
755 parent->id = mssr->parent;
756 } else {
757 ret = gen3_clk_get_core(clk, &core);
758 if (ret)
759 return ret;
760
761 if (core->type == CLK_TYPE_IN)
762 parent->id = ~0; /* Top-level clock */
763 else
764 parent->id = core->parent;
765 }
766
767 parent->dev = clk->dev;
768
769 return 0;
770 }
771
772 static int gen3_clk_setup_sdif_div(struct clk *clk)
773 {
774 struct gen3_clk_priv *priv = dev_get_priv(clk->dev);
775 const struct cpg_core_clk *core;
776 struct clk parent;
777 int ret;
778
779 ret = gen3_clk_get_parent(clk, &parent);
780 if (ret) {
781 printf("%s[%i] parent fail, ret=%i\n", __func__, __LINE__, ret);
782 return ret;
783 }
784
785 if (gen3_clk_is_mod(&parent))
786 return 0;
787
788 ret = gen3_clk_get_core(&parent, &core);
789 if (ret)
790 return ret;
791
792 if (core->type != CLK_TYPE_GEN3_SD)
793 return 0;
794
795 debug("%s[%i] SDIF offset=%x\n", __func__, __LINE__, core->offset);
796
797 writel(1, priv->base + core->offset);
798
799 return 0;
800 }
801
802 static int gen3_clk_endisable(struct clk *clk, bool enable)
803 {
804 struct gen3_clk_priv *priv = dev_get_priv(clk->dev);
805 const unsigned long clkid = clk->id & 0xffff;
806 const unsigned int reg = clkid / 100;
807 const unsigned int bit = clkid % 100;
808 const u32 bitmask = BIT(bit);
809 int ret;
810
811 if (!gen3_clk_is_mod(clk))
812 return -EINVAL;
813
814 debug("%s[%i] MSTP %lu=%02u/%02u %s\n", __func__, __LINE__,
815 clkid, reg, bit, enable ? "ON" : "OFF");
816
817 if (enable) {
818 ret = gen3_clk_setup_sdif_div(clk);
819 if (ret)
820 return ret;
821 clrbits_le32(priv->base + SMSTPCR(reg), bitmask);
822 return wait_for_bit("MSTP", priv->base + MSTPSR(reg),
823 bitmask, 0, 100, 0);
824 } else {
825 setbits_le32(priv->base + SMSTPCR(reg), bitmask);
826 return 0;
827 }
828 }
829
830 static int gen3_clk_enable(struct clk *clk)
831 {
832 return gen3_clk_endisable(clk, true);
833 }
834
835 static int gen3_clk_disable(struct clk *clk)
836 {
837 return gen3_clk_endisable(clk, false);
838 }
839
840 static ulong gen3_clk_get_rate(struct clk *clk)
841 {
842 struct gen3_clk_priv *priv = dev_get_priv(clk->dev);
843 struct clk parent;
844 const struct cpg_core_clk *core;
845 const struct rcar_gen3_cpg_pll_config *pll_config =
846 priv->cpg_pll_config;
847 u32 value, mult, prediv, postdiv, rate = 0;
848 int i, ret;
849
850 debug("%s[%i] Clock: id=%lu\n", __func__, __LINE__, clk->id);
851
852 ret = gen3_clk_get_parent(clk, &parent);
853 if (ret) {
854 printf("%s[%i] parent fail, ret=%i\n", __func__, __LINE__, ret);
855 return ret;
856 }
857
858 if (gen3_clk_is_mod(clk)) {
859 rate = gen3_clk_get_rate(&parent);
860 debug("%s[%i] MOD clk: parent=%lu => rate=%u\n",
861 __func__, __LINE__, parent.id, rate);
862 return rate;
863 }
864
865 ret = gen3_clk_get_core(clk, &core);
866 if (ret)
867 return ret;
868
869 switch (core->type) {
870 case CLK_TYPE_IN:
871 if (core->id == CLK_EXTAL) {
872 rate = clk_get_rate(&priv->clk_extal);
873 debug("%s[%i] EXTAL clk: rate=%u\n",
874 __func__, __LINE__, rate);
875 return rate;
876 }
877
878 if (core->id == CLK_EXTALR) {
879 rate = clk_get_rate(&priv->clk_extalr);
880 debug("%s[%i] EXTALR clk: rate=%u\n",
881 __func__, __LINE__, rate);
882 return rate;
883 }
884
885 return -EINVAL;
886
887 case CLK_TYPE_GEN3_MAIN:
888 rate = gen3_clk_get_rate(&parent) / pll_config->extal_div;
889 debug("%s[%i] MAIN clk: parent=%i extal_div=%i => rate=%u\n",
890 __func__, __LINE__,
891 core->parent, pll_config->extal_div, rate);
892 return rate;
893
894 case CLK_TYPE_GEN3_PLL0:
895 value = readl(priv->base + CPG_PLL0CR);
896 mult = (((value >> 24) & 0x7f) + 1) * 2;
897 rate = gen3_clk_get_rate(&parent) * mult;
898 debug("%s[%i] PLL0 clk: parent=%i mult=%u => rate=%u\n",
899 __func__, __LINE__, core->parent, mult, rate);
900 return rate;
901
902 case CLK_TYPE_GEN3_PLL1:
903 rate = gen3_clk_get_rate(&parent) * pll_config->pll1_mult;
904 debug("%s[%i] PLL1 clk: parent=%i mul=%i => rate=%u\n",
905 __func__, __LINE__,
906 core->parent, pll_config->pll1_mult, rate);
907 return rate;
908
909 case CLK_TYPE_GEN3_PLL2:
910 value = readl(priv->base + CPG_PLL2CR);
911 mult = (((value >> 24) & 0x7f) + 1) * 2;
912 rate = gen3_clk_get_rate(&parent) * mult;
913 debug("%s[%i] PLL2 clk: parent=%i mult=%u => rate=%u\n",
914 __func__, __LINE__, core->parent, mult, rate);
915 return rate;
916
917 case CLK_TYPE_GEN3_PLL3:
918 rate = gen3_clk_get_rate(&parent) * pll_config->pll3_mult;
919 debug("%s[%i] PLL3 clk: parent=%i mul=%i => rate=%u\n",
920 __func__, __LINE__,
921 core->parent, pll_config->pll3_mult, rate);
922 return rate;
923
924 case CLK_TYPE_GEN3_PLL4:
925 value = readl(priv->base + CPG_PLL4CR);
926 mult = (((value >> 24) & 0x7f) + 1) * 2;
927 rate = gen3_clk_get_rate(&parent) * mult;
928 debug("%s[%i] PLL4 clk: parent=%i mult=%u => rate=%u\n",
929 __func__, __LINE__, core->parent, mult, rate);
930 return rate;
931
932 case CLK_TYPE_FF:
933 rate = (gen3_clk_get_rate(&parent) * core->mult) / core->div;
934 debug("%s[%i] FIXED clk: parent=%i div=%i mul=%i => rate=%u\n",
935 __func__, __LINE__,
936 core->parent, core->mult, core->div, rate);
937 return rate;
938
939 case CLK_TYPE_GEN3_SD: /* FIXME */
940 value = readl(priv->base + core->offset);
941 value &= CPG_SD_STP_MASK | CPG_SD_FC_MASK;
942
943 for (i = 0; i < ARRAY_SIZE(cpg_sd_div_table); i++) {
944 if (cpg_sd_div_table[i].val != value)
945 continue;
946
947 rate = gen3_clk_get_rate(&parent) /
948 cpg_sd_div_table[i].div;
949 debug("%s[%i] SD clk: parent=%i div=%i => rate=%u\n",
950 __func__, __LINE__,
951 core->parent, cpg_sd_div_table[i].div, rate);
952
953 return rate;
954 }
955
956 return -EINVAL;
957
958 case CLK_TYPE_GEN3_RPC:
959 rate = gen3_clk_get_rate(&parent);
960
961 value = readl(priv->base + core->offset);
962
963 prediv = (value >> CPG_RPC_PREDIV_OFFSET) &
964 CPG_RPC_PREDIV_MASK;
965 if (prediv == 2)
966 rate /= 5;
967 else if (prediv == 3)
968 rate /= 6;
969 else
970 return -EINVAL;
971
972 postdiv = (value >> CPG_RPC_POSTDIV_OFFSET) &
973 CPG_RPC_POSTDIV_MASK;
974 rate /= postdiv + 1;
975
976 debug("%s[%i] RPC clk: parent=%i prediv=%i postdiv=%i => rate=%u\n",
977 __func__, __LINE__,
978 core->parent, prediv, postdiv, rate);
979
980 return -EINVAL;
981
982 }
983
984 printf("%s[%i] unknown fail\n", __func__, __LINE__);
985
986 return -ENOENT;
987 }
988
989 static ulong gen3_clk_set_rate(struct clk *clk, ulong rate)
990 {
991 return gen3_clk_get_rate(clk);
992 }
993
994 static int gen3_clk_of_xlate(struct clk *clk, struct ofnode_phandle_args *args)
995 {
996 if (args->args_count != 2) {
997 debug("Invaild args_count: %d\n", args->args_count);
998 return -EINVAL;
999 }
1000
1001 clk->id = (args->args[0] << 16) | args->args[1];
1002
1003 return 0;
1004 }
1005
1006 static const struct clk_ops gen3_clk_ops = {
1007 .enable = gen3_clk_enable,
1008 .disable = gen3_clk_disable,
1009 .get_rate = gen3_clk_get_rate,
1010 .set_rate = gen3_clk_set_rate,
1011 .of_xlate = gen3_clk_of_xlate,
1012 };
1013
1014 enum gen3_clk_model {
1015 CLK_R8A7795,
1016 CLK_R8A7796,
1017 };
1018
1019 static int gen3_clk_probe(struct udevice *dev)
1020 {
1021 struct gen3_clk_priv *priv = dev_get_priv(dev);
1022 enum gen3_clk_model model = dev_get_driver_data(dev);
1023 fdt_addr_t rst_base;
1024 u32 cpg_mode;
1025 int ret;
1026
1027 priv->base = (struct gen3_base *)devfdt_get_addr(dev);
1028 if (!priv->base)
1029 return -EINVAL;
1030
1031 switch (model) {
1032 case CLK_R8A7795:
1033 priv->core_clk = r8a7795_core_clks;
1034 priv->core_clk_size = ARRAY_SIZE(r8a7795_core_clks);
1035 priv->mod_clk = r8a7795_mod_clks;
1036 priv->mod_clk_size = ARRAY_SIZE(r8a7795_mod_clks);
1037 ret = fdt_node_offset_by_compatible(gd->fdt_blob, -1,
1038 "renesas,r8a7795-rst");
1039 if (ret < 0)
1040 return ret;
1041 break;
1042 case CLK_R8A7796:
1043 priv->core_clk = r8a7796_core_clks;
1044 priv->core_clk_size = ARRAY_SIZE(r8a7796_core_clks);
1045 priv->mod_clk = r8a7796_mod_clks;
1046 priv->mod_clk_size = ARRAY_SIZE(r8a7796_mod_clks);
1047 ret = fdt_node_offset_by_compatible(gd->fdt_blob, -1,
1048 "renesas,r8a7796-rst");
1049 if (ret < 0)
1050 return ret;
1051 break;
1052 default:
1053 return -EINVAL;
1054 }
1055
1056 rst_base = fdtdec_get_addr(gd->fdt_blob, ret, "reg");
1057 if (rst_base == FDT_ADDR_T_NONE)
1058 return -EINVAL;
1059
1060 cpg_mode = readl(rst_base + CPG_RST_MODEMR);
1061
1062 priv->cpg_pll_config = &cpg_pll_configs[CPG_PLL_CONFIG_INDEX(cpg_mode)];
1063 if (!priv->cpg_pll_config->extal_div)
1064 return -EINVAL;
1065
1066 ret = clk_get_by_name(dev, "extal", &priv->clk_extal);
1067 if (ret < 0)
1068 return ret;
1069
1070 ret = clk_get_by_name(dev, "extalr", &priv->clk_extalr);
1071 if (ret < 0)
1072 return ret;
1073
1074 return 0;
1075 }
1076
1077 static const struct udevice_id gen3_clk_ids[] = {
1078 { .compatible = "renesas,r8a7795-cpg-mssr", .data = CLK_R8A7795 },
1079 { .compatible = "renesas,r8a7796-cpg-mssr", .data = CLK_R8A7796 },
1080 { }
1081 };
1082
1083 U_BOOT_DRIVER(clk_gen3) = {
1084 .name = "clk_gen3",
1085 .id = UCLASS_CLK,
1086 .of_match = gen3_clk_ids,
1087 .priv_auto_alloc_size = sizeof(struct gen3_clk_priv),
1088 .ops = &gen3_clk_ops,
1089 .probe = gen3_clk_probe,
1090 };