Merge tag 'amlogic-fixes' into v5.11/dt64
[linux-2.6-microblaze.git] / drivers / clk / renesas / r8a7795-cpg-mssr.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * r8a7795 Clock Pulse Generator / Module Standby and Software Reset
4  *
5  * Copyright (C) 2015 Glider bvba
6  * Copyright (C) 2018-2019 Renesas Electronics Corp.
7  *
8  * Based on clk-rcar-gen3.c
9  *
10  * Copyright (C) 2015 Renesas Electronics Corp.
11  */
12
13 #include <linux/device.h>
14 #include <linux/init.h>
15 #include <linux/kernel.h>
16 #include <linux/soc/renesas/rcar-rst.h>
17 #include <linux/sys_soc.h>
18
19 #include <dt-bindings/clock/r8a7795-cpg-mssr.h>
20
21 #include "renesas-cpg-mssr.h"
22 #include "rcar-gen3-cpg.h"
23
24 enum clk_ids {
25         /* Core Clock Outputs exported to DT */
26         LAST_DT_CORE_CLK = R8A7795_CLK_S0D12,
27
28         /* External Input Clocks */
29         CLK_EXTAL,
30         CLK_EXTALR,
31
32         /* Internal Core Clocks */
33         CLK_MAIN,
34         CLK_PLL0,
35         CLK_PLL1,
36         CLK_PLL2,
37         CLK_PLL3,
38         CLK_PLL4,
39         CLK_PLL1_DIV2,
40         CLK_PLL1_DIV4,
41         CLK_S0,
42         CLK_S1,
43         CLK_S2,
44         CLK_S3,
45         CLK_SDSRC,
46         CLK_SSPSRC,
47         CLK_RPCSRC,
48         CLK_RINT,
49
50         /* Module Clocks */
51         MOD_CLK_BASE
52 };
53
54 static struct cpg_core_clk r8a7795_core_clks[] __initdata = {
55         /* External Clock Inputs */
56         DEF_INPUT("extal",      CLK_EXTAL),
57         DEF_INPUT("extalr",     CLK_EXTALR),
58
59         /* Internal Core Clocks */
60         DEF_BASE(".main",       CLK_MAIN, CLK_TYPE_GEN3_MAIN, CLK_EXTAL),
61         DEF_BASE(".pll0",       CLK_PLL0, CLK_TYPE_GEN3_PLL0, CLK_MAIN),
62         DEF_BASE(".pll1",       CLK_PLL1, CLK_TYPE_GEN3_PLL1, CLK_MAIN),
63         DEF_BASE(".pll2",       CLK_PLL2, CLK_TYPE_GEN3_PLL2, CLK_MAIN),
64         DEF_BASE(".pll3",       CLK_PLL3, CLK_TYPE_GEN3_PLL3, CLK_MAIN),
65         DEF_BASE(".pll4",       CLK_PLL4, CLK_TYPE_GEN3_PLL4, CLK_MAIN),
66
67         DEF_FIXED(".pll1_div2", CLK_PLL1_DIV2,     CLK_PLL1,       2, 1),
68         DEF_FIXED(".pll1_div4", CLK_PLL1_DIV4,     CLK_PLL1_DIV2,  2, 1),
69         DEF_FIXED(".s0",        CLK_S0,            CLK_PLL1_DIV2,  2, 1),
70         DEF_FIXED(".s1",        CLK_S1,            CLK_PLL1_DIV2,  3, 1),
71         DEF_FIXED(".s2",        CLK_S2,            CLK_PLL1_DIV2,  4, 1),
72         DEF_FIXED(".s3",        CLK_S3,            CLK_PLL1_DIV2,  6, 1),
73         DEF_FIXED(".sdsrc",     CLK_SDSRC,         CLK_PLL1_DIV2,  2, 1),
74         DEF_BASE(".rpcsrc",     CLK_RPCSRC, CLK_TYPE_GEN3_RPCSRC, CLK_PLL1),
75
76         DEF_BASE("rpc",         R8A7795_CLK_RPC, CLK_TYPE_GEN3_RPC,
77                  CLK_RPCSRC),
78         DEF_BASE("rpcd2",       R8A7795_CLK_RPCD2, CLK_TYPE_GEN3_RPCD2,
79                  R8A7795_CLK_RPC),
80
81         DEF_GEN3_OSC(".r",      CLK_RINT,          CLK_EXTAL,      32),
82
83         /* Core Clock Outputs */
84         DEF_GEN3_Z("z",         R8A7795_CLK_Z,     CLK_TYPE_GEN3_Z,  CLK_PLL0, 2, 8),
85         DEF_GEN3_Z("z2",        R8A7795_CLK_Z2,    CLK_TYPE_GEN3_Z,  CLK_PLL2, 2, 0),
86         DEF_FIXED("ztr",        R8A7795_CLK_ZTR,   CLK_PLL1_DIV2,  6, 1),
87         DEF_FIXED("ztrd2",      R8A7795_CLK_ZTRD2, CLK_PLL1_DIV2, 12, 1),
88         DEF_FIXED("zt",         R8A7795_CLK_ZT,    CLK_PLL1_DIV2,  4, 1),
89         DEF_FIXED("zx",         R8A7795_CLK_ZX,    CLK_PLL1_DIV2,  2, 1),
90         DEF_FIXED("s0d1",       R8A7795_CLK_S0D1,  CLK_S0,         1, 1),
91         DEF_FIXED("s0d2",       R8A7795_CLK_S0D2,  CLK_S0,         2, 1),
92         DEF_FIXED("s0d3",       R8A7795_CLK_S0D3,  CLK_S0,         3, 1),
93         DEF_FIXED("s0d4",       R8A7795_CLK_S0D4,  CLK_S0,         4, 1),
94         DEF_FIXED("s0d6",       R8A7795_CLK_S0D6,  CLK_S0,         6, 1),
95         DEF_FIXED("s0d8",       R8A7795_CLK_S0D8,  CLK_S0,         8, 1),
96         DEF_FIXED("s0d12",      R8A7795_CLK_S0D12, CLK_S0,        12, 1),
97         DEF_FIXED("s1d1",       R8A7795_CLK_S1D1,  CLK_S1,         1, 1),
98         DEF_FIXED("s1d2",       R8A7795_CLK_S1D2,  CLK_S1,         2, 1),
99         DEF_FIXED("s1d4",       R8A7795_CLK_S1D4,  CLK_S1,         4, 1),
100         DEF_FIXED("s2d1",       R8A7795_CLK_S2D1,  CLK_S2,         1, 1),
101         DEF_FIXED("s2d2",       R8A7795_CLK_S2D2,  CLK_S2,         2, 1),
102         DEF_FIXED("s2d4",       R8A7795_CLK_S2D4,  CLK_S2,         4, 1),
103         DEF_FIXED("s3d1",       R8A7795_CLK_S3D1,  CLK_S3,         1, 1),
104         DEF_FIXED("s3d2",       R8A7795_CLK_S3D2,  CLK_S3,         2, 1),
105         DEF_FIXED("s3d4",       R8A7795_CLK_S3D4,  CLK_S3,         4, 1),
106
107         DEF_GEN3_SD("sd0",      R8A7795_CLK_SD0,   CLK_SDSRC,     0x074),
108         DEF_GEN3_SD("sd1",      R8A7795_CLK_SD1,   CLK_SDSRC,     0x078),
109         DEF_GEN3_SD("sd2",      R8A7795_CLK_SD2,   CLK_SDSRC,     0x268),
110         DEF_GEN3_SD("sd3",      R8A7795_CLK_SD3,   CLK_SDSRC,     0x26c),
111
112         DEF_FIXED("cl",         R8A7795_CLK_CL,    CLK_PLL1_DIV2, 48, 1),
113         DEF_FIXED("cr",         R8A7795_CLK_CR,    CLK_PLL1_DIV4,  2, 1),
114         DEF_FIXED("cp",         R8A7795_CLK_CP,    CLK_EXTAL,      2, 1),
115         DEF_FIXED("cpex",       R8A7795_CLK_CPEX,  CLK_EXTAL,      2, 1),
116
117         DEF_DIV6P1("canfd",     R8A7795_CLK_CANFD, CLK_PLL1_DIV4, 0x244),
118         DEF_DIV6P1("csi0",      R8A7795_CLK_CSI0,  CLK_PLL1_DIV4, 0x00c),
119         DEF_DIV6P1("mso",       R8A7795_CLK_MSO,   CLK_PLL1_DIV4, 0x014),
120         DEF_DIV6P1("hdmi",      R8A7795_CLK_HDMI,  CLK_PLL1_DIV4, 0x250),
121
122         DEF_GEN3_OSC("osc",     R8A7795_CLK_OSC,   CLK_EXTAL,     8),
123
124         DEF_BASE("r",           R8A7795_CLK_R,     CLK_TYPE_GEN3_R, CLK_RINT),
125 };
126
127 static struct mssr_mod_clk r8a7795_mod_clks[] __initdata = {
128         DEF_MOD("fdp1-2",                117,   R8A7795_CLK_S2D1), /* ES1.x */
129         DEF_MOD("fdp1-1",                118,   R8A7795_CLK_S0D1),
130         DEF_MOD("fdp1-0",                119,   R8A7795_CLK_S0D1),
131         DEF_MOD("scif5",                 202,   R8A7795_CLK_S3D4),
132         DEF_MOD("scif4",                 203,   R8A7795_CLK_S3D4),
133         DEF_MOD("scif3",                 204,   R8A7795_CLK_S3D4),
134         DEF_MOD("scif1",                 206,   R8A7795_CLK_S3D4),
135         DEF_MOD("scif0",                 207,   R8A7795_CLK_S3D4),
136         DEF_MOD("msiof3",                208,   R8A7795_CLK_MSO),
137         DEF_MOD("msiof2",                209,   R8A7795_CLK_MSO),
138         DEF_MOD("msiof1",                210,   R8A7795_CLK_MSO),
139         DEF_MOD("msiof0",                211,   R8A7795_CLK_MSO),
140         DEF_MOD("sys-dmac2",             217,   R8A7795_CLK_S3D1),
141         DEF_MOD("sys-dmac1",             218,   R8A7795_CLK_S3D1),
142         DEF_MOD("sys-dmac0",             219,   R8A7795_CLK_S0D3),
143         DEF_MOD("sceg-pub",              229,   R8A7795_CLK_CR),
144         DEF_MOD("cmt3",                  300,   R8A7795_CLK_R),
145         DEF_MOD("cmt2",                  301,   R8A7795_CLK_R),
146         DEF_MOD("cmt1",                  302,   R8A7795_CLK_R),
147         DEF_MOD("cmt0",                  303,   R8A7795_CLK_R),
148         DEF_MOD("tpu0",                  304,   R8A7795_CLK_S3D4),
149         DEF_MOD("scif2",                 310,   R8A7795_CLK_S3D4),
150         DEF_MOD("sdif3",                 311,   R8A7795_CLK_SD3),
151         DEF_MOD("sdif2",                 312,   R8A7795_CLK_SD2),
152         DEF_MOD("sdif1",                 313,   R8A7795_CLK_SD1),
153         DEF_MOD("sdif0",                 314,   R8A7795_CLK_SD0),
154         DEF_MOD("pcie1",                 318,   R8A7795_CLK_S3D1),
155         DEF_MOD("pcie0",                 319,   R8A7795_CLK_S3D1),
156         DEF_MOD("usb-dmac30",            326,   R8A7795_CLK_S3D1),
157         DEF_MOD("usb3-if1",              327,   R8A7795_CLK_S3D1), /* ES1.x */
158         DEF_MOD("usb3-if0",              328,   R8A7795_CLK_S3D1),
159         DEF_MOD("usb-dmac31",            329,   R8A7795_CLK_S3D1),
160         DEF_MOD("usb-dmac0",             330,   R8A7795_CLK_S3D1),
161         DEF_MOD("usb-dmac1",             331,   R8A7795_CLK_S3D1),
162         DEF_MOD("rwdt",                  402,   R8A7795_CLK_R),
163         DEF_MOD("intc-ex",               407,   R8A7795_CLK_CP),
164         DEF_MOD("intc-ap",               408,   R8A7795_CLK_S0D3),
165         DEF_MOD("audmac1",               501,   R8A7795_CLK_S1D2),
166         DEF_MOD("audmac0",               502,   R8A7795_CLK_S1D2),
167         DEF_MOD("drif31",                508,   R8A7795_CLK_S3D2),
168         DEF_MOD("drif30",                509,   R8A7795_CLK_S3D2),
169         DEF_MOD("drif21",                510,   R8A7795_CLK_S3D2),
170         DEF_MOD("drif20",                511,   R8A7795_CLK_S3D2),
171         DEF_MOD("drif11",                512,   R8A7795_CLK_S3D2),
172         DEF_MOD("drif10",                513,   R8A7795_CLK_S3D2),
173         DEF_MOD("drif01",                514,   R8A7795_CLK_S3D2),
174         DEF_MOD("drif00",                515,   R8A7795_CLK_S3D2),
175         DEF_MOD("hscif4",                516,   R8A7795_CLK_S3D1),
176         DEF_MOD("hscif3",                517,   R8A7795_CLK_S3D1),
177         DEF_MOD("hscif2",                518,   R8A7795_CLK_S3D1),
178         DEF_MOD("hscif1",                519,   R8A7795_CLK_S3D1),
179         DEF_MOD("hscif0",                520,   R8A7795_CLK_S3D1),
180         DEF_MOD("thermal",               522,   R8A7795_CLK_CP),
181         DEF_MOD("pwm",                   523,   R8A7795_CLK_S0D12),
182         DEF_MOD("fcpvd3",                600,   R8A7795_CLK_S2D1), /* ES1.x */
183         DEF_MOD("fcpvd2",                601,   R8A7795_CLK_S0D2),
184         DEF_MOD("fcpvd1",                602,   R8A7795_CLK_S0D2),
185         DEF_MOD("fcpvd0",                603,   R8A7795_CLK_S0D2),
186         DEF_MOD("fcpvb1",                606,   R8A7795_CLK_S0D1),
187         DEF_MOD("fcpvb0",                607,   R8A7795_CLK_S0D1),
188         DEF_MOD("fcpvi2",                609,   R8A7795_CLK_S2D1), /* ES1.x */
189         DEF_MOD("fcpvi1",                610,   R8A7795_CLK_S0D1),
190         DEF_MOD("fcpvi0",                611,   R8A7795_CLK_S0D1),
191         DEF_MOD("fcpf2",                 613,   R8A7795_CLK_S2D1), /* ES1.x */
192         DEF_MOD("fcpf1",                 614,   R8A7795_CLK_S0D1),
193         DEF_MOD("fcpf0",                 615,   R8A7795_CLK_S0D1),
194         DEF_MOD("fcpci1",                616,   R8A7795_CLK_S2D1), /* ES1.x */
195         DEF_MOD("fcpci0",                617,   R8A7795_CLK_S2D1), /* ES1.x */
196         DEF_MOD("fcpcs",                 619,   R8A7795_CLK_S0D1),
197         DEF_MOD("vspd3",                 620,   R8A7795_CLK_S2D1), /* ES1.x */
198         DEF_MOD("vspd2",                 621,   R8A7795_CLK_S0D2),
199         DEF_MOD("vspd1",                 622,   R8A7795_CLK_S0D2),
200         DEF_MOD("vspd0",                 623,   R8A7795_CLK_S0D2),
201         DEF_MOD("vspbc",                 624,   R8A7795_CLK_S0D1),
202         DEF_MOD("vspbd",                 626,   R8A7795_CLK_S0D1),
203         DEF_MOD("vspi2",                 629,   R8A7795_CLK_S2D1), /* ES1.x */
204         DEF_MOD("vspi1",                 630,   R8A7795_CLK_S0D1),
205         DEF_MOD("vspi0",                 631,   R8A7795_CLK_S0D1),
206         DEF_MOD("ehci3",                 700,   R8A7795_CLK_S3D2),
207         DEF_MOD("ehci2",                 701,   R8A7795_CLK_S3D2),
208         DEF_MOD("ehci1",                 702,   R8A7795_CLK_S3D2),
209         DEF_MOD("ehci0",                 703,   R8A7795_CLK_S3D2),
210         DEF_MOD("hsusb",                 704,   R8A7795_CLK_S3D2),
211         DEF_MOD("hsusb3",                705,   R8A7795_CLK_S3D2),
212         DEF_MOD("cmm3",                  708,   R8A7795_CLK_S2D1),
213         DEF_MOD("cmm2",                  709,   R8A7795_CLK_S2D1),
214         DEF_MOD("cmm1",                  710,   R8A7795_CLK_S2D1),
215         DEF_MOD("cmm0",                  711,   R8A7795_CLK_S2D1),
216         DEF_MOD("csi21",                 713,   R8A7795_CLK_CSI0), /* ES1.x */
217         DEF_MOD("csi20",                 714,   R8A7795_CLK_CSI0),
218         DEF_MOD("csi41",                 715,   R8A7795_CLK_CSI0),
219         DEF_MOD("csi40",                 716,   R8A7795_CLK_CSI0),
220         DEF_MOD("du3",                   721,   R8A7795_CLK_S2D1),
221         DEF_MOD("du2",                   722,   R8A7795_CLK_S2D1),
222         DEF_MOD("du1",                   723,   R8A7795_CLK_S2D1),
223         DEF_MOD("du0",                   724,   R8A7795_CLK_S2D1),
224         DEF_MOD("lvds",                  727,   R8A7795_CLK_S0D4),
225         DEF_MOD("hdmi1",                 728,   R8A7795_CLK_HDMI),
226         DEF_MOD("hdmi0",                 729,   R8A7795_CLK_HDMI),
227         DEF_MOD("vin7",                  804,   R8A7795_CLK_S0D2),
228         DEF_MOD("vin6",                  805,   R8A7795_CLK_S0D2),
229         DEF_MOD("vin5",                  806,   R8A7795_CLK_S0D2),
230         DEF_MOD("vin4",                  807,   R8A7795_CLK_S0D2),
231         DEF_MOD("vin3",                  808,   R8A7795_CLK_S0D2),
232         DEF_MOD("vin2",                  809,   R8A7795_CLK_S0D2),
233         DEF_MOD("vin1",                  810,   R8A7795_CLK_S0D2),
234         DEF_MOD("vin0",                  811,   R8A7795_CLK_S0D2),
235         DEF_MOD("etheravb",              812,   R8A7795_CLK_S0D6),
236         DEF_MOD("sata0",                 815,   R8A7795_CLK_S3D2),
237         DEF_MOD("imr3",                  820,   R8A7795_CLK_S0D2),
238         DEF_MOD("imr2",                  821,   R8A7795_CLK_S0D2),
239         DEF_MOD("imr1",                  822,   R8A7795_CLK_S0D2),
240         DEF_MOD("imr0",                  823,   R8A7795_CLK_S0D2),
241         DEF_MOD("gpio7",                 905,   R8A7795_CLK_S3D4),
242         DEF_MOD("gpio6",                 906,   R8A7795_CLK_S3D4),
243         DEF_MOD("gpio5",                 907,   R8A7795_CLK_S3D4),
244         DEF_MOD("gpio4",                 908,   R8A7795_CLK_S3D4),
245         DEF_MOD("gpio3",                 909,   R8A7795_CLK_S3D4),
246         DEF_MOD("gpio2",                 910,   R8A7795_CLK_S3D4),
247         DEF_MOD("gpio1",                 911,   R8A7795_CLK_S3D4),
248         DEF_MOD("gpio0",                 912,   R8A7795_CLK_S3D4),
249         DEF_MOD("can-fd",                914,   R8A7795_CLK_S3D2),
250         DEF_MOD("can-if1",               915,   R8A7795_CLK_S3D4),
251         DEF_MOD("can-if0",               916,   R8A7795_CLK_S3D4),
252         DEF_MOD("rpc-if",                917,   R8A7795_CLK_RPCD2),
253         DEF_MOD("i2c6",                  918,   R8A7795_CLK_S0D6),
254         DEF_MOD("i2c5",                  919,   R8A7795_CLK_S0D6),
255         DEF_MOD("i2c-dvfs",              926,   R8A7795_CLK_CP),
256         DEF_MOD("i2c4",                  927,   R8A7795_CLK_S0D6),
257         DEF_MOD("i2c3",                  928,   R8A7795_CLK_S0D6),
258         DEF_MOD("i2c2",                  929,   R8A7795_CLK_S3D2),
259         DEF_MOD("i2c1",                  930,   R8A7795_CLK_S3D2),
260         DEF_MOD("i2c0",                  931,   R8A7795_CLK_S3D2),
261         DEF_MOD("ssi-all",              1005,   R8A7795_CLK_S3D4),
262         DEF_MOD("ssi9",                 1006,   MOD_CLK_ID(1005)),
263         DEF_MOD("ssi8",                 1007,   MOD_CLK_ID(1005)),
264         DEF_MOD("ssi7",                 1008,   MOD_CLK_ID(1005)),
265         DEF_MOD("ssi6",                 1009,   MOD_CLK_ID(1005)),
266         DEF_MOD("ssi5",                 1010,   MOD_CLK_ID(1005)),
267         DEF_MOD("ssi4",                 1011,   MOD_CLK_ID(1005)),
268         DEF_MOD("ssi3",                 1012,   MOD_CLK_ID(1005)),
269         DEF_MOD("ssi2",                 1013,   MOD_CLK_ID(1005)),
270         DEF_MOD("ssi1",                 1014,   MOD_CLK_ID(1005)),
271         DEF_MOD("ssi0",                 1015,   MOD_CLK_ID(1005)),
272         DEF_MOD("scu-all",              1017,   R8A7795_CLK_S3D4),
273         DEF_MOD("scu-dvc1",             1018,   MOD_CLK_ID(1017)),
274         DEF_MOD("scu-dvc0",             1019,   MOD_CLK_ID(1017)),
275         DEF_MOD("scu-ctu1-mix1",        1020,   MOD_CLK_ID(1017)),
276         DEF_MOD("scu-ctu0-mix0",        1021,   MOD_CLK_ID(1017)),
277         DEF_MOD("scu-src9",             1022,   MOD_CLK_ID(1017)),
278         DEF_MOD("scu-src8",             1023,   MOD_CLK_ID(1017)),
279         DEF_MOD("scu-src7",             1024,   MOD_CLK_ID(1017)),
280         DEF_MOD("scu-src6",             1025,   MOD_CLK_ID(1017)),
281         DEF_MOD("scu-src5",             1026,   MOD_CLK_ID(1017)),
282         DEF_MOD("scu-src4",             1027,   MOD_CLK_ID(1017)),
283         DEF_MOD("scu-src3",             1028,   MOD_CLK_ID(1017)),
284         DEF_MOD("scu-src2",             1029,   MOD_CLK_ID(1017)),
285         DEF_MOD("scu-src1",             1030,   MOD_CLK_ID(1017)),
286         DEF_MOD("scu-src0",             1031,   MOD_CLK_ID(1017)),
287 };
288
289 static const unsigned int r8a7795_crit_mod_clks[] __initconst = {
290         MOD_CLK_ID(402),        /* RWDT */
291         MOD_CLK_ID(408),        /* INTC-AP (GIC) */
292 };
293
294 /*
295  * CPG Clock Data
296  */
297
298 /*
299  *   MD         EXTAL           PLL0    PLL1    PLL2    PLL3    PLL4    OSC
300  * 14 13 19 17  (MHz)
301  *-------------------------------------------------------------------------
302  * 0  0  0  0   16.66 x 1       x180    x192    x144    x192    x144    /16
303  * 0  0  0  1   16.66 x 1       x180    x192    x144    x128    x144    /16
304  * 0  0  1  0   Prohibited setting
305  * 0  0  1  1   16.66 x 1       x180    x192    x144    x192    x144    /16
306  * 0  1  0  0   20    x 1       x150    x160    x120    x160    x120    /19
307  * 0  1  0  1   20    x 1       x150    x160    x120    x106    x120    /19
308  * 0  1  1  0   Prohibited setting
309  * 0  1  1  1   20    x 1       x150    x160    x120    x160    x120    /19
310  * 1  0  0  0   25    x 1       x120    x128    x96     x128    x96     /24
311  * 1  0  0  1   25    x 1       x120    x128    x96     x84     x96     /24
312  * 1  0  1  0   Prohibited setting
313  * 1  0  1  1   25    x 1       x120    x128    x96     x128    x96     /24
314  * 1  1  0  0   33.33 / 2       x180    x192    x144    x192    x144    /32
315  * 1  1  0  1   33.33 / 2       x180    x192    x144    x128    x144    /32
316  * 1  1  1  0   Prohibited setting
317  * 1  1  1  1   33.33 / 2       x180    x192    x144    x192    x144    /32
318  */
319 #define CPG_PLL_CONFIG_INDEX(md)        ((((md) & BIT(14)) >> 11) | \
320                                          (((md) & BIT(13)) >> 11) | \
321                                          (((md) & BIT(19)) >> 18) | \
322                                          (((md) & BIT(17)) >> 17))
323
324 static const struct rcar_gen3_cpg_pll_config cpg_pll_configs[16] __initconst = {
325         /* EXTAL div    PLL1 mult/div   PLL3 mult/div   OSC prediv */
326         { 1,            192,    1,      192,    1,      16,     },
327         { 1,            192,    1,      128,    1,      16,     },
328         { 0, /* Prohibited setting */                           },
329         { 1,            192,    1,      192,    1,      16,     },
330         { 1,            160,    1,      160,    1,      19,     },
331         { 1,            160,    1,      106,    1,      19,     },
332         { 0, /* Prohibited setting */                           },
333         { 1,            160,    1,      160,    1,      19,     },
334         { 1,            128,    1,      128,    1,      24,     },
335         { 1,            128,    1,      84,     1,      24,     },
336         { 0, /* Prohibited setting */                           },
337         { 1,            128,    1,      128,    1,      24,     },
338         { 2,            192,    1,      192,    1,      32,     },
339         { 2,            192,    1,      128,    1,      32,     },
340         { 0, /* Prohibited setting */                           },
341         { 2,            192,    1,      192,    1,      32,     },
342 };
343
344 static const struct soc_device_attribute r8a7795es1[] __initconst = {
345         { .soc_id = "r8a7795", .revision = "ES1.*" },
346         { /* sentinel */ }
347 };
348
349
350         /*
351          * Fixups for R-Car H3 ES1.x
352          */
353
354 static const unsigned int r8a7795es1_mod_nullify[] __initconst = {
355         MOD_CLK_ID(326),                        /* USB-DMAC3-0 */
356         MOD_CLK_ID(329),                        /* USB-DMAC3-1 */
357         MOD_CLK_ID(700),                        /* EHCI/OHCI3 */
358         MOD_CLK_ID(705),                        /* HS-USB-IF3 */
359
360 };
361
362 static const struct mssr_mod_reparent r8a7795es1_mod_reparent[] __initconst = {
363         { MOD_CLK_ID(118), R8A7795_CLK_S2D1 },  /* FDP1-1 */
364         { MOD_CLK_ID(119), R8A7795_CLK_S2D1 },  /* FDP1-0 */
365         { MOD_CLK_ID(217), R8A7795_CLK_S3D1 },  /* SYS-DMAC2 */
366         { MOD_CLK_ID(218), R8A7795_CLK_S3D1 },  /* SYS-DMAC1 */
367         { MOD_CLK_ID(219), R8A7795_CLK_S3D1 },  /* SYS-DMAC0 */
368         { MOD_CLK_ID(408), R8A7795_CLK_S3D1 },  /* INTC-AP */
369         { MOD_CLK_ID(501), R8A7795_CLK_S3D1 },  /* AUDMAC1 */
370         { MOD_CLK_ID(502), R8A7795_CLK_S3D1 },  /* AUDMAC0 */
371         { MOD_CLK_ID(523), R8A7795_CLK_S3D4 },  /* PWM */
372         { MOD_CLK_ID(601), R8A7795_CLK_S2D1 },  /* FCPVD2 */
373         { MOD_CLK_ID(602), R8A7795_CLK_S2D1 },  /* FCPVD1 */
374         { MOD_CLK_ID(603), R8A7795_CLK_S2D1 },  /* FCPVD0 */
375         { MOD_CLK_ID(606), R8A7795_CLK_S2D1 },  /* FCPVB1 */
376         { MOD_CLK_ID(607), R8A7795_CLK_S2D1 },  /* FCPVB0 */
377         { MOD_CLK_ID(610), R8A7795_CLK_S2D1 },  /* FCPVI1 */
378         { MOD_CLK_ID(611), R8A7795_CLK_S2D1 },  /* FCPVI0 */
379         { MOD_CLK_ID(614), R8A7795_CLK_S2D1 },  /* FCPF1 */
380         { MOD_CLK_ID(615), R8A7795_CLK_S2D1 },  /* FCPF0 */
381         { MOD_CLK_ID(619), R8A7795_CLK_S2D1 },  /* FCPCS */
382         { MOD_CLK_ID(621), R8A7795_CLK_S2D1 },  /* VSPD2 */
383         { MOD_CLK_ID(622), R8A7795_CLK_S2D1 },  /* VSPD1 */
384         { MOD_CLK_ID(623), R8A7795_CLK_S2D1 },  /* VSPD0 */
385         { MOD_CLK_ID(624), R8A7795_CLK_S2D1 },  /* VSPBC */
386         { MOD_CLK_ID(626), R8A7795_CLK_S2D1 },  /* VSPBD */
387         { MOD_CLK_ID(630), R8A7795_CLK_S2D1 },  /* VSPI1 */
388         { MOD_CLK_ID(631), R8A7795_CLK_S2D1 },  /* VSPI0 */
389         { MOD_CLK_ID(804), R8A7795_CLK_S2D1 },  /* VIN7 */
390         { MOD_CLK_ID(805), R8A7795_CLK_S2D1 },  /* VIN6 */
391         { MOD_CLK_ID(806), R8A7795_CLK_S2D1 },  /* VIN5 */
392         { MOD_CLK_ID(807), R8A7795_CLK_S2D1 },  /* VIN4 */
393         { MOD_CLK_ID(808), R8A7795_CLK_S2D1 },  /* VIN3 */
394         { MOD_CLK_ID(809), R8A7795_CLK_S2D1 },  /* VIN2 */
395         { MOD_CLK_ID(810), R8A7795_CLK_S2D1 },  /* VIN1 */
396         { MOD_CLK_ID(811), R8A7795_CLK_S2D1 },  /* VIN0 */
397         { MOD_CLK_ID(812), R8A7795_CLK_S3D2 },  /* EAVB-IF */
398         { MOD_CLK_ID(820), R8A7795_CLK_S2D1 },  /* IMR3 */
399         { MOD_CLK_ID(821), R8A7795_CLK_S2D1 },  /* IMR2 */
400         { MOD_CLK_ID(822), R8A7795_CLK_S2D1 },  /* IMR1 */
401         { MOD_CLK_ID(823), R8A7795_CLK_S2D1 },  /* IMR0 */
402         { MOD_CLK_ID(905), R8A7795_CLK_CP },    /* GPIO7 */
403         { MOD_CLK_ID(906), R8A7795_CLK_CP },    /* GPIO6 */
404         { MOD_CLK_ID(907), R8A7795_CLK_CP },    /* GPIO5 */
405         { MOD_CLK_ID(908), R8A7795_CLK_CP },    /* GPIO4 */
406         { MOD_CLK_ID(909), R8A7795_CLK_CP },    /* GPIO3 */
407         { MOD_CLK_ID(910), R8A7795_CLK_CP },    /* GPIO2 */
408         { MOD_CLK_ID(911), R8A7795_CLK_CP },    /* GPIO1 */
409         { MOD_CLK_ID(912), R8A7795_CLK_CP },    /* GPIO0 */
410         { MOD_CLK_ID(918), R8A7795_CLK_S3D2 },  /* I2C6 */
411         { MOD_CLK_ID(919), R8A7795_CLK_S3D2 },  /* I2C5 */
412         { MOD_CLK_ID(927), R8A7795_CLK_S3D2 },  /* I2C4 */
413         { MOD_CLK_ID(928), R8A7795_CLK_S3D2 },  /* I2C3 */
414 };
415
416
417         /*
418          * Fixups for R-Car H3 ES2.x
419          */
420
421 static const unsigned int r8a7795es2_mod_nullify[] __initconst = {
422         MOD_CLK_ID(117),                        /* FDP1-2 */
423         MOD_CLK_ID(327),                        /* USB3-IF1 */
424         MOD_CLK_ID(600),                        /* FCPVD3 */
425         MOD_CLK_ID(609),                        /* FCPVI2 */
426         MOD_CLK_ID(613),                        /* FCPF2 */
427         MOD_CLK_ID(616),                        /* FCPCI1 */
428         MOD_CLK_ID(617),                        /* FCPCI0 */
429         MOD_CLK_ID(620),                        /* VSPD3 */
430         MOD_CLK_ID(629),                        /* VSPI2 */
431         MOD_CLK_ID(713),                        /* CSI21 */
432 };
433
434 static int __init r8a7795_cpg_mssr_init(struct device *dev)
435 {
436         const struct rcar_gen3_cpg_pll_config *cpg_pll_config;
437         u32 cpg_mode;
438         int error;
439
440         error = rcar_rst_read_mode_pins(&cpg_mode);
441         if (error)
442                 return error;
443
444         cpg_pll_config = &cpg_pll_configs[CPG_PLL_CONFIG_INDEX(cpg_mode)];
445         if (!cpg_pll_config->extal_div) {
446                 dev_err(dev, "Prohibited setting (cpg_mode=0x%x)\n", cpg_mode);
447                 return -EINVAL;
448         }
449
450         if (soc_device_match(r8a7795es1)) {
451                 cpg_core_nullify_range(r8a7795_core_clks,
452                                        ARRAY_SIZE(r8a7795_core_clks),
453                                        R8A7795_CLK_S0D2, R8A7795_CLK_S0D12);
454                 mssr_mod_nullify(r8a7795_mod_clks,
455                                  ARRAY_SIZE(r8a7795_mod_clks),
456                                  r8a7795es1_mod_nullify,
457                                  ARRAY_SIZE(r8a7795es1_mod_nullify));
458                 mssr_mod_reparent(r8a7795_mod_clks,
459                                   ARRAY_SIZE(r8a7795_mod_clks),
460                                   r8a7795es1_mod_reparent,
461                                   ARRAY_SIZE(r8a7795es1_mod_reparent));
462         } else {
463                 mssr_mod_nullify(r8a7795_mod_clks,
464                                  ARRAY_SIZE(r8a7795_mod_clks),
465                                  r8a7795es2_mod_nullify,
466                                  ARRAY_SIZE(r8a7795es2_mod_nullify));
467         }
468
469         return rcar_gen3_cpg_init(cpg_pll_config, CLK_EXTALR, cpg_mode);
470 }
471
472 const struct cpg_mssr_info r8a7795_cpg_mssr_info __initconst = {
473         /* Core Clocks */
474         .core_clks = r8a7795_core_clks,
475         .num_core_clks = ARRAY_SIZE(r8a7795_core_clks),
476         .last_dt_core_clk = LAST_DT_CORE_CLK,
477         .num_total_core_clks = MOD_CLK_BASE,
478
479         /* Module Clocks */
480         .mod_clks = r8a7795_mod_clks,
481         .num_mod_clks = ARRAY_SIZE(r8a7795_mod_clks),
482         .num_hw_mod_clks = 12 * 32,
483
484         /* Critical Module Clocks */
485         .crit_mod_clks = r8a7795_crit_mod_clks,
486         .num_crit_mod_clks = ARRAY_SIZE(r8a7795_crit_mod_clks),
487
488         /* Callbacks */
489         .init = r8a7795_cpg_mssr_init,
490         .cpg_clk_register = rcar_gen3_cpg_clk_register,
491 };