1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Clock setup for SMDK5250 board based on EXYNOS5
4  *
5  * Copyright (C) 2012 Samsung Electronics
6  */
7 
8 #include <common.h>
9 #include <config.h>
10 #include <asm/io.h>
11 #include <asm/arch/clk.h>
12 #include <asm/arch/clock.h>
13 #include <asm/arch/spl.h>
14 #include <asm/arch/dwmmc.h>
15 
16 #include "clock_init.h"
17 #include "common_setup.h"
18 #include "exynos5_setup.h"
19 
20 #define FSYS1_MMC0_DIV_MASK	0xff0f
21 #define FSYS1_MMC0_DIV_VAL	0x0701
22 
23 struct arm_clk_ratios arm_clk_ratios[] = {
24 #ifdef CONFIG_EXYNOS5420
25 	{
26 		.arm_freq_mhz = 900,
27 
28 		.apll_mdiv = 0x96,
29 		.apll_pdiv = 0x2,
30 		.apll_sdiv = 0x1,
31 
32 		.arm2_ratio = 0x0,
33 		.apll_ratio = 0x3,
34 		.pclk_dbg_ratio = 0x6,
35 		.atb_ratio = 0x6,
36 		.periph_ratio = 0x7,
37 		.acp_ratio = 0x0,
38 		.cpud_ratio = 0x2,
39 		.arm_ratio = 0x0,
40 	}
41 #else
42 	{
43 		.arm_freq_mhz = 600,
44 
45 		.apll_mdiv = 0xc8,
46 		.apll_pdiv = 0x4,
47 		.apll_sdiv = 0x1,
48 
49 		.arm2_ratio = 0x0,
50 		.apll_ratio = 0x1,
51 		.pclk_dbg_ratio = 0x1,
52 		.atb_ratio = 0x2,
53 		.periph_ratio = 0x7,
54 		.acp_ratio = 0x7,
55 		.cpud_ratio = 0x1,
56 		.arm_ratio = 0x0,
57 	}, {
58 		.arm_freq_mhz = 800,
59 
60 		.apll_mdiv = 0x64,
61 		.apll_pdiv = 0x3,
62 		.apll_sdiv = 0x0,
63 
64 		.arm2_ratio = 0x0,
65 		.apll_ratio = 0x1,
66 		.pclk_dbg_ratio = 0x1,
67 		.atb_ratio = 0x3,
68 		.periph_ratio = 0x7,
69 		.acp_ratio = 0x7,
70 		.cpud_ratio = 0x2,
71 		.arm_ratio = 0x0,
72 	}, {
73 		.arm_freq_mhz = 1000,
74 
75 		.apll_mdiv = 0x7d,
76 		.apll_pdiv = 0x3,
77 		.apll_sdiv = 0x0,
78 
79 		.arm2_ratio = 0x0,
80 		.apll_ratio = 0x1,
81 		.pclk_dbg_ratio = 0x1,
82 		.atb_ratio = 0x4,
83 		.periph_ratio = 0x7,
84 		.acp_ratio = 0x7,
85 		.cpud_ratio = 0x2,
86 		.arm_ratio = 0x0,
87 	}, {
88 		.arm_freq_mhz = 1200,
89 
90 		.apll_mdiv = 0x96,
91 		.apll_pdiv = 0x3,
92 		.apll_sdiv = 0x0,
93 
94 		.arm2_ratio = 0x0,
95 		.apll_ratio = 0x3,
96 		.pclk_dbg_ratio = 0x1,
97 		.atb_ratio = 0x5,
98 		.periph_ratio = 0x7,
99 		.acp_ratio = 0x7,
100 		.cpud_ratio = 0x3,
101 		.arm_ratio = 0x0,
102 	}, {
103 		.arm_freq_mhz = 1400,
104 
105 		.apll_mdiv = 0xaf,
106 		.apll_pdiv = 0x3,
107 		.apll_sdiv = 0x0,
108 
109 		.arm2_ratio = 0x0,
110 		.apll_ratio = 0x3,
111 		.pclk_dbg_ratio = 0x1,
112 		.atb_ratio = 0x6,
113 		.periph_ratio = 0x7,
114 		.acp_ratio = 0x7,
115 		.cpud_ratio = 0x3,
116 		.arm_ratio = 0x0,
117 	}, {
118 		.arm_freq_mhz = 1700,
119 
120 		.apll_mdiv = 0x1a9,
121 		.apll_pdiv = 0x6,
122 		.apll_sdiv = 0x0,
123 
124 		.arm2_ratio = 0x0,
125 		.apll_ratio = 0x3,
126 		.pclk_dbg_ratio = 0x1,
127 		.atb_ratio = 0x6,
128 		.periph_ratio = 0x7,
129 		.acp_ratio = 0x7,
130 		.cpud_ratio = 0x3,
131 		.arm_ratio = 0x0,
132 	}
133 #endif
134 };
135 
136 struct mem_timings mem_timings[] = {
137 #ifdef CONFIG_EXYNOS5420
138 	{
139 		.mem_manuf = MEM_MANUF_SAMSUNG,
140 		.mem_type = DDR_MODE_DDR3,
141 		.frequency_mhz = 800,
142 
143 		/* MPLL @800MHz*/
144 		.mpll_mdiv = 0xc8,
145 		.mpll_pdiv = 0x3,
146 		.mpll_sdiv = 0x1,
147 		/* CPLL @666MHz */
148 		.cpll_mdiv = 0xde,
149 		.cpll_pdiv = 0x4,
150 		.cpll_sdiv = 0x1,
151 		/* EPLL @600MHz */
152 		.epll_mdiv = 0x64,
153 		.epll_pdiv = 0x2,
154 		.epll_sdiv = 0x1,
155 		/* VPLL @430MHz */
156 		.vpll_mdiv = 0xd7,
157 		.vpll_pdiv = 0x3,
158 		.vpll_sdiv = 0x2,
159 		/* BPLL @800MHz */
160 		.bpll_mdiv = 0xc8,
161 		.bpll_pdiv = 0x3,
162 		.bpll_sdiv = 0x1,
163 		/* KPLL @600MHz */
164 		.kpll_mdiv = 0x190,
165 		.kpll_pdiv = 0x4,
166 		.kpll_sdiv = 0x2,
167 		/* DPLL @600MHz */
168 		.dpll_mdiv = 0x190,
169 		.dpll_pdiv = 0x4,
170 		.dpll_sdiv = 0x2,
171 		/* IPLL @370MHz */
172 		.ipll_mdiv = 0xb9,
173 		.ipll_pdiv = 0x3,
174 		.ipll_sdiv = 0x2,
175 		/* SPLL @400MHz */
176 		.spll_mdiv = 0xc8,
177 		.spll_pdiv = 0x3,
178 		.spll_sdiv = 0x2,
179 		/* RPLL @141Mhz */
180 		.rpll_mdiv = 0x5E,
181 		.rpll_pdiv = 0x2,
182 		.rpll_sdiv = 0x3,
183 
184 		.direct_cmd_msr = {
185 			0x00020018, 0x00030000, 0x00010046, 0x00000d70,
186 			0x00000c70
187 		},
188 		.timing_ref = 0x000000bb,
189 		.timing_row = 0x6836650f,
190 		.timing_data = 0x3630580b,
191 		.timing_power = 0x41000a26,
192 		.phy0_dqs = 0x08080808,
193 		.phy1_dqs = 0x08080808,
194 		.phy0_dq = 0x08080808,
195 		.phy1_dq = 0x08080808,
196 		.phy0_tFS = 0x8,
197 		.phy1_tFS = 0x8,
198 		.phy0_pulld_dqs = 0xf,
199 		.phy1_pulld_dqs = 0xf,
200 
201 		.lpddr3_ctrl_phy_reset = 0x1,
202 		.ctrl_start_point = 0x10,
203 		.ctrl_inc = 0x10,
204 		.ctrl_start = 0x1,
205 		.ctrl_dll_on = 0x1,
206 		.ctrl_ref = 0x8,
207 
208 		.ctrl_force = 0x1a,
209 		.ctrl_rdlat = 0x0b,
210 		.ctrl_bstlen = 0x08,
211 
212 		.fp_resync = 0x8,
213 		.iv_size = 0x7,
214 		.dfi_init_start = 1,
215 		.aref_en = 1,
216 
217 		.rd_fetch = 0x3,
218 
219 		.zq_mode_dds = 0x7,
220 		.zq_mode_term = 0x1,
221 		.zq_mode_noterm = 1,
222 
223 		/*
224 		* Dynamic Clock: Always Running
225 		* Memory Burst length: 8
226 		* Number of chips: 1
227 		* Memory Bus width: 32 bit
228 		* Memory Type: DDR3
229 		* Additional Latancy for PLL: 0 Cycle
230 		*/
231 		.memcontrol = DMC_MEMCONTROL_CLK_STOP_DISABLE |
232 			DMC_MEMCONTROL_DPWRDN_DISABLE |
233 			DMC_MEMCONTROL_DPWRDN_ACTIVE_PRECHARGE |
234 			DMC_MEMCONTROL_TP_DISABLE |
235 			DMC_MEMCONTROL_DSREF_DISABLE |
236 			DMC_MEMCONTROL_ADD_LAT_PALL_CYCLE(0) |
237 			DMC_MEMCONTROL_MEM_TYPE_DDR3 |
238 			DMC_MEMCONTROL_MEM_WIDTH_32BIT |
239 			DMC_MEMCONTROL_NUM_CHIP_1 |
240 			DMC_MEMCONTROL_BL_8 |
241 			DMC_MEMCONTROL_PZQ_DISABLE |
242 			DMC_MEMCONTROL_MRR_BYTE_7_0,
243 		.memconfig = DMC_MEMCONFIG_CHIP_MAP_SPLIT |
244 			DMC_MEMCONFIGX_CHIP_COL_10 |
245 			DMC_MEMCONFIGX_CHIP_ROW_15 |
246 			DMC_MEMCONFIGX_CHIP_BANK_8,
247 		.prechconfig_tp_cnt = 0xff,
248 		.dpwrdn_cyc = 0xff,
249 		.dsref_cyc = 0xffff,
250 		.concontrol = DMC_CONCONTROL_DFI_INIT_START_DISABLE |
251 			DMC_CONCONTROL_TIMEOUT_LEVEL0 |
252 			DMC_CONCONTROL_RD_FETCH_DISABLE |
253 			DMC_CONCONTROL_EMPTY_DISABLE |
254 			DMC_CONCONTROL_AREF_EN_DISABLE |
255 			DMC_CONCONTROL_IO_PD_CON_DISABLE,
256 		.dmc_channels = 1,
257 		.chips_per_channel = 1,
258 		.chips_to_configure = 1,
259 		.send_zq_init = 1,
260 		.gate_leveling_enable = 1,
261 		.read_leveling_enable = 0,
262 	}
263 #else
264 	{
265 		.mem_manuf = MEM_MANUF_ELPIDA,
266 		.mem_type = DDR_MODE_DDR3,
267 		.frequency_mhz = 800,
268 		.mpll_mdiv = 0xc8,
269 		.mpll_pdiv = 0x3,
270 		.mpll_sdiv = 0x0,
271 		.cpll_mdiv = 0xde,
272 		.cpll_pdiv = 0x4,
273 		.cpll_sdiv = 0x2,
274 		.gpll_mdiv = 0x215,
275 		.gpll_pdiv = 0xc,
276 		.gpll_sdiv = 0x1,
277 		.epll_mdiv = 0x60,
278 		.epll_pdiv = 0x3,
279 		.epll_sdiv = 0x3,
280 		.vpll_mdiv = 0x96,
281 		.vpll_pdiv = 0x3,
282 		.vpll_sdiv = 0x2,
283 
284 		.bpll_mdiv = 0x64,
285 		.bpll_pdiv = 0x3,
286 		.bpll_sdiv = 0x0,
287 		.pclk_cdrex_ratio = 0x5,
288 		.direct_cmd_msr = {
289 			0x00020018, 0x00030000, 0x00010042, 0x00000d70
290 		},
291 		.timing_ref = 0x000000bb,
292 		.timing_row = 0x8c36650e,
293 		.timing_data = 0x3630580b,
294 		.timing_power = 0x41000a44,
295 		.phy0_dqs = 0x08080808,
296 		.phy1_dqs = 0x08080808,
297 		.phy0_dq = 0x08080808,
298 		.phy1_dq = 0x08080808,
299 		.phy0_tFS = 0x4,
300 		.phy1_tFS = 0x4,
301 		.phy0_pulld_dqs = 0xf,
302 		.phy1_pulld_dqs = 0xf,
303 
304 		.lpddr3_ctrl_phy_reset = 0x1,
305 		.ctrl_start_point = 0x10,
306 		.ctrl_inc = 0x10,
307 		.ctrl_start = 0x1,
308 		.ctrl_dll_on = 0x1,
309 		.ctrl_ref = 0x8,
310 
311 		.ctrl_force = 0x1a,
312 		.ctrl_rdlat = 0x0b,
313 		.ctrl_bstlen = 0x08,
314 
315 		.fp_resync = 0x8,
316 		.iv_size = 0x7,
317 		.dfi_init_start = 1,
318 		.aref_en = 1,
319 
320 		.rd_fetch = 0x3,
321 
322 		.zq_mode_dds = 0x7,
323 		.zq_mode_term = 0x1,
324 		.zq_mode_noterm = 0,
325 
326 		/*
327 		* Dynamic Clock: Always Running
328 		* Memory Burst length: 8
329 		* Number of chips: 1
330 		* Memory Bus width: 32 bit
331 		* Memory Type: DDR3
332 		* Additional Latancy for PLL: 0 Cycle
333 		*/
334 		.memcontrol = DMC_MEMCONTROL_CLK_STOP_DISABLE |
335 			DMC_MEMCONTROL_DPWRDN_DISABLE |
336 			DMC_MEMCONTROL_DPWRDN_ACTIVE_PRECHARGE |
337 			DMC_MEMCONTROL_TP_DISABLE |
338 			DMC_MEMCONTROL_DSREF_ENABLE |
339 			DMC_MEMCONTROL_ADD_LAT_PALL_CYCLE(0) |
340 			DMC_MEMCONTROL_MEM_TYPE_DDR3 |
341 			DMC_MEMCONTROL_MEM_WIDTH_32BIT |
342 			DMC_MEMCONTROL_NUM_CHIP_1 |
343 			DMC_MEMCONTROL_BL_8 |
344 			DMC_MEMCONTROL_PZQ_DISABLE |
345 			DMC_MEMCONTROL_MRR_BYTE_7_0,
346 		.memconfig = DMC_MEMCONFIGX_CHIP_MAP_INTERLEAVED |
347 			DMC_MEMCONFIGX_CHIP_COL_10 |
348 			DMC_MEMCONFIGX_CHIP_ROW_15 |
349 			DMC_MEMCONFIGX_CHIP_BANK_8,
350 		.membaseconfig0 = DMC_MEMBASECONFIG_VAL(0x40),
351 		.membaseconfig1 = DMC_MEMBASECONFIG_VAL(0x80),
352 		.prechconfig_tp_cnt = 0xff,
353 		.dpwrdn_cyc = 0xff,
354 		.dsref_cyc = 0xffff,
355 		.concontrol = DMC_CONCONTROL_DFI_INIT_START_DISABLE |
356 			DMC_CONCONTROL_TIMEOUT_LEVEL0 |
357 			DMC_CONCONTROL_RD_FETCH_DISABLE |
358 			DMC_CONCONTROL_EMPTY_DISABLE |
359 			DMC_CONCONTROL_AREF_EN_DISABLE |
360 			DMC_CONCONTROL_IO_PD_CON_DISABLE,
361 		.dmc_channels = 2,
362 		.chips_per_channel = 2,
363 		.chips_to_configure = 1,
364 		.send_zq_init = 1,
365 		.impedance = IMP_OUTPUT_DRV_30_OHM,
366 		.gate_leveling_enable = 0,
367 	}, {
368 		.mem_manuf = MEM_MANUF_SAMSUNG,
369 		.mem_type = DDR_MODE_DDR3,
370 		.frequency_mhz = 800,
371 		.mpll_mdiv = 0xc8,
372 		.mpll_pdiv = 0x3,
373 		.mpll_sdiv = 0x0,
374 		.cpll_mdiv = 0xde,
375 		.cpll_pdiv = 0x4,
376 		.cpll_sdiv = 0x2,
377 		.gpll_mdiv = 0x215,
378 		.gpll_pdiv = 0xc,
379 		.gpll_sdiv = 0x1,
380 		.epll_mdiv = 0x60,
381 		.epll_pdiv = 0x3,
382 		.epll_sdiv = 0x3,
383 		.vpll_mdiv = 0x96,
384 		.vpll_pdiv = 0x3,
385 		.vpll_sdiv = 0x2,
386 
387 		.bpll_mdiv = 0x64,
388 		.bpll_pdiv = 0x3,
389 		.bpll_sdiv = 0x0,
390 		.pclk_cdrex_ratio = 0x5,
391 		.direct_cmd_msr = {
392 			0x00020018, 0x00030000, 0x00010000, 0x00000d70
393 		},
394 		.timing_ref = 0x000000bb,
395 		.timing_row = 0x8c36650e,
396 		.timing_data = 0x3630580b,
397 		.timing_power = 0x41000a44,
398 		.phy0_dqs = 0x08080808,
399 		.phy1_dqs = 0x08080808,
400 		.phy0_dq = 0x08080808,
401 		.phy1_dq = 0x08080808,
402 		.phy0_tFS = 0x8,
403 		.phy1_tFS = 0x8,
404 		.phy0_pulld_dqs = 0xf,
405 		.phy1_pulld_dqs = 0xf,
406 
407 		.lpddr3_ctrl_phy_reset = 0x1,
408 		.ctrl_start_point = 0x10,
409 		.ctrl_inc = 0x10,
410 		.ctrl_start = 0x1,
411 		.ctrl_dll_on = 0x1,
412 		.ctrl_ref = 0x8,
413 
414 		.ctrl_force = 0x1a,
415 		.ctrl_rdlat = 0x0b,
416 		.ctrl_bstlen = 0x08,
417 
418 		.fp_resync = 0x8,
419 		.iv_size = 0x7,
420 		.dfi_init_start = 1,
421 		.aref_en = 1,
422 
423 		.rd_fetch = 0x3,
424 
425 		.zq_mode_dds = 0x5,
426 		.zq_mode_term = 0x1,
427 		.zq_mode_noterm = 1,
428 
429 		/*
430 		* Dynamic Clock: Always Running
431 		* Memory Burst length: 8
432 		* Number of chips: 1
433 		* Memory Bus width: 32 bit
434 		* Memory Type: DDR3
435 		* Additional Latancy for PLL: 0 Cycle
436 		*/
437 		.memcontrol = DMC_MEMCONTROL_CLK_STOP_DISABLE |
438 			DMC_MEMCONTROL_DPWRDN_DISABLE |
439 			DMC_MEMCONTROL_DPWRDN_ACTIVE_PRECHARGE |
440 			DMC_MEMCONTROL_TP_DISABLE |
441 			DMC_MEMCONTROL_DSREF_ENABLE |
442 			DMC_MEMCONTROL_ADD_LAT_PALL_CYCLE(0) |
443 			DMC_MEMCONTROL_MEM_TYPE_DDR3 |
444 			DMC_MEMCONTROL_MEM_WIDTH_32BIT |
445 			DMC_MEMCONTROL_NUM_CHIP_1 |
446 			DMC_MEMCONTROL_BL_8 |
447 			DMC_MEMCONTROL_PZQ_DISABLE |
448 			DMC_MEMCONTROL_MRR_BYTE_7_0,
449 		.memconfig = DMC_MEMCONFIGX_CHIP_MAP_INTERLEAVED |
450 			DMC_MEMCONFIGX_CHIP_COL_10 |
451 			DMC_MEMCONFIGX_CHIP_ROW_15 |
452 			DMC_MEMCONFIGX_CHIP_BANK_8,
453 		.membaseconfig0 = DMC_MEMBASECONFIG_VAL(0x40),
454 		.membaseconfig1 = DMC_MEMBASECONFIG_VAL(0x80),
455 		.prechconfig_tp_cnt = 0xff,
456 		.dpwrdn_cyc = 0xff,
457 		.dsref_cyc = 0xffff,
458 		.concontrol = DMC_CONCONTROL_DFI_INIT_START_DISABLE |
459 			DMC_CONCONTROL_TIMEOUT_LEVEL0 |
460 			DMC_CONCONTROL_RD_FETCH_DISABLE |
461 			DMC_CONCONTROL_EMPTY_DISABLE |
462 			DMC_CONCONTROL_AREF_EN_DISABLE |
463 			DMC_CONCONTROL_IO_PD_CON_DISABLE,
464 		.dmc_channels = 2,
465 		.chips_per_channel = 2,
466 		.chips_to_configure = 1,
467 		.send_zq_init = 1,
468 		.impedance = IMP_OUTPUT_DRV_40_OHM,
469 		.gate_leveling_enable = 1,
470 	}
471 #endif
472 };
473 
474 /**
475  * Get the required memory type and speed (SPL version).
476  *
477  * In SPL we have no device tree, so we use the machine parameters
478  *
479  * @param mem_type	Returns memory type
480  * @param frequency_mhz	Returns memory speed in MHz
481  * @param arm_freq	Returns ARM clock speed in MHz
482  * @param mem_manuf	Return Memory Manufacturer name
483  */
484 static void clock_get_mem_selection(enum ddr_mode *mem_type,
485 		unsigned *frequency_mhz, unsigned *arm_freq,
486 		enum mem_manuf *mem_manuf)
487 {
488 	struct spl_machine_param *params;
489 
490 	params = spl_get_machine_params();
491 	*mem_type = params->mem_type;
492 	*frequency_mhz = params->frequency_mhz;
493 	*arm_freq = params->arm_freq_mhz;
494 	*mem_manuf = params->mem_manuf;
495 }
496 
497 /* Get the ratios for setting ARM clock */
498 struct arm_clk_ratios *get_arm_ratios(void)
499 {
500 	struct arm_clk_ratios *arm_ratio;
501 	enum ddr_mode mem_type;
502 	enum mem_manuf mem_manuf;
503 	unsigned frequency_mhz, arm_freq;
504 	int i;
505 
506 	clock_get_mem_selection(&mem_type, &frequency_mhz,
507 				&arm_freq, &mem_manuf);
508 
509 	for (i = 0, arm_ratio = arm_clk_ratios; i < ARRAY_SIZE(arm_clk_ratios);
510 		i++, arm_ratio++) {
511 		if (arm_ratio->arm_freq_mhz == arm_freq)
512 			return arm_ratio;
513 	}
514 
515 	/* will hang if failed to find clock ratio */
516 	while (1)
517 		;
518 
519 	return NULL;
520 }
521 
522 struct mem_timings *clock_get_mem_timings(void)
523 {
524 	struct mem_timings *mem;
525 	enum ddr_mode mem_type;
526 	enum mem_manuf mem_manuf;
527 	unsigned frequency_mhz, arm_freq;
528 	int i;
529 
530 	clock_get_mem_selection(&mem_type, &frequency_mhz,
531 				&arm_freq, &mem_manuf);
532 	for (i = 0, mem = mem_timings; i < ARRAY_SIZE(mem_timings);
533 	     i++, mem++) {
534 		if (mem->mem_type == mem_type &&
535 		    mem->frequency_mhz == frequency_mhz &&
536 		    mem->mem_manuf == mem_manuf)
537 			return mem;
538 	}
539 
540 	/* will hang if failed to find memory timings */
541 	while (1)
542 		;
543 
544 	return NULL;
545 }
546 
547 static void exynos5250_system_clock_init(void)
548 {
549 	struct exynos5_clock *clk =
550 		(struct exynos5_clock *)samsung_get_base_clock();
551 	struct mem_timings *mem;
552 	struct arm_clk_ratios *arm_clk_ratio;
553 	u32 val, tmp;
554 
555 	mem = clock_get_mem_timings();
556 	arm_clk_ratio = get_arm_ratios();
557 
558 	clrbits_le32(&clk->src_cpu, MUX_APLL_SEL_MASK);
559 	do {
560 		val = readl(&clk->mux_stat_cpu);
561 	} while ((val | MUX_APLL_SEL_MASK) != val);
562 
563 	clrbits_le32(&clk->src_core1, MUX_MPLL_SEL_MASK);
564 	do {
565 		val = readl(&clk->mux_stat_core1);
566 	} while ((val | MUX_MPLL_SEL_MASK) != val);
567 
568 	clrbits_le32(&clk->src_top2, MUX_CPLL_SEL_MASK);
569 	clrbits_le32(&clk->src_top2, MUX_EPLL_SEL_MASK);
570 	clrbits_le32(&clk->src_top2, MUX_VPLL_SEL_MASK);
571 	clrbits_le32(&clk->src_top2, MUX_GPLL_SEL_MASK);
572 	tmp = MUX_CPLL_SEL_MASK | MUX_EPLL_SEL_MASK | MUX_VPLL_SEL_MASK
573 		| MUX_GPLL_SEL_MASK;
574 	do {
575 		val = readl(&clk->mux_stat_top2);
576 	} while ((val | tmp) != val);
577 
578 	clrbits_le32(&clk->src_cdrex, MUX_BPLL_SEL_MASK);
579 	do {
580 		val = readl(&clk->mux_stat_cdrex);
581 	} while ((val | MUX_BPLL_SEL_MASK) != val);
582 
583 	/* PLL locktime */
584 	writel(mem->apll_pdiv * PLL_LOCK_FACTOR, &clk->apll_lock);
585 	writel(mem->mpll_pdiv * PLL_LOCK_FACTOR, &clk->mpll_lock);
586 	writel(mem->bpll_pdiv * PLL_LOCK_FACTOR, &clk->bpll_lock);
587 	writel(mem->cpll_pdiv * PLL_LOCK_FACTOR, &clk->cpll_lock);
588 	writel(mem->gpll_pdiv * PLL_X_LOCK_FACTOR, &clk->gpll_lock);
589 	writel(mem->epll_pdiv * PLL_X_LOCK_FACTOR, &clk->epll_lock);
590 	writel(mem->vpll_pdiv * PLL_X_LOCK_FACTOR, &clk->vpll_lock);
591 
592 	writel(CLK_REG_DISABLE, &clk->pll_div2_sel);
593 
594 	writel(MUX_HPM_SEL_MASK, &clk->src_cpu);
595 	do {
596 		val = readl(&clk->mux_stat_cpu);
597 	} while ((val | HPM_SEL_SCLK_MPLL) != val);
598 
599 	val = arm_clk_ratio->arm2_ratio << 28
600 		| arm_clk_ratio->apll_ratio << 24
601 		| arm_clk_ratio->pclk_dbg_ratio << 20
602 		| arm_clk_ratio->atb_ratio << 16
603 		| arm_clk_ratio->periph_ratio << 12
604 		| arm_clk_ratio->acp_ratio << 8
605 		| arm_clk_ratio->cpud_ratio << 4
606 		| arm_clk_ratio->arm_ratio;
607 	writel(val, &clk->div_cpu0);
608 	do {
609 		val = readl(&clk->div_stat_cpu0);
610 	} while (0 != val);
611 
612 	writel(CLK_DIV_CPU1_VAL, &clk->div_cpu1);
613 	do {
614 		val = readl(&clk->div_stat_cpu1);
615 	} while (0 != val);
616 
617 	/* Set APLL */
618 	writel(APLL_CON1_VAL, &clk->apll_con1);
619 	val = set_pll(arm_clk_ratio->apll_mdiv, arm_clk_ratio->apll_pdiv,
620 			arm_clk_ratio->apll_sdiv);
621 	writel(val, &clk->apll_con0);
622 	while ((readl(&clk->apll_con0) & APLL_CON0_LOCKED) == 0)
623 		;
624 
625 	/* Set MPLL */
626 	writel(MPLL_CON1_VAL, &clk->mpll_con1);
627 	val = set_pll(mem->mpll_mdiv, mem->mpll_pdiv, mem->mpll_sdiv);
628 	writel(val, &clk->mpll_con0);
629 	while ((readl(&clk->mpll_con0) & MPLL_CON0_LOCKED) == 0)
630 		;
631 
632 	/* Set BPLL */
633 	writel(BPLL_CON1_VAL, &clk->bpll_con1);
634 	val = set_pll(mem->bpll_mdiv, mem->bpll_pdiv, mem->bpll_sdiv);
635 	writel(val, &clk->bpll_con0);
636 	while ((readl(&clk->bpll_con0) & BPLL_CON0_LOCKED) == 0)
637 		;
638 
639 	/* Set CPLL */
640 	writel(CPLL_CON1_VAL, &clk->cpll_con1);
641 	val = set_pll(mem->cpll_mdiv, mem->cpll_pdiv, mem->cpll_sdiv);
642 	writel(val, &clk->cpll_con0);
643 	while ((readl(&clk->cpll_con0) & CPLL_CON0_LOCKED) == 0)
644 		;
645 
646 	/* Set GPLL */
647 	writel(GPLL_CON1_VAL, &clk->gpll_con1);
648 	val = set_pll(mem->gpll_mdiv, mem->gpll_pdiv, mem->gpll_sdiv);
649 	writel(val, &clk->gpll_con0);
650 	while ((readl(&clk->gpll_con0) & GPLL_CON0_LOCKED) == 0)
651 		;
652 
653 	/* Set EPLL */
654 	writel(EPLL_CON2_VAL, &clk->epll_con2);
655 	writel(EPLL_CON1_VAL, &clk->epll_con1);
656 	val = set_pll(mem->epll_mdiv, mem->epll_pdiv, mem->epll_sdiv);
657 	writel(val, &clk->epll_con0);
658 	while ((readl(&clk->epll_con0) & EPLL_CON0_LOCKED) == 0)
659 		;
660 
661 	/* Set VPLL */
662 	writel(VPLL_CON2_VAL, &clk->vpll_con2);
663 	writel(VPLL_CON1_VAL, &clk->vpll_con1);
664 	val = set_pll(mem->vpll_mdiv, mem->vpll_pdiv, mem->vpll_sdiv);
665 	writel(val, &clk->vpll_con0);
666 	while ((readl(&clk->vpll_con0) & VPLL_CON0_LOCKED) == 0)
667 		;
668 
669 	writel(CLK_SRC_CORE0_VAL, &clk->src_core0);
670 	writel(CLK_DIV_CORE0_VAL, &clk->div_core0);
671 	while (readl(&clk->div_stat_core0) != 0)
672 		;
673 
674 	writel(CLK_DIV_CORE1_VAL, &clk->div_core1);
675 	while (readl(&clk->div_stat_core1) != 0)
676 		;
677 
678 	writel(CLK_DIV_SYSRGT_VAL, &clk->div_sysrgt);
679 	while (readl(&clk->div_stat_sysrgt) != 0)
680 		;
681 
682 	writel(CLK_DIV_ACP_VAL, &clk->div_acp);
683 	while (readl(&clk->div_stat_acp) != 0)
684 		;
685 
686 	writel(CLK_DIV_SYSLFT_VAL, &clk->div_syslft);
687 	while (readl(&clk->div_stat_syslft) != 0)
688 		;
689 
690 	writel(CLK_SRC_TOP0_VAL, &clk->src_top0);
691 	writel(CLK_SRC_TOP1_VAL, &clk->src_top1);
692 	writel(TOP2_VAL, &clk->src_top2);
693 	writel(CLK_SRC_TOP3_VAL, &clk->src_top3);
694 
695 	writel(CLK_DIV_TOP0_VAL, &clk->div_top0);
696 	while (readl(&clk->div_stat_top0))
697 		;
698 
699 	writel(CLK_DIV_TOP1_VAL, &clk->div_top1);
700 	while (readl(&clk->div_stat_top1))
701 		;
702 
703 	writel(CLK_SRC_LEX_VAL, &clk->src_lex);
704 	while (1) {
705 		val = readl(&clk->mux_stat_lex);
706 		if (val == (val | 1))
707 			break;
708 	}
709 
710 	writel(CLK_DIV_LEX_VAL, &clk->div_lex);
711 	while (readl(&clk->div_stat_lex))
712 		;
713 
714 	writel(CLK_DIV_R0X_VAL, &clk->div_r0x);
715 	while (readl(&clk->div_stat_r0x))
716 		;
717 
718 	writel(CLK_DIV_R0X_VAL, &clk->div_r0x);
719 	while (readl(&clk->div_stat_r0x))
720 		;
721 
722 	writel(CLK_DIV_R1X_VAL, &clk->div_r1x);
723 	while (readl(&clk->div_stat_r1x))
724 		;
725 
726 	writel(CLK_REG_DISABLE, &clk->src_cdrex);
727 
728 	writel(CLK_DIV_CDREX_VAL, &clk->div_cdrex);
729 	while (readl(&clk->div_stat_cdrex))
730 		;
731 
732 	val = readl(&clk->src_cpu);
733 	val |= CLK_SRC_CPU_VAL;
734 	writel(val, &clk->src_cpu);
735 
736 	val = readl(&clk->src_top2);
737 	val |= CLK_SRC_TOP2_VAL;
738 	writel(val, &clk->src_top2);
739 
740 	val = readl(&clk->src_core1);
741 	val |= CLK_SRC_CORE1_VAL;
742 	writel(val, &clk->src_core1);
743 
744 	writel(CLK_SRC_FSYS0_VAL, &clk->src_fsys);
745 	writel(CLK_DIV_FSYS0_VAL, &clk->div_fsys0);
746 	while (readl(&clk->div_stat_fsys0))
747 		;
748 
749 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_cpu);
750 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_core);
751 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_acp);
752 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_top);
753 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_lex);
754 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_r0x);
755 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_r1x);
756 	writel(CLK_REG_DISABLE, &clk->clkout_cmu_cdrex);
757 
758 	writel(CLK_SRC_PERIC0_VAL, &clk->src_peric0);
759 	writel(CLK_DIV_PERIC0_VAL, &clk->div_peric0);
760 
761 	writel(CLK_SRC_PERIC1_VAL, &clk->src_peric1);
762 	writel(CLK_DIV_PERIC1_VAL, &clk->div_peric1);
763 	writel(CLK_DIV_PERIC2_VAL, &clk->div_peric2);
764 	writel(CLK_DIV_PERIC3_VAL, &clk->div_peric3);
765 
766 	writel(SCLK_SRC_ISP_VAL, &clk->sclk_src_isp);
767 	writel(SCLK_DIV_ISP_VAL, &clk->sclk_div_isp);
768 	writel(CLK_DIV_ISP0_VAL, &clk->div_isp0);
769 	writel(CLK_DIV_ISP1_VAL, &clk->div_isp1);
770 	writel(CLK_DIV_ISP2_VAL, &clk->div_isp2);
771 
772 	/* FIMD1 SRC CLK SELECTION */
773 	writel(CLK_SRC_DISP1_0_VAL, &clk->src_disp1_0);
774 
775 	val = MMC2_PRE_RATIO_VAL << MMC2_PRE_RATIO_OFFSET
776 		| MMC2_RATIO_VAL << MMC2_RATIO_OFFSET
777 		| MMC3_PRE_RATIO_VAL << MMC3_PRE_RATIO_OFFSET
778 		| MMC3_RATIO_VAL << MMC3_RATIO_OFFSET;
779 	writel(val, &clk->div_fsys2);
780 }
781 
782 static void exynos5420_system_clock_init(void)
783 {
784 	struct exynos5420_clock *clk =
785 		(struct exynos5420_clock *)samsung_get_base_clock();
786 	struct mem_timings *mem;
787 	struct arm_clk_ratios *arm_clk_ratio;
788 	u32 val;
789 
790 	mem = clock_get_mem_timings();
791 	arm_clk_ratio = get_arm_ratios();
792 
793 	/* PLL locktime */
794 	writel(arm_clk_ratio->apll_pdiv * PLL_LOCK_FACTOR, &clk->apll_lock);
795 	writel(mem->mpll_pdiv * PLL_LOCK_FACTOR, &clk->mpll_lock);
796 	writel(mem->bpll_pdiv * PLL_LOCK_FACTOR, &clk->bpll_lock);
797 	writel(mem->cpll_pdiv * PLL_LOCK_FACTOR, &clk->cpll_lock);
798 	writel(mem->dpll_pdiv * PLL_LOCK_FACTOR, &clk->dpll_lock);
799 	writel(mem->epll_pdiv * PLL_X_LOCK_FACTOR, &clk->epll_lock);
800 	writel(mem->vpll_pdiv * PLL_LOCK_FACTOR, &clk->vpll_lock);
801 	writel(mem->ipll_pdiv * PLL_LOCK_FACTOR, &clk->ipll_lock);
802 	writel(mem->spll_pdiv * PLL_LOCK_FACTOR, &clk->spll_lock);
803 	writel(mem->kpll_pdiv * PLL_LOCK_FACTOR, &clk->kpll_lock);
804 	writel(mem->rpll_pdiv * PLL_X_LOCK_FACTOR, &clk->rpll_lock);
805 
806 	setbits_le32(&clk->src_cpu, MUX_HPM_SEL_MASK);
807 
808 	writel(0, &clk->src_top6);
809 
810 	writel(0, &clk->src_cdrex);
811 	writel(SRC_KFC_HPM_SEL, &clk->src_kfc);
812 	writel(HPM_RATIO,  &clk->div_cpu1);
813 	writel(CLK_DIV_CPU0_VAL,  &clk->div_cpu0);
814 
815 	/* switch A15 clock source to OSC clock before changing APLL */
816 	clrbits_le32(&clk->src_cpu, APLL_FOUT);
817 
818 	/* Set APLL */
819 	writel(APLL_CON1_VAL, &clk->apll_con1);
820 	val = set_pll(arm_clk_ratio->apll_mdiv,
821 		      arm_clk_ratio->apll_pdiv,
822 		      arm_clk_ratio->apll_sdiv);
823 	writel(val, &clk->apll_con0);
824 	while ((readl(&clk->apll_con0) & PLL_LOCKED) == 0)
825 		;
826 
827 	/* now it is safe to switch to APLL */
828 	setbits_le32(&clk->src_cpu, APLL_FOUT);
829 
830 	writel(SRC_KFC_HPM_SEL, &clk->src_kfc);
831 	writel(CLK_DIV_KFC_VAL, &clk->div_kfc0);
832 
833 	/* switch A7 clock source to OSC clock before changing KPLL */
834 	clrbits_le32(&clk->src_kfc, KPLL_FOUT);
835 
836 	/* Set KPLL*/
837 	writel(KPLL_CON1_VAL, &clk->kpll_con1);
838 	val = set_pll(mem->kpll_mdiv, mem->kpll_pdiv, mem->kpll_sdiv);
839 	writel(val, &clk->kpll_con0);
840 	while ((readl(&clk->kpll_con0) & PLL_LOCKED) == 0)
841 		;
842 
843 	/* now it is safe to switch to KPLL */
844 	setbits_le32(&clk->src_kfc, KPLL_FOUT);
845 
846 	/* Set MPLL */
847 	writel(MPLL_CON1_VAL, &clk->mpll_con1);
848 	val = set_pll(mem->mpll_mdiv, mem->mpll_pdiv, mem->mpll_sdiv);
849 	writel(val, &clk->mpll_con0);
850 	while ((readl(&clk->mpll_con0) & PLL_LOCKED) == 0)
851 		;
852 
853 	/* Set DPLL */
854 	writel(DPLL_CON1_VAL, &clk->dpll_con1);
855 	val = set_pll(mem->dpll_mdiv, mem->dpll_pdiv, mem->dpll_sdiv);
856 	writel(val, &clk->dpll_con0);
857 	while ((readl(&clk->dpll_con0) & PLL_LOCKED) == 0)
858 		;
859 
860 	/* Set EPLL */
861 	writel(EPLL_CON2_VAL, &clk->epll_con2);
862 	writel(EPLL_CON1_VAL, &clk->epll_con1);
863 	val = set_pll(mem->epll_mdiv, mem->epll_pdiv, mem->epll_sdiv);
864 	writel(val, &clk->epll_con0);
865 	while ((readl(&clk->epll_con0) & PLL_LOCKED) == 0)
866 		;
867 
868 	/* Set CPLL */
869 	writel(CPLL_CON1_VAL, &clk->cpll_con1);
870 	val = set_pll(mem->cpll_mdiv, mem->cpll_pdiv, mem->cpll_sdiv);
871 	writel(val, &clk->cpll_con0);
872 	while ((readl(&clk->cpll_con0) & PLL_LOCKED) == 0)
873 		;
874 
875 	/* Set IPLL */
876 	writel(IPLL_CON1_VAL, &clk->ipll_con1);
877 	val = set_pll(mem->ipll_mdiv, mem->ipll_pdiv, mem->ipll_sdiv);
878 	writel(val, &clk->ipll_con0);
879 	while ((readl(&clk->ipll_con0) & PLL_LOCKED) == 0)
880 		;
881 
882 	/* Set VPLL */
883 	writel(VPLL_CON1_VAL, &clk->vpll_con1);
884 	val = set_pll(mem->vpll_mdiv, mem->vpll_pdiv, mem->vpll_sdiv);
885 	writel(val, &clk->vpll_con0);
886 	while ((readl(&clk->vpll_con0) & PLL_LOCKED) == 0)
887 		;
888 
889 	/* Set BPLL */
890 	writel(BPLL_CON1_VAL, &clk->bpll_con1);
891 	val = set_pll(mem->bpll_mdiv, mem->bpll_pdiv, mem->bpll_sdiv);
892 	writel(val, &clk->bpll_con0);
893 	while ((readl(&clk->bpll_con0) & PLL_LOCKED) == 0)
894 		;
895 
896 	/* Set SPLL */
897 	writel(SPLL_CON1_VAL, &clk->spll_con1);
898 	val = set_pll(mem->spll_mdiv, mem->spll_pdiv, mem->spll_sdiv);
899 	writel(val, &clk->spll_con0);
900 	while ((readl(&clk->spll_con0) & PLL_LOCKED) == 0)
901 		;
902 
903 	/* Set RPLL */
904 	writel(RPLL_CON2_VAL, &clk->rpll_con2);
905 	writel(RPLL_CON1_VAL, &clk->rpll_con1);
906 	val = set_pll(mem->rpll_mdiv, mem->rpll_pdiv, mem->rpll_sdiv);
907 	writel(val, &clk->rpll_con0);
908 	while ((readl(&clk->rpll_con0) & PLL_LOCKED) == 0)
909 		;
910 
911 	writel(CLK_DIV_CDREX0_VAL, &clk->div_cdrex0);
912 	writel(CLK_DIV_CDREX1_VAL, &clk->div_cdrex1);
913 
914 	writel(CLK_SRC_TOP0_VAL, &clk->src_top0);
915 	writel(CLK_SRC_TOP1_VAL, &clk->src_top1);
916 	writel(CLK_SRC_TOP2_VAL, &clk->src_top2);
917 	writel(CLK_SRC_TOP7_VAL, &clk->src_top7);
918 
919 	writel(CLK_DIV_TOP0_VAL, &clk->div_top0);
920 	writel(CLK_DIV_TOP1_VAL, &clk->div_top1);
921 	writel(CLK_DIV_TOP2_VAL, &clk->div_top2);
922 
923 	writel(0, &clk->src_top10);
924 	writel(0, &clk->src_top11);
925 	writel(0, &clk->src_top12);
926 
927 	writel(CLK_SRC_TOP3_VAL, &clk->src_top3);
928 	writel(CLK_SRC_TOP4_VAL, &clk->src_top4);
929 	writel(CLK_SRC_TOP5_VAL, &clk->src_top5);
930 
931 	/* DISP1 BLK CLK SELECTION */
932 	writel(CLK_SRC_DISP1_0_VAL, &clk->src_disp10);
933 	writel(CLK_DIV_DISP1_0_VAL, &clk->div_disp10);
934 
935 	/* AUDIO BLK */
936 	writel(AUDIO0_SEL_EPLL, &clk->src_mau);
937 	writel(DIV_MAU_VAL, &clk->div_mau);
938 
939 	/* FSYS */
940 	writel(CLK_SRC_FSYS0_VAL, &clk->src_fsys);
941 	writel(CLK_DIV_FSYS0_VAL, &clk->div_fsys0);
942 	writel(CLK_DIV_FSYS1_VAL, &clk->div_fsys1);
943 	writel(CLK_DIV_FSYS2_VAL, &clk->div_fsys2);
944 
945 	writel(CLK_SRC_ISP_VAL, &clk->src_isp);
946 	writel(CLK_DIV_ISP0_VAL, &clk->div_isp0);
947 	writel(CLK_DIV_ISP1_VAL, &clk->div_isp1);
948 
949 	writel(CLK_SRC_PERIC0_VAL, &clk->src_peric0);
950 	writel(CLK_SRC_PERIC1_VAL, &clk->src_peric1);
951 
952 	writel(CLK_DIV_PERIC0_VAL, &clk->div_peric0);
953 	writel(CLK_DIV_PERIC1_VAL, &clk->div_peric1);
954 	writel(CLK_DIV_PERIC2_VAL, &clk->div_peric2);
955 	writel(CLK_DIV_PERIC3_VAL, &clk->div_peric3);
956 	writel(CLK_DIV_PERIC4_VAL, &clk->div_peric4);
957 
958 	writel(CLK_DIV_CPERI1_VAL, &clk->div_cperi1);
959 
960 	writel(CLK_DIV2_RATIO, &clk->clkdiv2_ratio);
961 	writel(CLK_DIV4_RATIO, &clk->clkdiv4_ratio);
962 	writel(CLK_DIV_G2D, &clk->div_g2d);
963 
964 	writel(CLK_SRC_TOP6_VAL, &clk->src_top6);
965 	writel(CLK_SRC_CDREX_VAL, &clk->src_cdrex);
966 	writel(CLK_SRC_KFC_VAL, &clk->src_kfc);
967 }
968 
969 void system_clock_init(void)
970 {
971 	if (proid_is_exynos5420() || proid_is_exynos5422())
972 		exynos5420_system_clock_init();
973 	else
974 		exynos5250_system_clock_init();
975 }
976 
977 void clock_init_dp_clock(void)
978 {
979 	struct exynos5_clock *clk =
980 		(struct exynos5_clock *)samsung_get_base_clock();
981 
982 	/* DP clock enable */
983 	setbits_le32(&clk->gate_ip_disp1, CLK_GATE_DP1_ALLOW);
984 
985 	/* We run DP at 267 Mhz */
986 	setbits_le32(&clk->div_disp1_0, CLK_DIV_DISP1_0_FIMD1);
987 }
988 
989 /*
990  * Set clock divisor value for booting from EMMC.
991  * Set DWMMC channel-0 clk div to operate mmc0 device at 50MHz.
992  */
993 void emmc_boot_clk_div_set(void)
994 {
995 	struct exynos5_clock *clk =
996 		(struct exynos5_clock *)samsung_get_base_clock();
997 	unsigned int div_mmc;
998 
999 	div_mmc = readl((unsigned int) &clk->div_fsys1) & ~FSYS1_MMC0_DIV_MASK;
1000 	div_mmc |= FSYS1_MMC0_DIV_VAL;
1001 	writel(div_mmc, (unsigned int) &clk->div_fsys1);
1002 }
1003