2 * Copyright (C) 2015-2017 Socionext Inc.
3 * Author: Masahiro Yamada <yamada.masahiro@socionext.com>
5 * based on commit 21b6e480f92ccc38fe0502e3116411d6509d3bf2 of Diag by:
6 * Copyright (C) 2015 Socionext Inc.
8 * SPDX-License-Identifier: GPL-2.0+
12 #include <linux/errno.h>
14 #include <linux/sizes.h>
15 #include <asm/processor.h>
18 #include "../soc-info.h"
19 #include "ddrmphy-regs.h"
37 static u32 ddrphy_pgcr2[DRAM_FREQ_NR] = {0x00FC7E5D, 0x00FC90AB};
38 static u32 ddrphy_ptr0[DRAM_FREQ_NR] = {0x0EA09205, 0x10C0A6C6};
39 static u32 ddrphy_ptr1[DRAM_FREQ_NR] = {0x0DAC041B, 0x0FA104B1};
40 static u32 ddrphy_ptr3[DRAM_FREQ_NR] = {0x15171e45, 0x18182357};
41 static u32 ddrphy_ptr4[DRAM_FREQ_NR] = {0x0e9ad8e9, 0x10b34157};
42 static u32 ddrphy_dtpr0[DRAM_FREQ_NR] = {0x35a00d88, 0x39e40e88};
43 static u32 ddrphy_dtpr1[DRAM_FREQ_NR] = {0x2288cc2c, 0x228a04d0};
44 static u32 ddrphy_dtpr2[DRAM_FREQ_NR] = {0x50005e00, 0x50006a00};
45 static u32 ddrphy_dtpr3[DRAM_FREQ_NR] = {0x0010cb49, 0x0010ec89};
46 static u32 ddrphy_mr0[DRAM_FREQ_NR] = {0x00000115, 0x00000125};
47 static u32 ddrphy_mr2[DRAM_FREQ_NR] = {0x000002a0, 0x000002a8};
49 /* dependent on package and board design */
50 static u32 ddrphy_acbdlr0[DRAM_CH_NR] = {0x0000000c, 0x0000000c, 0x00000009};
53 static inline int ddrphy_get_rank(int dx)
58 static void ddrphy_fifo_reset(void __iomem *phy_base)
62 tmp = readl(phy_base + MPHY_PGCR0);
63 tmp &= ~MPHY_PGCR0_PHYFRST;
64 writel(tmp, phy_base + MPHY_PGCR0);
68 tmp |= MPHY_PGCR0_PHYFRST;
69 writel(tmp, phy_base + MPHY_PGCR0);
74 static void ddrphy_vt_ctrl(void __iomem *phy_base, int enable)
78 tmp = readl(phy_base + MPHY_PGCR1);
81 tmp &= ~MPHY_PGCR1_INHVT;
83 tmp |= MPHY_PGCR1_INHVT;
85 writel(tmp, phy_base + MPHY_PGCR1);
88 while (!(readl(phy_base + MPHY_PGSR1) & MPHY_PGSR1_VTSTOP))
93 static void ddrphy_dqs_delay_fixup(void __iomem *phy_base, int nr_dx, int step)
97 void __iomem *dx_base = phy_base + MPHY_DX_BASE;
99 ddrphy_vt_ctrl(phy_base, 0);
101 for (dx = 0; dx < nr_dx; dx++) {
102 lcdlr1 = readl(dx_base + MPHY_DX_LCDLR1);
103 rdqsd = (lcdlr1 >> 8) & 0xff;
104 rdqsd = clamp(rdqsd + step, 0U, 0xffU);
105 lcdlr1 = (lcdlr1 & ~(0xff << 8)) | (rdqsd << 8);
106 writel(lcdlr1, dx_base + MPHY_DX_LCDLR1);
107 readl(dx_base + MPHY_DX_LCDLR1); /* relax */
108 dx_base += MPHY_DX_STRIDE;
111 ddrphy_vt_ctrl(phy_base, 1);
114 static int ddrphy_get_system_latency(void __iomem *phy_base, int width)
116 void __iomem *dx_base = phy_base + MPHY_DX_BASE;
117 const int nr_dx = width / 8;
120 int dgsl, dgsl_min = INT_MAX, dgsl_max = 0;
122 for (dx = 0; dx < nr_dx; dx++) {
123 gtr = readl(dx_base + MPHY_DX_GTR);
124 for (rank = 0; rank < 4; rank++) {
126 /* if dgsl is zero, this rank was not trained. skip. */
128 dgsl_min = min(dgsl_min, dgsl);
129 dgsl_max = max(dgsl_max, dgsl);
133 dx_base += MPHY_DX_STRIDE;
136 if (dgsl_min != dgsl_max)
137 printf("DQS Gateing System Latencies are not all leveled.\n");
142 static void ddrphy_init(void __iomem *phy_base, enum dram_freq freq, int width,
146 void __iomem *zq_base, *dx_base;
152 writel(MPHY_PIR_ZCALBYP, phy_base + MPHY_PIR);
154 * Disable RGLVT bit (Read DQS Gating LCDL Delay VT Compensation)
155 * to avoid read error issue.
157 writel(0x07d81e37, phy_base + MPHY_PGCR0);
158 writel(0x0200c4e0, phy_base + MPHY_PGCR1);
160 tmp = ddrphy_pgcr2[freq];
162 tmp |= MPHY_PGCR2_DUALCHN | MPHY_PGCR2_ACPDDC;
163 writel(tmp, phy_base + MPHY_PGCR2);
165 writel(ddrphy_ptr0[freq], phy_base + MPHY_PTR0);
166 writel(ddrphy_ptr1[freq], phy_base + MPHY_PTR1);
167 writel(0x00083def, phy_base + MPHY_PTR2);
168 writel(ddrphy_ptr3[freq], phy_base + MPHY_PTR3);
169 writel(ddrphy_ptr4[freq], phy_base + MPHY_PTR4);
171 writel(ddrphy_acbdlr0[ch], phy_base + MPHY_ACBDLR0);
173 writel(0x55555555, phy_base + MPHY_ACIOCR1);
174 writel(0x00000000, phy_base + MPHY_ACIOCR2);
175 writel(0x55555555, phy_base + MPHY_ACIOCR3);
176 writel(0x00000000, phy_base + MPHY_ACIOCR4);
177 writel(0x00000055, phy_base + MPHY_ACIOCR5);
178 writel(0x00181aa4, phy_base + MPHY_DXCCR);
180 writel(0x0024641e, phy_base + MPHY_DSGCR);
181 writel(0x0000040b, phy_base + MPHY_DCR);
182 writel(ddrphy_dtpr0[freq], phy_base + MPHY_DTPR0);
183 writel(ddrphy_dtpr1[freq], phy_base + MPHY_DTPR1);
184 writel(ddrphy_dtpr2[freq], phy_base + MPHY_DTPR2);
185 writel(ddrphy_dtpr3[freq], phy_base + MPHY_DTPR3);
186 writel(ddrphy_mr0[freq], phy_base + MPHY_MR0);
187 writel(0x00000006, phy_base + MPHY_MR1);
188 writel(ddrphy_mr2[freq], phy_base + MPHY_MR2);
189 writel(0x00000000, phy_base + MPHY_MR3);
192 for (dx = 0; dx < nr_dx; dx++)
193 tmp |= BIT(MPHY_DTCR_RANKEN_SHIFT + ddrphy_get_rank(dx));
194 writel(0x90003087 | tmp, phy_base + MPHY_DTCR);
196 writel(0x00000000, phy_base + MPHY_DTAR0);
197 writel(0x00000008, phy_base + MPHY_DTAR1);
198 writel(0x00000010, phy_base + MPHY_DTAR2);
199 writel(0x00000018, phy_base + MPHY_DTAR3);
200 writel(0xdd22ee11, phy_base + MPHY_DTDR0);
201 writel(0x7788bb44, phy_base + MPHY_DTDR1);
203 /* impedance control settings */
204 writel(0x04048900, phy_base + MPHY_ZQCR);
206 zq_base = phy_base + MPHY_ZQ_BASE;
207 for (zq = 0; zq < 4; zq++) {
210 * PXS2: CH0ZQ0=0x5B, CH1ZQ0=0x5B, CH2ZQ0=0x59, others=0x5D
212 writel(0x0007BB5D, zq_base + MPHY_ZQ_PR);
213 zq_base += MPHY_ZQ_STRIDE;
217 dx_base = phy_base + MPHY_DX_BASE;
218 for (dx = 0; dx < 4; dx++) {
219 tmp = readl(dx_base + MPHY_DX_GCR0);
220 tmp &= ~MPHY_DX_GCR0_WLRKEN_MASK;
221 tmp |= BIT(MPHY_DX_GCR0_WLRKEN_SHIFT + ddrphy_get_rank(dx)) &
222 MPHY_DX_GCR0_WLRKEN_MASK;
223 writel(tmp, dx_base + MPHY_DX_GCR0);
225 writel(0x00000000, dx_base + MPHY_DX_GCR1);
226 writel(0x00000000, dx_base + MPHY_DX_GCR2);
227 writel(0x00000000, dx_base + MPHY_DX_GCR3);
228 dx_base += MPHY_DX_STRIDE;
231 while (!(readl(phy_base + MPHY_PGSR0) & MPHY_PGSR0_IDONE))
234 ddrphy_dqs_delay_fixup(phy_base, nr_dx, -4);
237 struct ddrphy_init_sequence {
244 static const struct ddrphy_init_sequence impedance_calibration_sequence[] = {
246 "Impedance Calibration",
254 static const struct ddrphy_init_sequence dram_init_sequence[] = {
256 "DRAM Initialization",
257 MPHY_PIR_DRAMRST | MPHY_PIR_DRAMINIT,
264 static const struct ddrphy_init_sequence training_sequence[] = {
272 "Read DQS Gate Training",
278 "Write Leveling Adjustment",
302 "Write Eye Training",
310 static int __ddrphy_training(void __iomem *phy_base,
311 const struct ddrphy_init_sequence *seq)
313 const struct ddrphy_init_sequence *s;
315 u32 init_flag = MPHY_PIR_INIT;
316 u32 done_flag = MPHY_PGSR0_IDONE;
317 int timeout = 50000; /* 50 msec is long enough */
318 #ifdef DISPLAY_ELAPSED_TIME
319 ulong start = get_timer(0);
322 for (s = seq; s->description; s++) {
323 init_flag |= s->init_flag;
324 done_flag |= s->done_flag;
327 writel(init_flag, phy_base + MPHY_PIR);
331 pr_err("%s: error: timeout during DDR training\n",
336 pgsr0 = readl(phy_base + MPHY_PGSR0);
337 } while ((pgsr0 & done_flag) != done_flag);
339 for (s = seq; s->description; s++) {
340 if (pgsr0 & s->err_flag) {
341 pr_err("%s: error: %s failed\n", __func__,
347 #ifdef DISPLAY_ELAPSED_TIME
348 printf("%s: info: elapsed time %ld msec\n", get_timer(start));
354 static int ddrphy_impedance_calibration(void __iomem *phy_base)
359 ret = __ddrphy_training(phy_base, impedance_calibration_sequence);
364 * Because of a hardware bug, IDONE flag is set when the first ZQ block
365 * is calibrated. The flag does not guarantee the completion for all
366 * the ZQ blocks. Wait a little more just in case.
370 /* reflect ZQ settings and enable average algorithm*/
371 tmp = readl(phy_base + MPHY_ZQCR);
372 tmp |= MPHY_ZQCR_FORCE_ZCAL_VT_UPDATE;
373 writel(tmp, phy_base + MPHY_ZQCR);
374 tmp &= ~MPHY_ZQCR_FORCE_ZCAL_VT_UPDATE;
375 tmp |= MPHY_ZQCR_AVGEN;
376 writel(tmp, phy_base + MPHY_ZQCR);
381 static int ddrphy_dram_init(void __iomem *phy_base)
383 return __ddrphy_training(phy_base, dram_init_sequence);
386 static int ddrphy_training(void __iomem *phy_base)
388 return __ddrphy_training(phy_base, training_sequence);
392 static u32 umc_cmdctla[DRAM_FREQ_NR] = {0x66DD131D, 0x77EE1722};
394 * The ch2 is a different generation UMC core.
395 * The register spec is different, unfortunately.
397 static u32 umc_cmdctlb_ch01[DRAM_FREQ_NR] = {0x13E87C44, 0x18F88C44};
398 static u32 umc_cmdctlb_ch2[DRAM_FREQ_NR] = {0x19E8DC44, 0x1EF8EC44};
399 static u32 umc_spcctla[DRAM_FREQ_NR][DRAM_SZ_NR] = {
400 {0x004A071D, 0x0078071D},
401 {0x0055081E, 0x0089081E},
404 static u32 umc_spcctlb[] = {0x00FF000A, 0x00FF000B};
405 /* The ch2 is different for some reason only hardware guys know... */
406 static u32 umc_flowctla_ch01[] = {0x0800001E, 0x08000022};
407 static u32 umc_flowctla_ch2[] = {0x0800001E, 0x0800001E};
409 static void umc_set_system_latency(void __iomem *dc_base, int phy_latency)
414 val = readl(dc_base + UMC_RDATACTL_D0);
415 latency = (val & UMC_RDATACTL_RADLTY_MASK) >> UMC_RDATACTL_RADLTY_SHIFT;
416 latency += (val & UMC_RDATACTL_RAD2LTY_MASK) >>
417 UMC_RDATACTL_RAD2LTY_SHIFT;
419 * UMC works at the half clock rate of the PHY.
420 * The LSB of latency is ignored
422 latency += phy_latency & ~1;
424 val &= ~(UMC_RDATACTL_RADLTY_MASK | UMC_RDATACTL_RAD2LTY_MASK);
426 val |= 0xf << UMC_RDATACTL_RADLTY_SHIFT;
427 val |= (latency - 0xf) << UMC_RDATACTL_RAD2LTY_SHIFT;
429 val |= latency << UMC_RDATACTL_RADLTY_SHIFT;
432 writel(val, dc_base + UMC_RDATACTL_D0);
433 writel(val, dc_base + UMC_RDATACTL_D1);
435 readl(dc_base + UMC_RDATACTL_D1); /* relax */
438 /* enable/disable auto refresh */
439 void umc_refresh_ctrl(void __iomem *dc_base, int enable)
443 tmp = readl(dc_base + UMC_SPCSETB);
444 tmp &= ~UMC_SPCSETB_AREFMD_MASK;
447 tmp |= UMC_SPCSETB_AREFMD_ARB;
449 tmp |= UMC_SPCSETB_AREFMD_REG;
451 writel(tmp, dc_base + UMC_SPCSETB);
455 static void umc_ud_init(void __iomem *umc_base, int ch)
457 writel(0x00000003, umc_base + UMC_BITPERPIXELMODE_D0);
460 writel(0x00000033, umc_base + UMC_PAIR1DOFF_D0);
463 static int umc_dc_init(void __iomem *dc_base, enum dram_freq freq,
464 unsigned long size, int width, int ch)
466 enum dram_size size_e;
474 size_e = DRAM_SZ_256M;
477 size_e = DRAM_SZ_512M;
480 pr_err("unsupported DRAM size 0x%08lx (per 16bit) for ch%d\n",
485 writel(umc_cmdctla[freq], dc_base + UMC_CMDCTLA);
487 writel(ch == 2 ? umc_cmdctlb_ch2[freq] : umc_cmdctlb_ch01[freq],
488 dc_base + UMC_CMDCTLB);
490 writel(umc_spcctla[freq][size_e], dc_base + UMC_SPCCTLA);
491 writel(umc_spcctlb[freq], dc_base + UMC_SPCCTLB);
495 /* ES2 inserted one more FF to the logic. */
496 if (uniphier_get_soc_model() >= 2)
500 val |= 0xf << UMC_RDATACTL_RADLTY_SHIFT;
501 val |= (latency - 0xf) << UMC_RDATACTL_RAD2LTY_SHIFT;
503 val |= latency << UMC_RDATACTL_RADLTY_SHIFT;
506 writel(val, dc_base + UMC_RDATACTL_D0);
508 writel(val, dc_base + UMC_RDATACTL_D1);
510 writel(0x04060A02, dc_base + UMC_WDATACTL_D0);
512 writel(0x04060A02, dc_base + UMC_WDATACTL_D1);
513 writel(0x04000000, dc_base + UMC_DATASET);
514 writel(0x00400020, dc_base + UMC_DCCGCTL);
515 writel(0x00000084, dc_base + UMC_FLOWCTLG);
516 writel(0x00000000, dc_base + UMC_ACSSETA);
518 writel(ch == 2 ? umc_flowctla_ch2[freq] : umc_flowctla_ch01[freq],
519 dc_base + UMC_FLOWCTLA);
521 writel(0x00004400, dc_base + UMC_FLOWCTLC);
522 writel(0x200A0A00, dc_base + UMC_SPCSETB);
523 writel(0x00000520, dc_base + UMC_DFICUPDCTLA);
524 writel(0x0000000D, dc_base + UMC_RESPCTL);
527 writel(0x00202000, dc_base + UMC_FLOWCTLB);
528 writel(0xFDBFFFFF, dc_base + UMC_FLOWCTLOB0);
529 writel(0xFFFFFFFF, dc_base + UMC_FLOWCTLOB1);
530 writel(0x00080700, dc_base + UMC_BSICMAPSET);
532 writel(0x00200000, dc_base + UMC_FLOWCTLB);
533 writel(0x00000000, dc_base + UMC_BSICMAPSET);
536 writel(0x00000000, dc_base + UMC_ERRMASKA);
537 writel(0x00000000, dc_base + UMC_ERRMASKB);
542 static int umc_ch_init(void __iomem *umc_ch_base, enum dram_freq freq,
543 unsigned long size, unsigned int width, int ch)
545 void __iomem *dc_base = umc_ch_base + 0x00011000;
546 void __iomem *phy_base = umc_ch_base + 0x00030000;
549 writel(0x00000002, dc_base + UMC_INITSET);
550 while (readl(dc_base + UMC_INITSTAT) & BIT(2))
553 /* deassert PHY reset signals */
554 writel(UMC_DIOCTLA_CTL_NRST | UMC_DIOCTLA_CFG_NRST,
555 dc_base + UMC_DIOCTLA);
557 ddrphy_init(phy_base, freq, width, ch);
559 ret = ddrphy_impedance_calibration(phy_base);
563 ddrphy_dram_init(phy_base);
567 ret = umc_dc_init(dc_base, freq, size, width, ch);
571 umc_ud_init(umc_ch_base, ch);
573 ret = ddrphy_training(phy_base);
579 /* match the system latency between UMC and PHY */
580 umc_set_system_latency(dc_base,
581 ddrphy_get_system_latency(phy_base, width));
585 /* stop auto refresh before clearing FIFO in PHY */
586 umc_refresh_ctrl(dc_base, 0);
587 ddrphy_fifo_reset(phy_base);
588 umc_refresh_ctrl(dc_base, 1);
595 static void um_init(void __iomem *um_base)
597 writel(0x000000ff, um_base + UMC_MBUS0);
598 writel(0x000000ff, um_base + UMC_MBUS1);
599 writel(0x000000ff, um_base + UMC_MBUS2);
600 writel(0x000000ff, um_base + UMC_MBUS3);
603 int uniphier_pxs2_umc_init(const struct uniphier_board_data *bd)
605 void __iomem *um_base = (void __iomem *)0x5b600000;
606 void __iomem *umc_ch_base = (void __iomem *)0x5b800000;
610 switch (bd->dram_freq) {
612 freq = DRAM_FREQ_1866M;
615 freq = DRAM_FREQ_2133M;
618 pr_err("unsupported DRAM frequency %d MHz\n", bd->dram_freq);
622 for (ch = 0; ch < DRAM_CH_NR; ch++) {
623 unsigned long size = bd->dram_ch[ch].size;
624 unsigned int width = bd->dram_ch[ch].width;
627 ret = umc_ch_init(umc_ch_base, freq,
628 size / (width / 16), width, ch);
630 pr_err("failed to initialize UMC ch%d\n", ch);
635 umc_ch_base += 0x00200000;