1
2
3
4
5
6#include <common.h>
7#include <i2c.h>
8#include <spl.h>
9#include <asm/io.h>
10#include <asm/arch/cpu.h>
11#include <asm/arch/soc.h>
12
13#include "ddr3_hw_training.h"
14
15
16
17
18#define DEBUG_DFS_C(s, d, l) \
19 DEBUG_DFS_S(s); DEBUG_DFS_D(d, l); DEBUG_DFS_S("\n")
20#define DEBUG_DFS_FULL_C(s, d, l) \
21 DEBUG_DFS_FULL_S(s); DEBUG_DFS_FULL_D(d, l); DEBUG_DFS_FULL_S("\n")
22
23#ifdef MV_DEBUG_DFS
24#define DEBUG_DFS_S(s) puts(s)
25#define DEBUG_DFS_D(d, l) printf("%x", d)
26#else
27#define DEBUG_DFS_S(s)
28#define DEBUG_DFS_D(d, l)
29#endif
30
31#ifdef MV_DEBUG_DFS_FULL
32#define DEBUG_DFS_FULL_S(s) puts(s)
33#define DEBUG_DFS_FULL_D(d, l) printf("%x", d)
34#else
35#define DEBUG_DFS_FULL_S(s)
36#define DEBUG_DFS_FULL_D(d, l)
37#endif
38
39#if defined(MV88F672X)
40extern u8 div_ratio[CLK_VCO][CLK_DDR];
41extern void get_target_freq(u32 freq_mode, u32 *ddr_freq, u32 *hclk_ps);
42#else
43extern u16 odt_dynamic[ODT_OPT][MAX_CS];
44extern u8 div_ratio1to1[CLK_CPU][CLK_DDR];
45extern u8 div_ratio2to1[CLK_CPU][CLK_DDR];
46#endif
47extern u16 odt_static[ODT_OPT][MAX_CS];
48
49extern u32 cpu_fab_clk_to_hclk[FAB_OPT][CLK_CPU];
50
51extern u32 ddr3_get_vco_freq(void);
52
53u32 ddr3_get_freq_parameter(u32 target_freq, int ratio_2to1);
54
55#ifdef MV_DEBUG_DFS
56static inline void dfs_reg_write(u32 addr, u32 val)
57{
58 printf("\n write reg 0x%08x = 0x%08x", addr, val);
59 writel(val, INTER_REGS_BASE + addr);
60}
61#else
62static inline void dfs_reg_write(u32 addr, u32 val)
63{
64 writel(val, INTER_REGS_BASE + addr);
65}
66#endif
67
68static void wait_refresh_op_complete(void)
69{
70 u32 reg;
71
72
73 do {
74 reg = reg_read(REG_SDRAM_OPERATION_ADDR) &
75 REG_SDRAM_OPERATION_CMD_RFRS_DONE;
76 } while (reg);
77}
78
79
80
81
82
83
84
85
86u32 ddr3_get_freq_parameter(u32 target_freq, int ratio_2to1)
87{
88 u32 ui_vco_freq, freq_par;
89
90 ui_vco_freq = ddr3_get_vco_freq();
91
92#if defined(MV88F672X)
93 freq_par = div_ratio[ui_vco_freq][target_freq];
94#else
95
96 if (ratio_2to1)
97 freq_par = div_ratio2to1[ui_vco_freq][target_freq];
98 else
99 freq_par = div_ratio1to1[ui_vco_freq][target_freq];
100#endif
101
102 return freq_par;
103}
104
105
106
107
108
109
110
111
112int ddr3_dfs_high_2_low(u32 freq, MV_DRAM_INFO *dram_info)
113{
114#if defined(MV88F78X60) || defined(MV88F672X)
115
116 u32 reg, freq_par, tmp;
117 u32 cs = 0;
118
119 DEBUG_DFS_C("DDR3 - DFS - High To Low - Starting DFS procedure to Frequency - ",
120 freq, 1);
121
122
123 freq_par = ddr3_get_freq_parameter(freq, 0);
124
125#if defined(MV88F672X)
126 u32 hclk;
127 u32 cpu_freq = ddr3_get_cpu_freq();
128 get_target_freq(cpu_freq, &tmp, &hclk);
129#endif
130
131
132 reg = reg_read(REG_DFS_ADDR);
133
134 reg |= (1 << REG_DFS_DLLNEXTSTATE_OFFS);
135 dfs_reg_write(REG_DFS_ADDR, reg);
136
137
138
139
140
141 reg = reg_read(REG_METAL_MASK_ADDR);
142
143 reg &= ~(1 << REG_METAL_MASK_RETRY_OFFS);
144
145 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
146
147
148 reg = reg_read(REG_DFS_ADDR);
149 reg |= (1 << REG_DFS_BLOCK_OFFS);
150 dfs_reg_write(REG_DFS_ADDR, reg);
151
152
153 if (dram_info->reg_dimm) {
154
155
156
157
158 reg = (0x9 & REG_SDRAM_OPERATION_CWA_RC_MASK) <<
159 REG_SDRAM_OPERATION_CWA_RC_OFFS;
160
161
162
163
164 reg |= ((0 & REG_SDRAM_OPERATION_CWA_DATA_MASK) <<
165 REG_SDRAM_OPERATION_CWA_DATA_OFFS);
166
167
168
169
170
171 reg |= (0 << REG_SDRAM_OPERATION_CWA_DELAY_SEL_OFFS);
172
173
174 reg |= (REG_SDRAM_OPERATION_CMD_CWA &
175 ~(0xF << REG_SDRAM_OPERATION_CS_OFFS));
176
177
178 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
179
180
181 do {
182 reg = reg_read(REG_SDRAM_OPERATION_ADDR) &
183 (REG_SDRAM_OPERATION_CMD_MASK);
184 } while (reg);
185
186
187 reg = reg_read(REG_REGISTERED_DRAM_CTRL_ADDR);
188
189 reg &= ~(1 << REG_REGISTERED_DRAM_CTRL_SR_FLOAT_OFFS);
190
191 dfs_reg_write(REG_REGISTERED_DRAM_CTRL_ADDR, reg);
192 }
193
194
195 for (cs = 0; cs < MAX_CS; cs++) {
196 if (dram_info->cs_ena & (1 << cs)) {
197 reg = reg_read(REG_DDR3_MR1_CS_ADDR +
198 (cs << MR_CS_ADDR_OFFS));
199 reg &= REG_DDR3_MR1_RTT_MASK;
200 dfs_reg_write(REG_DDR3_MR1_CS_ADDR +
201 (cs << MR_CS_ADDR_OFFS), reg);
202 }
203 }
204
205
206 reg = reg_read(REG_DFS_ADDR);
207 reg |= (1 << REG_DFS_SR_OFFS);
208 dfs_reg_write(REG_DFS_ADDR, reg);
209
210
211 do {
212 reg = ((reg_read(REG_DFS_ADDR)) & (1 << REG_DFS_ATSR_OFFS));
213 } while (reg == 0x0);
214
215
216#if defined(MV88F672X)
217
218
219 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL0);
220 reg &= CPU_PLL_CLOCK_DIVIDER_CNTRL0_MASK;
221
222 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL0, (reg + 0xFF));
223
224
225 reg = reg_read(CPU_PLL_CNTRL0);
226 reg &= CPU_PLL_CNTRL0_RELOAD_SMOOTH_MASK;
227
228 dfs_reg_write(CPU_PLL_CNTRL0,
229 (reg + (2 << CPU_PLL_CNTRL0_RELOAD_SMOOTH_OFFS)));
230
231
232 reg = reg_read(CPU_PLL_CNTRL0);
233 reg &= CPU_PLL_CNTRL0_RELAX_EN_MASK;
234
235 dfs_reg_write(CPU_PLL_CNTRL0,
236 (reg + (2 << CPU_PLL_CNTRL0_RELAX_EN_OFFS)));
237
238
239 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL1);
240
241
242
243
244 reg &= CPU_PLL_CLOCK_DIVIDER_CNTRL1_MASK;
245 reg |= (freq_par << 8);
246 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL1, reg);
247
248
249 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL0);
250 reg &= CPU_PLL_CLOCK_RELOAD_RATIO_MASK;
251
252 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL0,
253 (reg + (1 << CPU_PLL_CLOCK_RELOAD_RATIO_OFFS)));
254
255 udelay(1);
256
257
258 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL0);
259 reg &= CPU_PLL_CLOCK_RELOAD_RATIO_MASK;
260
261 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL0, reg);
262
263 udelay(5);
264
265#else
266
267
268
269
270
271 reg = 0x0000FDFF;
272
273 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
274
275
276
277
278
279 reg = 0x0000FF00;
280
281 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_1_ADDR, reg);
282
283 reg = reg_read(REG_CPU_DIV_CLK_CTRL_2_ADDR) &
284 REG_CPU_DIV_CLK_CTRL_3_FREQ_MASK;
285
286
287 reg |= (freq_par << REG_CPU_DIV_CLK_CTRL_3_FREQ_OFFS);
288
289 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_2_ADDR, reg);
290
291
292
293
294
295
296
297
298 reg = 0x000FFF02;
299 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_4_ADDR, reg);
300
301
302 udelay(1);
303
304
305
306
307
308
309
310
311
312
313 reg = 0x0102FDFF;
314
315 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
316
317 udelay(1);
318
319
320
321
322
323 do {
324 reg = (reg_read(REG_CPU_DIV_CLK_STATUS_0_ADDR)) &
325 (1 << REG_CPU_DIV_CLK_ALL_STABLE_OFFS);
326 } while (reg == 0);
327
328
329
330
331
332 reg = 0x000000FF;
333
334 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
335
336 udelay(5);
337#endif
338
339
340
341 reg = reg_read(REG_DRAM_INIT_CTRL_STATUS_ADDR);
342
343 reg |= (1 << REG_DRAM_INIT_CTRL_TRN_CLK_OFFS);
344
345 dfs_reg_write(REG_DRAM_INIT_CTRL_STATUS_ADDR, reg);
346
347
348
349
350 reg = reg_read(REG_DDR_IO_ADDR) & ~(1 << REG_DDR_IO_CLK_RATIO_OFFS);
351 dfs_reg_write(REG_DDR_IO_ADDR, reg);
352
353
354 reg = reg_read(REG_DUNIT_CTRL_LOW_ADDR);
355
356 reg &= ~(REG_DUNIT_CTRL_LOW_2T_MASK << REG_DUNIT_CTRL_LOW_2T_OFFS);
357
358 dfs_reg_write(REG_DUNIT_CTRL_LOW_ADDR, reg);
359
360
361 reg = reg_read(REG_DFS_ADDR);
362 reg &= ~(REG_DFS_CL_NEXT_STATE_MASK << REG_DFS_CL_NEXT_STATE_OFFS);
363 reg &= ~(REG_DFS_CWL_NEXT_STATE_MASK << REG_DFS_CWL_NEXT_STATE_OFFS);
364
365 reg |= (0x4 << REG_DFS_CL_NEXT_STATE_OFFS);
366
367 reg |= (0x1 << REG_DFS_CWL_NEXT_STATE_OFFS);
368 dfs_reg_write(REG_DFS_ADDR, reg);
369
370
371 do {
372 reg = (reg_read(REG_PHY_LOCK_STATUS_ADDR)) &
373 REG_PHY_LOCK_APLL_ADLL_STATUS_MASK;
374
375 } while (reg != REG_PHY_LOCK_APLL_ADLL_STATUS_MASK);
376
377
378 reg = (reg_read(REG_SDRAM_CONFIG_ADDR) & REG_SDRAM_CONFIG_MASK);
379
380
381 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
382
383
384
385
386
387 reg = (reg_read(REG_SDRAM_CONFIG_ADDR) | ~REG_SDRAM_CONFIG_MASK);
388
389
390 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
391
392
393 if (dram_info->reg_dimm) {
394
395
396
397
398 reg = (0xA & REG_SDRAM_OPERATION_CWA_RC_MASK) <<
399 REG_SDRAM_OPERATION_CWA_RC_OFFS;
400
401
402
403
404
405 reg |= ((0x0 & REG_SDRAM_OPERATION_CWA_DATA_MASK) <<
406 REG_SDRAM_OPERATION_CWA_DATA_OFFS);
407
408
409 reg |= (0x1 << REG_SDRAM_OPERATION_CWA_DELAY_SEL_OFFS);
410
411
412 reg |= (REG_SDRAM_OPERATION_CMD_CWA &
413 ~(0xF << REG_SDRAM_OPERATION_CS_OFFS));
414
415
416 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
417
418
419 do {
420 reg = reg_read(REG_SDRAM_OPERATION_ADDR) &
421 (REG_SDRAM_OPERATION_CMD_MASK);
422 } while (reg);
423 }
424
425
426
427 reg = (reg_read(REG_DFS_ADDR) & ~(1 << REG_DFS_SR_OFFS));
428 dfs_reg_write(REG_DFS_ADDR, reg);
429
430
431
432
433
434 do {
435 reg = ((reg_read(REG_DFS_ADDR)) & (1 << REG_DFS_ATSR_OFFS));
436 } while (reg);
437
438
439
440 reg = REG_SDRAM_OPERATION_CMD_RFRS;
441 for (cs = 0; cs < MAX_CS; cs++) {
442 if (dram_info->cs_ena & (1 << cs))
443 reg &= ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
444 }
445
446
447 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
448
449
450 wait_refresh_op_complete();
451
452
453 reg = reg_read(REG_DFS_ADDR);
454 reg &= ~(1 << REG_DFS_BLOCK_OFFS);
455 dfs_reg_write(REG_DFS_ADDR, reg);
456
457
458
459
460
461 reg = reg_read(REG_METAL_MASK_ADDR);
462
463 reg |= (1 << REG_METAL_MASK_RETRY_OFFS);
464
465 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
466
467 for (cs = 0; cs < MAX_CS; cs++) {
468 if (dram_info->cs_ena & (1 << cs)) {
469
470 reg = reg_read(REG_DDR3_MR0_CS_ADDR +
471 (cs << MR_CS_ADDR_OFFS)) &
472 ~REG_DDR3_MR0_CL_MASK;
473 tmp = 0x4;
474 reg |= ((tmp & 0x1) << REG_DDR3_MR0_CL_OFFS);
475 reg |= ((tmp & 0xE) << REG_DDR3_MR0_CL_HIGH_OFFS);
476 dfs_reg_write(REG_DDR3_MR0_CS_ADDR +
477 (cs << MR_CS_ADDR_OFFS), reg);
478
479
480 reg = reg_read(REG_DDR3_MR2_CS_ADDR +
481 (cs << MR_CS_ADDR_OFFS))
482 & ~(REG_DDR3_MR2_CWL_MASK << REG_DDR3_MR2_CWL_OFFS);
483
484 reg |= ((0x1) << REG_DDR3_MR2_CWL_OFFS);
485 dfs_reg_write(REG_DDR3_MR2_CS_ADDR +
486 (cs << MR_CS_ADDR_OFFS), reg);
487 }
488 }
489
490 DEBUG_DFS_C("DDR3 - DFS - High To Low - Ended successfuly - new Frequency - ",
491 freq, 1);
492
493 return MV_OK;
494#else
495
496
497 u32 reg, freq_par;
498 u32 cs = 0;
499
500 DEBUG_DFS_C("DDR3 - DFS - High To Low - Starting DFS procedure to Frequency - ",
501 freq, 1);
502
503
504 freq_par = ddr3_get_freq_parameter(freq, 0);
505
506 reg = 0x0000FF00;
507
508 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_1_ADDR, reg);
509
510
511 reg = reg_read(REG_ODPG_CNTRL_ADDR);
512
513 reg |= (1 << REG_ODPG_CNTRL_OFFS);
514 dfs_reg_write(REG_ODPG_CNTRL_ADDR, reg);
515
516
517 reg = reg_read(REG_PHY_LOCK_MASK_ADDR);
518 reg &= REG_PHY_LOCK_MASK_MASK;
519 dfs_reg_write(REG_PHY_LOCK_MASK_ADDR, reg);
520
521 reg = reg_read(REG_DFS_ADDR);
522
523
524 reg &= ~0x10;
525 reg |= 0x1;
526
527 dfs_reg_write(REG_DFS_ADDR, reg);
528
529 reg = reg_read(REG_METAL_MASK_ADDR) & ~(1 << 0);
530
531 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
532
533
534 reg = reg_read(REG_DFS_ADDR) | (1 << REG_DFS_BLOCK_OFFS);
535 dfs_reg_write(REG_DFS_ADDR, reg);
536
537
538 reg = reg_read(REG_DFS_ADDR) | (1 << REG_DFS_SR_OFFS);
539 dfs_reg_write(REG_DFS_ADDR, reg);
540
541
542
543
544
545
546 do {
547 reg = reg_read(REG_DFS_ADDR) & (1 << REG_DFS_ATSR_OFFS);
548 } while (reg == 0x0);
549
550
551 dfs_reg_write(REG_SDRAM_ODT_CTRL_HIGH_ADDR,
552 REG_SDRAM_ODT_CTRL_HIGH_OVRD_MASK);
553
554
555 reg = (reg_read(REG_PHY_LOCK_MASK_ADDR) & REG_PHY_LOCK_MASK_MASK);
556
557 dfs_reg_write(REG_PHY_LOCK_MASK_ADDR, reg);
558
559
560 udelay(1);
561
562
563
564
565
566
567 reg = 0x0000FDFF;
568
569 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
570
571
572
573
574 reg = 0x0000FF00;
575
576 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_1_ADDR, reg);
577
578 reg = reg_read(REG_CPU_DIV_CLK_CTRL_3_ADDR) &
579 REG_CPU_DIV_CLK_CTRL_3_FREQ_MASK;
580
581 reg |= (freq_par << REG_CPU_DIV_CLK_CTRL_3_FREQ_OFFS);
582
583 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_3_ADDR, reg);
584
585
586
587
588
589
590
591
592 reg = 0x000FFF02;
593 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_4_ADDR, reg);
594
595
596 udelay(1);
597
598
599
600
601
602
603
604
605
606
607 reg = 0x0102FDFF;
608
609 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
610
611 udelay(1);
612
613
614
615
616
617 do {
618 reg = (reg_read(REG_CPU_DIV_CLK_STATUS_0_ADDR)) &
619 (1 << REG_CPU_DIV_CLK_ALL_STABLE_OFFS);
620 } while (reg == 0);
621
622
623
624
625
626 reg = 0x000000FF;
627
628 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
629
630 udelay(5);
631
632
633 reg = 0x20050000;
634
635 dfs_reg_write(REG_DRAM_INIT_CTRL_STATUS_ADDR, reg);
636
637 reg = reg_read(REG_DDR_IO_ADDR) & ~(1 << REG_DDR_IO_CLK_RATIO_OFFS);
638
639 dfs_reg_write(REG_DDR_IO_ADDR, reg);
640
641 reg = reg_read(REG_DRAM_PHY_CONFIG_ADDR) & REG_DRAM_PHY_CONFIG_MASK;
642
643
644 dfs_reg_write(REG_DRAM_PHY_CONFIG_ADDR, reg);
645
646 reg = (reg_read(REG_DRAM_PHY_CONFIG_ADDR) | ~REG_DRAM_PHY_CONFIG_MASK);
647
648
649 dfs_reg_write(REG_DRAM_PHY_CONFIG_ADDR, reg);
650
651 udelay(1);
652
653
654 reg = (reg_read(REG_DUNIT_CTRL_LOW_ADDR) & 0xFFFFFFE7);
655 dfs_reg_write(REG_DUNIT_CTRL_LOW_ADDR, reg);
656
657
658 do {
659 reg = (reg_read(REG_PHY_LOCK_STATUS_ADDR)) &
660 REG_PHY_LOCK_STATUS_LOCK_MASK;
661 } while (reg != REG_PHY_LOCK_STATUS_LOCK_MASK);
662
663 reg = (reg_read(REG_SDRAM_CONFIG_ADDR) & REG_SDRAM_CONFIG_MASK);
664
665
666 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
667
668 reg = reg_read(REG_SDRAM_CONFIG_ADDR) | ~REG_SDRAM_CONFIG_MASK;
669
670
671 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
672
673 udelay(1000);
674
675 for (cs = 0; cs < MAX_CS; cs++) {
676 if (dram_info->cs_ena & (1 << cs)) {
677
678 wait_refresh_op_complete();
679
680
681 reg = reg_read(REG_DDR3_MR0_ADDR);
682 reg &= ~0x74;
683 reg |= (1 << 5);
684 dfs_reg_write(REG_DDR3_MR0_ADDR, reg);
685 reg = REG_SDRAM_OPERATION_CMD_MR0 &
686 ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
687
688 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
689
690
691 wait_refresh_op_complete();
692
693 reg = reg_read(REG_DDR3_MR2_ADDR);
694 reg &= ~0x38;
695 reg |= (1 << 3);
696 dfs_reg_write(REG_DDR3_MR2_ADDR, reg);
697
698 reg = REG_SDRAM_OPERATION_CMD_MR2 &
699 ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
700
701 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
702
703
704 wait_refresh_op_complete();
705
706
707 reg = reg_read(REG_READ_DATA_SAMPLE_DELAYS_ADDR);
708 reg &= ~(REG_READ_DATA_SAMPLE_DELAYS_MASK <<
709 (REG_READ_DATA_SAMPLE_DELAYS_OFFS * cs));
710 reg |= (5 << (REG_READ_DATA_SAMPLE_DELAYS_OFFS * cs));
711 dfs_reg_write(REG_READ_DATA_SAMPLE_DELAYS_ADDR, reg);
712
713
714 reg = reg_read(REG_READ_DATA_READY_DELAYS_ADDR);
715 reg &= ~(REG_READ_DATA_READY_DELAYS_MASK <<
716 (REG_READ_DATA_READY_DELAYS_OFFS * cs));
717 reg |= ((6) << (REG_READ_DATA_READY_DELAYS_OFFS * cs));
718 dfs_reg_write(REG_READ_DATA_READY_DELAYS_ADDR, reg);
719 }
720 }
721
722
723 reg = reg_read(REG_DFS_ADDR) & ~(1 << REG_DFS_SR_OFFS);
724 dfs_reg_write(REG_DFS_ADDR, reg);
725
726
727 reg = reg_read(REG_DFS_ADDR) & ~(1 << REG_DFS_BLOCK_OFFS);
728 dfs_reg_write(REG_DFS_ADDR, reg);
729
730
731
732
733
734
735 do {
736 reg = reg_read(REG_DFS_ADDR) & (1 << REG_DFS_ATSR_OFFS);
737 } while (reg);
738
739 reg = (reg_read(REG_METAL_MASK_ADDR) | (1 << 0));
740
741
742 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
743
744
745 reg = reg_read(REG_ODPG_CNTRL_ADDR);
746 reg &= ~(1 << REG_ODPG_CNTRL_OFFS);
747 dfs_reg_write(REG_ODPG_CNTRL_ADDR, reg);
748
749
750 reg = reg_read(REG_PHY_LOCK_MASK_ADDR);
751 reg |= ~REG_PHY_LOCK_MASK_MASK;
752 dfs_reg_write(REG_PHY_LOCK_MASK_ADDR, reg);
753
754 DEBUG_DFS_C("DDR3 - DFS - High To Low - Ended successfuly - new Frequency - ",
755 freq, 1);
756
757 return MV_OK;
758#endif
759}
760
761
762
763
764
765
766
767
768int ddr3_dfs_low_2_high(u32 freq, int ratio_2to1, MV_DRAM_INFO *dram_info)
769{
770#if defined(MV88F78X60) || defined(MV88F672X)
771
772 u32 reg, freq_par, tmp;
773 u32 cs = 0;
774
775 DEBUG_DFS_C("DDR3 - DFS - Low To High - Starting DFS procedure to Frequency - ",
776 freq, 1);
777
778
779 freq_par = ddr3_get_freq_parameter(freq, ratio_2to1);
780
781#if defined(MV88F672X)
782 u32 hclk;
783 u32 cpu_freq = ddr3_get_cpu_freq();
784 get_target_freq(cpu_freq, &tmp, &hclk);
785#endif
786
787
788 reg = reg_read(REG_DFS_ADDR);
789
790 reg &= ~(1 << REG_DFS_DLLNEXTSTATE_OFFS);
791 dfs_reg_write(REG_DFS_ADDR, reg);
792
793
794
795
796
797 reg = reg_read(REG_METAL_MASK_ADDR);
798
799 reg &= ~(1 << REG_METAL_MASK_RETRY_OFFS);
800
801 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
802
803
804 reg = reg_read(REG_DFS_ADDR);
805 reg |= (1 << REG_DFS_BLOCK_OFFS);
806 dfs_reg_write(REG_DFS_ADDR, reg);
807
808
809 reg = reg_read(REG_DFS_ADDR);
810 reg |= (1 << REG_DFS_SR_OFFS);
811 dfs_reg_write(REG_DFS_ADDR, reg);
812
813
814 do {
815 reg = ((reg_read(REG_DFS_ADDR)) & (1 << REG_DFS_ATSR_OFFS));
816 } while (reg == 0x0);
817
818
819#if defined(MV88F672X)
820
821
822 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL0);
823 reg &= CPU_PLL_CLOCK_DIVIDER_CNTRL0_MASK;
824
825 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL0, (reg + 0xFF));
826
827
828 reg = reg_read(CPU_PLL_CNTRL0);
829 reg &= CPU_PLL_CNTRL0_RELOAD_SMOOTH_MASK;
830
831 dfs_reg_write(CPU_PLL_CNTRL0,
832 reg + (2 << CPU_PLL_CNTRL0_RELOAD_SMOOTH_OFFS));
833
834
835 reg = reg_read(CPU_PLL_CNTRL0);
836 reg &= CPU_PLL_CNTRL0_RELAX_EN_MASK;
837
838 dfs_reg_write(CPU_PLL_CNTRL0,
839 reg + (2 << CPU_PLL_CNTRL0_RELAX_EN_OFFS));
840
841
842 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL1);
843
844
845
846
847 reg &= CPU_PLL_CLOCK_DIVIDER_CNTRL1_MASK;
848 reg |= (freq_par << 8);
849 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL1, reg);
850
851 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL0);
852 reg &= CPU_PLL_CLOCK_RELOAD_RATIO_MASK;
853
854 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL0,
855 reg + (1 << CPU_PLL_CLOCK_RELOAD_RATIO_OFFS));
856
857 udelay(1);
858
859
860 reg = reg_read(CPU_PLL_CLOCK_DIVIDER_CNTRL0);
861 reg &= CPU_PLL_CLOCK_RELOAD_RATIO_MASK;
862
863 dfs_reg_write(CPU_PLL_CLOCK_DIVIDER_CNTRL0, reg);
864
865 udelay(5);
866
867#else
868
869
870
871
872
873 reg = 0x0000FFFF;
874
875
876 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
877
878
879
880
881 reg = 0x0000FF00;
882
883 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_1_ADDR, reg);
884
885 reg = reg_read(REG_CPU_DIV_CLK_CTRL_2_ADDR) &
886 REG_CPU_DIV_CLK_CTRL_3_FREQ_MASK;
887 reg |= (freq_par << REG_CPU_DIV_CLK_CTRL_3_FREQ_OFFS);
888
889
890 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_2_ADDR, reg);
891
892
893
894
895
896
897 reg = 0x000FFF02;
898 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_4_ADDR, reg);
899
900
901 udelay(1);
902
903 reg = 0x0102FDFF;
904
905
906
907
908
909
910
911
912
913
914 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
915
916 udelay(1);
917
918
919
920
921
922 do {
923 reg = reg_read(REG_CPU_DIV_CLK_STATUS_0_ADDR) &
924 (1 << REG_CPU_DIV_CLK_ALL_STABLE_OFFS);
925 } while (reg == 0);
926
927 reg = 0x000000FF;
928
929
930
931
932
933 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
934#endif
935
936
937 if (ratio_2to1) {
938
939 reg = reg_read(REG_DRAM_INIT_CTRL_STATUS_ADDR);
940
941 reg &= ~(1 << REG_DRAM_INIT_CTRL_TRN_CLK_OFFS);
942
943 dfs_reg_write(REG_DRAM_INIT_CTRL_STATUS_ADDR, reg);
944 }
945
946
947
948
949
950 if (ratio_2to1) {
951
952
953
954
955 reg = reg_read(REG_DDR_IO_ADDR) |
956 (1 << REG_DDR_IO_CLK_RATIO_OFFS);
957 } else {
958
959
960
961
962 reg = reg_read(REG_DDR_IO_ADDR) &
963 ~(1 << REG_DDR_IO_CLK_RATIO_OFFS);
964 }
965 dfs_reg_write(REG_DDR_IO_ADDR, reg);
966
967
968 reg = reg_read(REG_DUNIT_CTRL_LOW_ADDR);
969
970 reg &= ~(REG_DUNIT_CTRL_LOW_2T_MASK << REG_DUNIT_CTRL_LOW_2T_OFFS);
971 reg |= ((dram_info->mode_2t & REG_DUNIT_CTRL_LOW_2T_MASK) <<
972 REG_DUNIT_CTRL_LOW_2T_OFFS);
973
974 dfs_reg_write(REG_DUNIT_CTRL_LOW_ADDR, reg);
975
976
977 reg = reg_read(REG_DFS_ADDR);
978 reg &= ~(REG_DFS_CL_NEXT_STATE_MASK << REG_DFS_CL_NEXT_STATE_OFFS);
979 reg &= ~(REG_DFS_CWL_NEXT_STATE_MASK << REG_DFS_CWL_NEXT_STATE_OFFS);
980
981 if (freq == DDR_400) {
982 if (dram_info->target_frequency == 0x8)
983 tmp = ddr3_cl_to_valid_cl(5);
984 else
985 tmp = ddr3_cl_to_valid_cl(6);
986 } else {
987 tmp = ddr3_cl_to_valid_cl(dram_info->cl);
988 }
989
990
991 reg |= ((tmp & REG_DFS_CL_NEXT_STATE_MASK) << REG_DFS_CL_NEXT_STATE_OFFS);
992 if (freq == DDR_400) {
993
994 reg |= (((0) & REG_DFS_CWL_NEXT_STATE_MASK) <<
995 REG_DFS_CWL_NEXT_STATE_OFFS);
996 } else {
997
998 reg |= (((dram_info->cwl) & REG_DFS_CWL_NEXT_STATE_MASK) <<
999 REG_DFS_CWL_NEXT_STATE_OFFS);
1000 }
1001 dfs_reg_write(REG_DFS_ADDR, reg);
1002
1003
1004 for (cs = 0; cs < MAX_CS; cs++) {
1005 if (dram_info->cs_ena & (1 << cs)) {
1006 reg = reg_read(REG_DDR3_MR1_CS_ADDR +
1007 (cs << MR_CS_ADDR_OFFS));
1008 reg &= REG_DDR3_MR1_RTT_MASK;
1009 reg |= odt_static[dram_info->cs_ena][cs];
1010 dfs_reg_write(REG_DDR3_MR1_CS_ADDR +
1011 (cs << MR_CS_ADDR_OFFS), reg);
1012 }
1013 }
1014
1015
1016 reg = reg_read(REG_DRAM_PHY_CONFIG_ADDR) & REG_DRAM_PHY_CONFIG_MASK;
1017
1018
1019 dfs_reg_write(REG_DRAM_PHY_CONFIG_ADDR, reg);
1020
1021
1022 reg = reg_read(REG_DRAM_PHY_CONFIG_ADDR) | ~REG_DRAM_PHY_CONFIG_MASK;
1023
1024
1025 dfs_reg_write(REG_DRAM_PHY_CONFIG_ADDR, reg);
1026
1027
1028 do {
1029 reg = reg_read(REG_PHY_LOCK_STATUS_ADDR) &
1030 REG_PHY_LOCK_APLL_ADLL_STATUS_MASK;
1031
1032 } while (reg != REG_PHY_LOCK_APLL_ADLL_STATUS_MASK);
1033
1034
1035 if (ratio_2to1) {
1036
1037
1038 reg = reg_read(REG_SDRAM_CONFIG_ADDR) &
1039 ~(1 << REG_SDRAM_CONFIG_PUPRSTDIV_OFFS);
1040
1041 tmp = reg_read(REG_SDRAM_CONFIG_ADDR) |
1042 (1 << REG_SDRAM_CONFIG_PUPRSTDIV_OFFS);
1043
1044 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
1045
1046
1047
1048 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, tmp);
1049 }
1050
1051
1052 reg = reg_read(REG_SDRAM_CONFIG_ADDR) & REG_SDRAM_CONFIG_MASK;
1053
1054
1055 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
1056
1057
1058
1059
1060
1061 reg = reg_read(REG_SDRAM_CONFIG_ADDR) | ~REG_SDRAM_CONFIG_MASK;
1062
1063
1064 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
1065
1066
1067 if (dram_info->reg_dimm) {
1068
1069
1070
1071
1072 reg = (0xA & REG_SDRAM_OPERATION_CWA_RC_MASK) <<
1073 REG_SDRAM_OPERATION_CWA_RC_OFFS;
1074 if (freq <= DDR_400) {
1075
1076
1077
1078
1079 reg |= ((0x0 & REG_SDRAM_OPERATION_CWA_DATA_MASK) <<
1080 REG_SDRAM_OPERATION_CWA_DATA_OFFS);
1081 } else if ((freq > DDR_400) && (freq <= DDR_533)) {
1082
1083
1084
1085
1086 reg |= ((0x1 & REG_SDRAM_OPERATION_CWA_DATA_MASK) <<
1087 REG_SDRAM_OPERATION_CWA_DATA_OFFS);
1088 } else if ((freq > DDR_533) && (freq <= DDR_666)) {
1089
1090
1091
1092
1093 reg |= ((0x2 & REG_SDRAM_OPERATION_CWA_DATA_MASK) <<
1094 REG_SDRAM_OPERATION_CWA_DATA_OFFS);
1095 } else {
1096
1097
1098
1099
1100 reg |= ((0x3 & REG_SDRAM_OPERATION_CWA_DATA_MASK) <<
1101 REG_SDRAM_OPERATION_CWA_DATA_OFFS);
1102 }
1103
1104
1105 reg |= (0x1 << REG_SDRAM_OPERATION_CWA_DELAY_SEL_OFFS);
1106
1107 reg |= (REG_SDRAM_OPERATION_CMD_CWA &
1108 ~(0xF << REG_SDRAM_OPERATION_CS_OFFS));
1109
1110
1111 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
1112
1113
1114 do {
1115 reg = reg_read(REG_SDRAM_OPERATION_ADDR) &
1116 REG_SDRAM_OPERATION_CMD_MASK;
1117 } while (reg);
1118 }
1119
1120
1121
1122 reg = reg_read(REG_DFS_ADDR) & ~(1 << REG_DFS_SR_OFFS);
1123 dfs_reg_write(REG_DFS_ADDR, reg);
1124
1125
1126
1127
1128
1129 do {
1130 reg = reg_read(REG_DFS_ADDR) & (1 << REG_DFS_ATSR_OFFS);
1131 } while (reg);
1132
1133
1134
1135 reg = REG_SDRAM_OPERATION_CMD_RFRS;
1136 for (cs = 0; cs < MAX_CS; cs++) {
1137 if (dram_info->cs_ena & (1 << cs))
1138 reg &= ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
1139 }
1140
1141
1142 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
1143
1144
1145 wait_refresh_op_complete();
1146
1147
1148 reg = reg_read(REG_DFS_ADDR);
1149 reg &= ~(1 << REG_DFS_BLOCK_OFFS);
1150 dfs_reg_write(REG_DFS_ADDR, reg);
1151
1152
1153
1154
1155
1156 reg = reg_read(REG_METAL_MASK_ADDR);
1157
1158 reg |= (1 << REG_METAL_MASK_RETRY_OFFS);
1159
1160 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
1161
1162 for (cs = 0; cs < MAX_CS; cs++) {
1163 if (dram_info->cs_ena & (1 << cs)) {
1164
1165 reg = reg_read(REG_DDR3_MR0_CS_ADDR +
1166 (cs << MR_CS_ADDR_OFFS)) &
1167 ~REG_DDR3_MR0_CL_MASK;
1168 if (freq == DDR_400)
1169 tmp = ddr3_cl_to_valid_cl(6);
1170 else
1171 tmp = ddr3_cl_to_valid_cl(dram_info->cl);
1172 reg |= ((tmp & 0x1) << REG_DDR3_MR0_CL_OFFS);
1173 reg |= ((tmp & 0xE) << REG_DDR3_MR0_CL_HIGH_OFFS);
1174 dfs_reg_write(REG_DDR3_MR0_CS_ADDR +
1175 (cs << MR_CS_ADDR_OFFS), reg);
1176
1177
1178 reg = reg_read(REG_DDR3_MR2_CS_ADDR +
1179 (cs << MR_CS_ADDR_OFFS)) &
1180 ~(REG_DDR3_MR2_CWL_MASK << REG_DDR3_MR2_CWL_OFFS);
1181 if (freq == DDR_400)
1182 reg |= ((0) << REG_DDR3_MR2_CWL_OFFS);
1183 else
1184 reg |= ((dram_info->cwl) << REG_DDR3_MR2_CWL_OFFS);
1185 dfs_reg_write(REG_DDR3_MR2_CS_ADDR +
1186 (cs << MR_CS_ADDR_OFFS), reg);
1187 }
1188 }
1189
1190 DEBUG_DFS_C("DDR3 - DFS - Low To High - Ended successfuly - new Frequency - ",
1191 freq, 1);
1192
1193 return MV_OK;
1194
1195#else
1196
1197
1198
1199 u32 reg, freq_par, tmp;
1200 u32 cs = 0;
1201
1202 DEBUG_DFS_C("DDR3 - DFS - Low To High - Starting DFS procedure to Frequency - ",
1203 freq, 1);
1204
1205
1206 freq_par = ddr3_get_freq_parameter(freq, ratio_2to1);
1207
1208 reg = 0x0000FF00;
1209 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_1_ADDR, reg);
1210
1211
1212 reg = reg_read(REG_ODPG_CNTRL_ADDR);
1213 reg |= (1 << REG_ODPG_CNTRL_OFFS);
1214 dfs_reg_write(REG_ODPG_CNTRL_ADDR, reg);
1215
1216
1217 reg = reg_read(REG_PHY_LOCK_MASK_ADDR);
1218 reg &= REG_PHY_LOCK_MASK_MASK;
1219 dfs_reg_write(REG_PHY_LOCK_MASK_ADDR, reg);
1220
1221
1222 reg = reg_read(REG_DFS_ADDR);
1223
1224 reg &= ~0x11;
1225
1226 dfs_reg_write(REG_DFS_ADDR, reg);
1227
1228
1229
1230 reg = reg_read(REG_METAL_MASK_ADDR) & ~(1 << 0);
1231
1232 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
1233
1234
1235
1236 reg = reg_read(REG_DFS_ADDR) | (1 << REG_DFS_BLOCK_OFFS);
1237 dfs_reg_write(REG_DFS_ADDR, reg);
1238
1239
1240
1241 reg = reg_read(REG_DFS_ADDR) | (1 << REG_DFS_SR_OFFS);
1242 dfs_reg_write(REG_DFS_ADDR, reg);
1243
1244
1245
1246
1247
1248
1249 do {
1250 reg = reg_read(REG_DFS_ADDR) & (1 << REG_DFS_ATSR_OFFS);
1251 } while (reg == 0x0);
1252
1253
1254
1255
1256
1257 if (ratio_2to1) {
1258
1259 reg = reg_read(REG_DDR_IO_ADDR) |
1260 (1 << REG_DDR_IO_CLK_RATIO_OFFS);
1261 } else {
1262
1263 reg = reg_read(REG_DDR_IO_ADDR) &
1264 ~(1 << REG_DDR_IO_CLK_RATIO_OFFS);
1265 }
1266 dfs_reg_write(REG_DDR_IO_ADDR, reg);
1267
1268
1269 reg = 0x20040000;
1270
1271
1272
1273
1274
1275
1276 dfs_reg_write(REG_DRAM_INIT_CTRL_STATUS_ADDR, reg);
1277
1278
1279 udelay(1);
1280
1281
1282
1283
1284
1285
1286 reg = 0x0000FFFF;
1287
1288 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
1289
1290
1291
1292
1293 reg = 0x0000FF00;
1294
1295 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_1_ADDR, reg);
1296
1297 reg = reg_read(REG_CPU_DIV_CLK_CTRL_3_ADDR) &
1298 REG_CPU_DIV_CLK_CTRL_3_FREQ_MASK;
1299 reg |= (freq_par << REG_CPU_DIV_CLK_CTRL_3_FREQ_OFFS);
1300
1301
1302 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_3_ADDR, reg);
1303
1304
1305
1306
1307
1308
1309
1310 reg = 0x000FFF02;
1311
1312 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_4_ADDR, reg);
1313
1314
1315 udelay(1);
1316
1317 reg = 0x0102FDFF;
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
1329
1330 udelay(1);
1331
1332
1333
1334
1335
1336 do {
1337 reg = reg_read(REG_CPU_DIV_CLK_STATUS_0_ADDR) &
1338 (1 << REG_CPU_DIV_CLK_ALL_STABLE_OFFS);
1339 } while (reg == 0);
1340
1341 reg = 0x000000FF;
1342
1343
1344
1345
1346
1347 dfs_reg_write(REG_CPU_DIV_CLK_CTRL_0_ADDR, reg);
1348
1349 udelay(5);
1350
1351 if (ratio_2to1) {
1352
1353
1354 reg = reg_read(REG_SDRAM_CONFIG_ADDR) & ~(1 << 28);
1355
1356 tmp = reg_read(REG_SDRAM_CONFIG_ADDR) | (1 << 28);
1357
1358 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
1359
1360
1361
1362 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, tmp);
1363 }
1364
1365
1366 reg = (reg_read(REG_DRAM_PHY_CONFIG_ADDR) & REG_DRAM_PHY_CONFIG_MASK);
1367
1368
1369 dfs_reg_write(REG_DRAM_PHY_CONFIG_ADDR, reg);
1370
1371 udelay(25);
1372
1373
1374 do {
1375 reg = reg_read(REG_PHY_LOCK_STATUS_ADDR) &
1376 (1 << REG_PHY_LOCK_STATUS_LOCK_OFFS);
1377 } while (reg == 0);
1378
1379
1380 reg = reg_read(REG_DRAM_PHY_CONFIG_ADDR) | ~REG_DRAM_PHY_CONFIG_MASK;
1381
1382
1383 dfs_reg_write(REG_DRAM_PHY_CONFIG_ADDR, reg);
1384
1385 udelay(10000);
1386
1387
1388
1389
1390 do {
1391 reg = reg_read(REG_PHY_LOCK_STATUS_ADDR) &
1392 REG_PHY_LOCK_STATUS_LOCK_MASK;
1393 } while (reg != REG_PHY_LOCK_STATUS_LOCK_MASK);
1394
1395
1396 reg = reg_read(REG_SDRAM_CONFIG_ADDR) & REG_SDRAM_CONFIG_MASK;
1397
1398
1399 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
1400
1401
1402 reg = reg_read(REG_SDRAM_CONFIG_ADDR) | ~REG_SDRAM_CONFIG_MASK;
1403
1404
1405 dfs_reg_write(REG_SDRAM_CONFIG_ADDR, reg);
1406
1407
1408 reg = reg_read(REG_DFS_ADDR) & ~(1 << 4);
1409 dfs_reg_write(REG_DFS_ADDR, reg);
1410
1411
1412 reg = reg_read(REG_DFS_ADDR) & ~(1 << REG_DFS_SR_OFFS);
1413 dfs_reg_write(REG_DFS_ADDR, reg);
1414
1415
1416
1417
1418
1419 do {
1420 reg = reg_read(REG_DFS_ADDR) & (1 << REG_DFS_ATSR_OFFS);
1421 } while (reg);
1422
1423
1424 reg = (reg_read(REG_DUNIT_CTRL_LOW_ADDR) & 0xFFFFFFE7) | 0x2;
1425
1426
1427
1428 reg &= ~(REG_DUNIT_CTRL_LOW_2T_MASK << REG_DUNIT_CTRL_LOW_2T_OFFS);
1429 reg |= ((dram_info->mode_2t & REG_DUNIT_CTRL_LOW_2T_MASK) <<
1430 REG_DUNIT_CTRL_LOW_2T_OFFS);
1431 dfs_reg_write(REG_DUNIT_CTRL_LOW_ADDR, reg);
1432
1433 udelay(1);
1434
1435 for (cs = 0; cs < MAX_CS; cs++) {
1436 if (dram_info->cs_ena & (1 << cs)) {
1437 reg = (reg_read(REG_DDR3_MR1_ADDR));
1438
1439 reg &= ~(1 << REG_DDR3_MR1_DLL_ENA_OFFS);
1440 dfs_reg_write(REG_DDR3_MR1_ADDR, reg);
1441
1442
1443 reg = REG_SDRAM_OPERATION_CMD_MR1 &
1444 ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
1445
1446
1447
1448
1449
1450 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
1451
1452
1453 wait_refresh_op_complete();
1454
1455
1456 reg = reg_read(REG_DDR3_MR0_ADDR);
1457 dfs_reg_write(REG_DDR3_MR0_ADDR, reg);
1458
1459
1460 reg = REG_SDRAM_OPERATION_CMD_MR0 &
1461 ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
1462
1463
1464
1465
1466
1467 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
1468
1469
1470 wait_refresh_op_complete();
1471
1472 reg = reg_read(REG_DDR3_MR0_ADDR);
1473 reg &= ~0x74;
1474
1475 if (freq == DDR_400)
1476 tmp = ddr3_cl_to_valid_cl(6) & 0xF;
1477 else
1478 tmp = ddr3_cl_to_valid_cl(dram_info->cl) & 0xF;
1479
1480 reg |= ((tmp & 0x1) << 2);
1481 reg |= ((tmp >> 1) << 4);
1482 dfs_reg_write(REG_DDR3_MR0_ADDR, reg);
1483
1484 reg = REG_SDRAM_OPERATION_CMD_MR0 &
1485 ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
1486
1487 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
1488
1489
1490 wait_refresh_op_complete();
1491
1492 reg = reg_read(REG_DDR3_MR2_ADDR);
1493 reg &= ~0x38;
1494
1495 if (freq != DDR_400)
1496 reg |= dram_info->cwl << REG_DDR3_MR2_CWL_OFFS;
1497 dfs_reg_write(REG_DDR3_MR2_ADDR, reg);
1498 reg = REG_SDRAM_OPERATION_CMD_MR2 &
1499 ~(1 << (REG_SDRAM_OPERATION_CS_OFFS + cs));
1500
1501 dfs_reg_write(REG_SDRAM_OPERATION_ADDR, reg);
1502
1503
1504 wait_refresh_op_complete();
1505
1506
1507 reg = reg_read(REG_READ_DATA_SAMPLE_DELAYS_ADDR);
1508 reg &= ~(REG_READ_DATA_SAMPLE_DELAYS_MASK <<
1509 (REG_READ_DATA_SAMPLE_DELAYS_OFFS * cs));
1510 reg |= (dram_info->cl <<
1511 (REG_READ_DATA_SAMPLE_DELAYS_OFFS * cs));
1512 dfs_reg_write(REG_READ_DATA_SAMPLE_DELAYS_ADDR, reg);
1513
1514
1515 reg = reg_read(REG_READ_DATA_READY_DELAYS_ADDR);
1516 reg &= ~(REG_READ_DATA_READY_DELAYS_MASK <<
1517 (REG_READ_DATA_READY_DELAYS_OFFS * cs));
1518 reg |= ((dram_info->cl + 1) <<
1519 (REG_READ_DATA_SAMPLE_DELAYS_OFFS * cs));
1520 dfs_reg_write(REG_READ_DATA_READY_DELAYS_ADDR, reg);
1521 }
1522 }
1523
1524
1525 dfs_reg_write(REG_SDRAM_ODT_CTRL_HIGH_ADDR, 0);
1526
1527
1528 reg = reg_read(REG_DFS_ADDR) & ~(1 << REG_DFS_BLOCK_OFFS);
1529 dfs_reg_write(REG_DFS_ADDR, reg);
1530
1531
1532
1533 reg = reg_read(REG_ODPG_CNTRL_ADDR);
1534 reg &= ~(1 << REG_ODPG_CNTRL_OFFS);
1535 dfs_reg_write(REG_ODPG_CNTRL_ADDR, reg);
1536
1537
1538
1539 reg = reg_read(REG_PHY_LOCK_MASK_ADDR);
1540 reg |= ~REG_PHY_LOCK_MASK_MASK;
1541 dfs_reg_write(REG_PHY_LOCK_MASK_ADDR, reg);
1542
1543 reg = reg_read(REG_METAL_MASK_ADDR) | (1 << 0);
1544
1545 dfs_reg_write(REG_METAL_MASK_ADDR, reg);
1546
1547 DEBUG_DFS_C("DDR3 - DFS - Low To High - Ended successfuly - new Frequency - ",
1548 freq, 1);
1549 return MV_OK;
1550#endif
1551}
1552