1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 *
4 *  Copyright (C) 2010 John Crispin <john@phrozen.org>
5 *  Copyright (C) 2013-2015 Lantiq Beteiligungs-GmbH & Co.KG
6 */
7
8#include <linux/io.h>
9#include <linux/export.h>
10#include <linux/clk.h>
11
12#include <asm/time.h>
13#include <asm/irq.h>
14#include <asm/div64.h>
15
16#include <lantiq_soc.h>
17
18#include "../clk.h"
19
20static unsigned int ram_clocks[] = {
21	CLOCK_167M, CLOCK_133M, CLOCK_111M, CLOCK_83M };
22#define DDR_HZ ram_clocks[ltq_cgu_r32(CGU_SYS) & 0x3]
23
24/* legacy xway clock */
25#define CGU_SYS			0x10
26
27/* vr9, ar10/grx390 clock */
28#define CGU_SYS_XRX		0x0c
29#define CGU_IF_CLK_AR10		0x24
30
31unsigned long ltq_danube_fpi_hz(void)
32{
33	unsigned long ddr_clock = DDR_HZ;
34
35	if (ltq_cgu_r32(CGU_SYS) & 0x40)
36		return ddr_clock >> 1;
37	return ddr_clock;
38}
39
40unsigned long ltq_danube_cpu_hz(void)
41{
42	switch (ltq_cgu_r32(CGU_SYS) & 0xc) {
43	case 0:
44		return CLOCK_333M;
45	case 4:
46		return DDR_HZ;
47	case 8:
48		return DDR_HZ << 1;
49	default:
50		return DDR_HZ >> 1;
51	}
52}
53
54unsigned long ltq_danube_pp32_hz(void)
55{
56	unsigned int clksys = (ltq_cgu_r32(CGU_SYS) >> 7) & 3;
57	unsigned long clk;
58
59	switch (clksys) {
60	case 1:
61		clk = CLOCK_240M;
62		break;
63	case 2:
64		clk = CLOCK_222M;
65		break;
66	case 3:
67		clk = CLOCK_133M;
68		break;
69	default:
70		clk = CLOCK_266M;
71		break;
72	}
73
74	return clk;
75}
76
77unsigned long ltq_ar9_sys_hz(void)
78{
79	if (((ltq_cgu_r32(CGU_SYS) >> 3) & 0x3) == 0x2)
80		return CLOCK_393M;
81	return CLOCK_333M;
82}
83
84unsigned long ltq_ar9_fpi_hz(void)
85{
86	unsigned long sys = ltq_ar9_sys_hz();
87
88	if (ltq_cgu_r32(CGU_SYS) & BIT(0))
89		return sys / 3;
90	else
91		return sys / 2;
92}
93
94unsigned long ltq_ar9_cpu_hz(void)
95{
96	if (ltq_cgu_r32(CGU_SYS) & BIT(2))
97		return ltq_ar9_fpi_hz();
98	else
99		return ltq_ar9_sys_hz();
100}
101
102unsigned long ltq_vr9_cpu_hz(void)
103{
104	unsigned int cpu_sel;
105	unsigned long clk;
106
107	cpu_sel = (ltq_cgu_r32(CGU_SYS_XRX) >> 4) & 0xf;
108
109	switch (cpu_sel) {
110	case 0:
111		clk = CLOCK_600M;
112		break;
113	case 1:
114		clk = CLOCK_500M;
115		break;
116	case 2:
117		clk = CLOCK_393M;
118		break;
119	case 3:
120		clk = CLOCK_333M;
121		break;
122	case 5:
123	case 6:
124		clk = CLOCK_196_608M;
125		break;
126	case 7:
127		clk = CLOCK_167M;
128		break;
129	case 4:
130	case 8:
131	case 9:
132		clk = CLOCK_125M;
133		break;
134	default:
135		clk = 0;
136		break;
137	}
138
139	return clk;
140}
141
142unsigned long ltq_vr9_fpi_hz(void)
143{
144	unsigned int ocp_sel, cpu_clk;
145	unsigned long clk;
146
147	cpu_clk = ltq_vr9_cpu_hz();
148	ocp_sel = ltq_cgu_r32(CGU_SYS_XRX) & 0x3;
149
150	switch (ocp_sel) {
151	case 0:
152		/* OCP ratio 1 */
153		clk = cpu_clk;
154		break;
155	case 2:
156		/* OCP ratio 2 */
157		clk = cpu_clk / 2;
158		break;
159	case 3:
160		/* OCP ratio 2.5 */
161		clk = (cpu_clk * 2) / 5;
162		break;
163	case 4:
164		/* OCP ratio 3 */
165		clk = cpu_clk / 3;
166		break;
167	default:
168		clk = 0;
169		break;
170	}
171
172	return clk;
173}
174
175unsigned long ltq_vr9_pp32_hz(void)
176{
177	unsigned int clksys = (ltq_cgu_r32(CGU_SYS) >> 16) & 0x7;
178	unsigned long clk;
179
180	switch (clksys) {
181	case 0:
182		clk = CLOCK_500M;
183		break;
184	case 1:
185		clk = CLOCK_432M;
186		break;
187	case 2:
188		clk = CLOCK_288M;
189		break;
190	default:
191		clk = CLOCK_500M;
192		break;
193	}
194
195	return clk;
196}
197
198unsigned long ltq_ar10_cpu_hz(void)
199{
200	unsigned int clksys;
201	int cpu_fs = (ltq_cgu_r32(CGU_SYS_XRX) >> 8) & 0x1;
202	int freq_div = (ltq_cgu_r32(CGU_SYS_XRX) >> 4) & 0x7;
203
204	switch (cpu_fs) {
205	case 0:
206		clksys = CLOCK_500M;
207		break;
208	case 1:
209		clksys = CLOCK_600M;
210		break;
211	default:
212		clksys = CLOCK_500M;
213		break;
214	}
215
216	switch (freq_div) {
217	case 0:
218		return clksys;
219	case 1:
220		return clksys >> 1;
221	case 2:
222		return clksys >> 2;
223	default:
224		return clksys;
225	}
226}
227
228unsigned long ltq_ar10_fpi_hz(void)
229{
230	int freq_fpi = (ltq_cgu_r32(CGU_IF_CLK_AR10) >> 25) & 0xf;
231
232	switch (freq_fpi) {
233	case 1:
234		return CLOCK_300M;
235	case 5:
236		return CLOCK_250M;
237	case 2:
238		return CLOCK_150M;
239	case 6:
240		return CLOCK_125M;
241
242	default:
243		return CLOCK_125M;
244	}
245}
246
247unsigned long ltq_ar10_pp32_hz(void)
248{
249	unsigned int clksys = (ltq_cgu_r32(CGU_SYS) >> 16) & 0x7;
250	unsigned long clk;
251
252	switch (clksys) {
253	case 1:
254		clk = CLOCK_250M;
255		break;
256	case 4:
257		clk = CLOCK_400M;
258		break;
259	default:
260		clk = CLOCK_250M;
261		break;
262	}
263
264	return clk;
265}
266
267unsigned long ltq_grx390_cpu_hz(void)
268{
269	unsigned int clksys;
270	int cpu_fs = ((ltq_cgu_r32(CGU_SYS_XRX) >> 9) & 0x3);
271	int freq_div = ((ltq_cgu_r32(CGU_SYS_XRX) >> 4) & 0x7);
272
273	switch (cpu_fs) {
274	case 0:
275		clksys = CLOCK_600M;
276		break;
277	case 1:
278		clksys = CLOCK_666M;
279		break;
280	case 2:
281		clksys = CLOCK_720M;
282		break;
283	default:
284		clksys = CLOCK_600M;
285		break;
286	}
287
288	switch (freq_div) {
289	case 0:
290		return clksys;
291	case 1:
292		return clksys >> 1;
293	case 2:
294		return clksys >> 2;
295	default:
296		return clksys;
297	}
298}
299
300unsigned long ltq_grx390_fpi_hz(void)
301{
302	/* fpi clock is derived from ddr_clk */
303	unsigned int clksys;
304	int cpu_fs = ((ltq_cgu_r32(CGU_SYS_XRX) >> 9) & 0x3);
305	int freq_div = ((ltq_cgu_r32(CGU_SYS_XRX)) & 0x7);
306	switch (cpu_fs) {
307	case 0:
308		clksys = CLOCK_600M;
309		break;
310	case 1:
311		clksys = CLOCK_666M;
312		break;
313	case 2:
314		clksys = CLOCK_720M;
315		break;
316	default:
317		clksys = CLOCK_600M;
318		break;
319	}
320
321	switch (freq_div) {
322	case 1:
323		return clksys >> 1;
324	case 2:
325		return clksys >> 2;
326	default:
327		return clksys >> 1;
328	}
329}
330
331unsigned long ltq_grx390_pp32_hz(void)
332{
333	unsigned int clksys = (ltq_cgu_r32(CGU_SYS) >> 16) & 0x7;
334	unsigned long clk;
335
336	switch (clksys) {
337	case 1:
338		clk = CLOCK_250M;
339		break;
340	case 2:
341		clk = CLOCK_432M;
342		break;
343	case 4:
344		clk = CLOCK_400M;
345		break;
346	default:
347		clk = CLOCK_250M;
348		break;
349	}
350	return clk;
351}
352