Commit c85f8f09 authored by Marek Vasut's avatar Marek Vasut
Browse files

rcar_gen3: drivers: ddr-a: Fix E3 DDR init coding style



Coding style cleanup, no functional change.
Signed-off-by: default avatarMarek Vasut <marek.vasut+renesas@gmail.com>
Change-Id: I689418768e87a8c1b6eeeb9f1a48dfb333908017
parent 2c400e94
/* /*
* Copyright (c) 2015-2019, Renesas Electronics Corporation. All rights reserved. * Copyright (c) 2015-2019, Renesas Electronics Corporation.
* All rights reserved.
* *
* SPDX-License-Identifier: BSD-3-Clause * SPDX-License-Identifier: BSD-3-Clause
*/ */
...@@ -16,45 +17,42 @@ ...@@ -16,45 +17,42 @@
#define RCAR_E3_DDR_VERSION "rev.0.12" #define RCAR_E3_DDR_VERSION "rev.0.12"
/* Average periodic refresh interval[ns]. Support 3900,7800 */
#ifdef ddr_qos_init_setting #ifdef ddr_qos_init_setting
#define REFRESH_RATE 3900 /* Average periodic refresh interval[ns]. Support 3900,7800 */ #define REFRESH_RATE 3900U
#else #else
#if RCAR_REF_INT == 1 #if RCAR_REF_INT == 1
#define REFRESH_RATE 7800 #define REFRESH_RATE 7800U
#else #else
#define REFRESH_RATE 3900 #define REFRESH_RATE 3900U
#endif #endif
#endif #endif
/******************************************************************************* /*
* Initialize ddr * Initialize ddr
******************************************************************************/ */
uint32_t init_ddr(void) uint32_t init_ddr(void)
{ {
uint32_t RegVal_R2, RegVal_R5, RegVal_R6, RegVal_R7, RegVal_R12, i; uint32_t i, r2, r5, r6, r7, r12;
uint32_t ddr_md; uint32_t ddr_md;
uint32_t regval, j;
/* rev.0.08 */ uint32_t dqsgd_0c, bdlcount_0c, bdlcount_0c_div2, bdlcount_0c_div4;
uint32_t RegVal, j; uint32_t bdlcount_0c_div8, bdlcount_0c_div16;
uint32_t dqsgd_0c, bdlcount_0c, bdlcount_0c_div2, bdlcount_0c_div4, bdlcount_0c_div8, bdlcount_0c_div16;
uint32_t gatesl_0c, rdqsd_0c, rdqsnd_0c, rbd_0c[4]; uint32_t gatesl_0c, rdqsd_0c, rdqsnd_0c, rbd_0c[4];
uint32_t pdqsr_ctl, lcdl_ctl, lcdl_judge1, lcdl_judge2; uint32_t pdqsr_ctl, lcdl_ctl, lcdl_judge1, lcdl_judge2;
/* rev.0.10 */
uint32_t pdr_ctl; uint32_t pdr_ctl;
/* rev.0.11 */
uint32_t byp_ctl; uint32_t byp_ctl;
/* rev.0.08 */
if ((mmio_read_32(0xFFF00044) & 0x000000FF) == 0x00000000) { if ((mmio_read_32(0xFFF00044) & 0x000000FF) == 0x00000000) {
pdqsr_ctl = 1; pdqsr_ctl = 1;
lcdl_ctl = 1; lcdl_ctl = 1;
pdr_ctl = 1; /* rev.0.10 */ pdr_ctl = 1;
byp_ctl = 1; /* rev.0.11 */ byp_ctl = 1;
} else { } else {
pdqsr_ctl = 0; pdqsr_ctl = 0;
lcdl_ctl = 0; lcdl_ctl = 0;
pdr_ctl = 0; /* rev.0.10 */ pdr_ctl = 0;
byp_ctl = 0; /* rev.0.11 */ byp_ctl = 0;
} }
/* Judge the DDR bit rate (ddr_md : 0 = 1584Mbps, 1 = 1856Mbps) */ /* Judge the DDR bit rate (ddr_md : 0 = 1584Mbps, 1 = 1856Mbps) */
...@@ -62,21 +60,19 @@ uint32_t init_ddr(void) ...@@ -62,21 +60,19 @@ uint32_t init_ddr(void)
/* 1584Mbps setting */ /* 1584Mbps setting */
if (ddr_md == 0) { if (ddr_md == 0) {
/* CPG setting ===============================================*/
mmio_write_32(CPG_CPGWPR, 0x5A5AFFFF); mmio_write_32(CPG_CPGWPR, 0x5A5AFFFF);
mmio_write_32(CPG_CPGWPCR, 0xA5A50000); mmio_write_32(CPG_CPGWPCR, 0xA5A50000);
mmio_write_32(CPG_SRCR4, 0x20000000); mmio_write_32(CPG_SRCR4, 0x20000000);
mmio_write_32(0xE61500DC, 0xe2200000); /* Change to 1584Mbps */ mmio_write_32(0xE61500DC, 0xe2200000); /* Change to 1584Mbps */
while ((BIT(11) & mmio_read_32(CPG_PLLECR)) == 0); while (!(mmio_read_32(CPG_PLLECR) & BIT(11)))
;
mmio_write_32(CPG_SRSTCLR4, 0x20000000); mmio_write_32(CPG_SRSTCLR4, 0x20000000);
mmio_write_32(CPG_CPGWPCR, 0xA5A50001); mmio_write_32(CPG_CPGWPCR, 0xA5A50001);
}
/* CPG setting ===============================================*/
} /* ddr_md */
mmio_write_32(DBSC_DBSYSCNT0, 0x00001234); mmio_write_32(DBSC_DBSYSCNT0, 0x00001234);
mmio_write_32(DBSC_DBKIND, 0x00000007); mmio_write_32(DBSC_DBKIND, 0x00000007);
...@@ -88,21 +84,20 @@ uint32_t init_ddr(void) ...@@ -88,21 +84,20 @@ uint32_t init_ddr(void)
#endif #endif
#if RCAR_DRAM_DDR3L_MEMDUAL == 1 #if RCAR_DRAM_DDR3L_MEMDUAL == 1
RegVal_R2 = (mmio_read_32(0xE6790614)); r2 = mmio_read_32(0xE6790614);
mmio_write_32(0xE6790614, RegVal_R2 | 0x00000003); /* MCS1_N/MODT1 are activated. */ mmio_write_32(0xE6790614, r2 | 0x3); /* MCS1_N/MODT1 are activated. */
#endif #endif
mmio_write_32(DBSC_DBPHYCONF0, 0x1);
mmio_write_32(DBSC_DBPHYCONF0, 0x00000001);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
mmio_write_32(DBSC_DBTR0, 0x0000000B); mmio_write_32(DBSC_DBTR0, 0xB);
mmio_write_32(DBSC_DBTR1, 0x00000008); mmio_write_32(DBSC_DBTR1, 0x8);
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBTR0, 0x0000000D); mmio_write_32(DBSC_DBTR0, 0xD);
mmio_write_32(DBSC_DBTR1, 0x00000009); mmio_write_32(DBSC_DBTR1, 0x9);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR2, 0x00000000); mmio_write_32(DBSC_DBTR2, 0x00000000);
...@@ -117,7 +112,7 @@ uint32_t init_ddr(void) ...@@ -117,7 +112,7 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBTR4, 0x000D000D); mmio_write_32(DBSC_DBTR4, 0x000D000D);
mmio_write_32(DBSC_DBTR5, 0x0000002D); mmio_write_32(DBSC_DBTR5, 0x0000002D);
mmio_write_32(DBSC_DBTR6, 0x00000020); mmio_write_32(DBSC_DBTR6, 0x00000020);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR7, 0x00060006); mmio_write_32(DBSC_DBTR7, 0x00060006);
...@@ -144,7 +139,7 @@ uint32_t init_ddr(void) ...@@ -144,7 +139,7 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBTR15, 0x00060005); mmio_write_32(DBSC_DBTR15, 0x00060005);
mmio_write_32(DBSC_DBTR16, 0x09210507); mmio_write_32(DBSC_DBTR16, 0x09210507);
mmio_write_32(DBSC_DBTR17, 0x040E0000); mmio_write_32(DBSC_DBTR17, 0x040E0000);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR18, 0x00000200); mmio_write_32(DBSC_DBTR18, 0x00000200);
...@@ -155,7 +150,7 @@ uint32_t init_ddr(void) ...@@ -155,7 +150,7 @@ uint32_t init_ddr(void)
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBTR19, 0x0129004B); mmio_write_32(DBSC_DBTR19, 0x0129004B);
mmio_write_32(DBSC_DBTR20, 0x020000FB); mmio_write_32(DBSC_DBTR20, 0x020000FB);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR21, 0x00040004); mmio_write_32(DBSC_DBTR21, 0x00040004);
mmio_write_32(DBSC_DBBL, 0x00000000); mmio_write_32(DBSC_DBBL, 0x00000000);
...@@ -173,35 +168,33 @@ uint32_t init_ddr(void) ...@@ -173,35 +168,33 @@ uint32_t init_ddr(void)
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_SCFCTST0, 0x0C050B03); mmio_write_32(DBSC_SCFCTST0, 0x0C050B03);
mmio_write_32(DBSC_SCFCTST1, 0x0305030C); mmio_write_32(DBSC_SCFCTST1, 0x0305030C);
} /* ddr_md */ }
/* rev.0.03 add Comment */ /*
/****************************************************************************
* Initial_Step0( INITBYP ) * Initial_Step0( INITBYP )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDLK0, 0x0000A55A); mmio_write_32(DBSC_DBPDLK0, 0x0000A55A);
mmio_write_32(DBSC_DBCMD, 0x01840001); mmio_write_32(DBSC_DBCMD, 0x01840001);
mmio_write_32(DBSC_DBCMD, 0x08840000); mmio_write_32(DBSC_DBCMD, 0x08840000);
NOTICE("BL2: [COLD_BOOT]\n"); /* rev.0.11 */ NOTICE("BL2: [COLD_BOOT]\n");
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x80010000); mmio_write_32(DBSC_DBPDRGD0, 0x80010000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* rev.0.03 add Comment */ /*
/****************************************************************************
* Initial_Step1( ZCAL,PLLINIT,DCAL,PHYRST training ) * Initial_Step1( ZCAL,PLLINIT,DCAL,PHYRST training )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000008); mmio_write_32(DBSC_DBPDRGA0, 0x00000008);
mmio_write_32(DBSC_DBPDRGD0, 0x000B8000); mmio_write_32(DBSC_DBPDRGD0, 0x000B8000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058904); mmio_write_32(DBSC_DBPDRGD0, 0x04058904);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058A04); mmio_write_32(DBSC_DBPDRGD0, 0x04058A04);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000091); mmio_write_32(DBSC_DBPDRGA0, 0x00000091);
mmio_write_32(DBSC_DBPDRGD0, 0x0007BB6B); mmio_write_32(DBSC_DBPDRGD0, 0x0007BB6B);
...@@ -212,108 +205,104 @@ uint32_t init_ddr(void) ...@@ -212,108 +205,104 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058900); mmio_write_32(DBSC_DBPDRGD0, 0x04058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058A00); mmio_write_32(DBSC_DBPDRGD0, 0x04058A00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000021); mmio_write_32(DBSC_DBPDRGA0, 0x00000021);
mmio_write_32(DBSC_DBPDRGD0, 0x0024641E); mmio_write_32(DBSC_DBPDRGD0, 0x0024641E);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010073); mmio_write_32(DBSC_DBPDRGD0, 0x00010073);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* rev.0.03 add Comment */ /*
/****************************************************************************
* Initial_Step2( DRAMRST/DRAMINT training ) * Initial_Step2( DRAMRST/DRAMINT training )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0C058900); mmio_write_32(DBSC_DBPDRGD0, 0x0C058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0C058A00); mmio_write_32(DBSC_DBPDRGD0, 0x0C058A00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058900); mmio_write_32(DBSC_DBPDRGD0, 0x04058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058A00); mmio_write_32(DBSC_DBPDRGD0, 0x04058A00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000003); mmio_write_32(DBSC_DBPDRGA0, 0x00000003);
if (byp_ctl == 1) { if (byp_ctl == 1)
mmio_write_32(DBSC_DBPDRGD0, 0x0780C720); mmio_write_32(DBSC_DBPDRGD0, 0x0780C720);
} else { else
mmio_write_32(DBSC_DBPDRGD0, 0x0780C700); mmio_write_32(DBSC_DBPDRGD0, 0x0780C700);
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000007); mmio_write_32(DBSC_DBPDRGA0, 0x00000007);
while ((BIT(30) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(30)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000004); mmio_write_32(DBSC_DBPDRGA0, 0x00000004);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, (uint32_t)(REFRESH_RATE * 792 / 125) - 400 + 0x08B00000); mmio_write_32(DBSC_DBPDRGD0, (REFRESH_RATE * 792 / 125) -
400 + 0x08B00000);
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, (uint32_t)(REFRESH_RATE * 928 / 125) - 400 + 0x0A300000); mmio_write_32(DBSC_DBPDRGD0, (REFRESH_RATE * 928 / 125) -
} /* ddr_md */ 400 + 0x0A300000);
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000022); mmio_write_32(DBSC_DBPDRGA0, 0x00000022);
mmio_write_32(DBSC_DBPDRGD0, 0x1000040B); mmio_write_32(DBSC_DBPDRGD0, 0x1000040B);
mmio_write_32(DBSC_DBPDRGA0, 0x00000023); mmio_write_32(DBSC_DBPDRGA0, 0x00000023);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x2D9C0B66); mmio_write_32(DBSC_DBPDRGD0, 0x2D9C0B66);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x35A00D77); mmio_write_32(DBSC_DBPDRGD0, 0x35A00D77);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000024); mmio_write_32(DBSC_DBPDRGA0, 0x00000024);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x2A88B400); mmio_write_32(DBSC_DBPDRGD0, 0x2A88B400);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x2A8A2C28); mmio_write_32(DBSC_DBPDRGD0, 0x2A8A2C28);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000025); mmio_write_32(DBSC_DBPDRGA0, 0x00000025);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x30005200); mmio_write_32(DBSC_DBPDRGD0, 0x30005200);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x30005E00); mmio_write_32(DBSC_DBPDRGD0, 0x30005E00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000026); mmio_write_32(DBSC_DBPDRGA0, 0x00000026);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0014A9C9); mmio_write_32(DBSC_DBPDRGD0, 0x0014A9C9);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0014CB49); mmio_write_32(DBSC_DBPDRGD0, 0x0014CB49);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000027); mmio_write_32(DBSC_DBPDRGA0, 0x00000027);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x00000D70); mmio_write_32(DBSC_DBPDRGD0, 0x00000D70);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x00000F14); mmio_write_32(DBSC_DBPDRGD0, 0x00000F14);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000028); mmio_write_32(DBSC_DBPDRGA0, 0x00000028);
mmio_write_32(DBSC_DBPDRGD0, 0x00000046); mmio_write_32(DBSC_DBPDRGD0, 0x00000046);
...@@ -321,18 +310,16 @@ uint32_t init_ddr(void) ...@@ -321,18 +310,16 @@ uint32_t init_ddr(void)
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
if (REFRESH_RATE > 3900) { if (REFRESH_RATE > 3900) /* [7]SRT=0 */
mmio_write_32(DBSC_DBPDRGD0, 0x00000018); /* [7]SRT=0 */ mmio_write_32(DBSC_DBPDRGD0, 0x18);
} else { else /* [7]SRT=1 */
mmio_write_32(DBSC_DBPDRGD0, 0x00000098); /* [7]SRT=1 */ mmio_write_32(DBSC_DBPDRGD0, 0x98);
}
} else { /* 1856Mbps */ } else { /* 1856Mbps */
if (REFRESH_RATE > 3900) { if (REFRESH_RATE > 3900) /* [7]SRT=0 */
mmio_write_32(DBSC_DBPDRGD0, 0x00000020); /* [7]SRT=0 */ mmio_write_32(DBSC_DBPDRGD0, 0x20);
} else { else /* [7]SRT=1 */
mmio_write_32(DBSC_DBPDRGD0, 0x000000A0); /* [7]SRT=1 */ mmio_write_32(DBSC_DBPDRGD0, 0xA0);
} /* REFRESH_RATE */ }
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x0000002C); mmio_write_32(DBSC_DBPDRGA0, 0x0000002C);
mmio_write_32(DBSC_DBPDRGD0, 0x81003047); mmio_write_32(DBSC_DBPDRGD0, 0x81003047);
...@@ -341,7 +328,8 @@ uint32_t init_ddr(void) ...@@ -341,7 +328,8 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBPDRGA0, 0x0000001A); mmio_write_32(DBSC_DBPDRGA0, 0x0000001A);
mmio_write_32(DBSC_DBPDRGD0, 0x33C03C10); mmio_write_32(DBSC_DBPDRGD0, 0x33C03C10);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x000000A7); mmio_write_32(DBSC_DBPDRGA0, 0x000000A7);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D); mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
...@@ -372,54 +360,56 @@ uint32_t init_ddr(void) ...@@ -372,54 +360,56 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBPDRGD0, 0x00010181); mmio_write_32(DBSC_DBPDRGD0, 0x00010181);
mmio_write_32(DBSC_DBCMD, 0x08840001); mmio_write_32(DBSC_DBCMD, 0x08840001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* rev.0.03 add Comment */ /*
/****************************************************************************
* Initial_Step3( WL/QSG training ) * Initial_Step3( WL/QSG training )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010601); mmio_write_32(DBSC_DBPDRGD0, 0x00010601);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
RegVal_R5 = (mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 0x8; r5 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >> 0x8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B4 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB4 + i * 0x20);
RegVal_R6 = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF); r6 = mmio_read_32(DBSC_DBPDRGD0) & 0xFF;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B3 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB3 + i * 0x20);
RegVal_R7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007); r7 = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
if (RegVal_R6 > 0) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); if (r6 > 0) {
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r7 + 0x1) & 0x7));
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | RegVal_R6); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, r2 | r6);
} else { } else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | RegVal_R7); mmio_write_32(DBSC_DBPDRGD0, r2 | r7);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R6 + ((RegVal_R5) << 1)) & 0x000000FF)); mmio_write_32(DBSC_DBPDRGD0, r2 |
} /* RegVal_R6 */ ((r6 + ((r5) << 1)) &
} /* for i */ 0xFF));
}
}
/* rev.0.10 move Comment */ /*
/****************************************************************************
* Initial_Step4( WLADJ training ) * Initial_Step4( WLADJ training )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000005); mmio_write_32(DBSC_DBPDRGA0, 0x00000005);
mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00C0); mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00C0);
/* rev.0.08 */ if (pdqsr_ctl == 0) {
if (pdqsr_ctl == 1){} else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -430,7 +420,7 @@ uint32_t init_ddr(void) ...@@ -430,7 +420,7 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR always off */ /* rev.0.10 */ /* PDR always off */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000008); mmio_write_32(DBSC_DBPDRGD0, 0x00000008);
...@@ -445,21 +435,22 @@ uint32_t init_ddr(void) ...@@ -445,21 +435,22 @@ uint32_t init_ddr(void)
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010801); mmio_write_32(DBSC_DBPDRGD0, 0x00010801);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/**************************************************************************** /*
* Initial_Step5(Read Data Bit Deskew) * Initial_Step5(Read Data Bit Deskew)
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000005); mmio_write_32(DBSC_DBPDRGA0, 0x00000005);
mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00D8); mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00D8);
/* rev.0.08 */
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00011001); mmio_write_32(DBSC_DBPDRGD0, 0x00011001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -468,9 +459,9 @@ if (pdqsr_ctl == 1) { ...@@ -468,9 +459,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100); mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR dynamic */ /* rev.0.10 */ /* PDR dynamic */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
...@@ -482,18 +473,19 @@ if (pdqsr_ctl == 1) { ...@@ -482,18 +473,19 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
} }
/**************************************************************************** /*
* Initial_Step6(Write Data Bit Deskew) * Initial_Step6(Write Data Bit Deskew)
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00012001); mmio_write_32(DBSC_DBPDRGD0, 0x00012001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/**************************************************************************** /*
* Initial_Step7(Read Data Eye Training) * Initial_Step7(Read Data Eye Training)
***************************************************************************/ */
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -502,9 +494,9 @@ if (pdqsr_ctl == 1) { ...@@ -502,9 +494,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100); mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
} }
/* PDR always off */ /* rev.0.10 */ /* PDR always off */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000008); mmio_write_32(DBSC_DBPDRGD0, 0x00000008);
...@@ -519,9 +511,10 @@ if (pdqsr_ctl == 1) { ...@@ -519,9 +511,10 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00014001); mmio_write_32(DBSC_DBPDRGD0, 0x00014001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -530,9 +523,9 @@ if (pdqsr_ctl == 1) { ...@@ -530,9 +523,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100); mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR dynamic */ /* rev.0.10 */ /* PDR dynamic */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
...@@ -544,18 +537,18 @@ if (pdqsr_ctl == 1) { ...@@ -544,18 +537,18 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
} }
/**************************************************************************** /*
* Initial_Step8(Write Data Eye Training) * Initial_Step8(Write Data Eye Training)
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00018001); mmio_write_32(DBSC_DBPDRGD0, 0x00018001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* rev.0.03 add Comment */ /*
/****************************************************************************
* Initial_Step3_2( DQS Gate Training ) * Initial_Step3_2( DQS Gate Training )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -569,43 +562,43 @@ if (pdqsr_ctl == 1) { ...@@ -569,43 +562,43 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010401); mmio_write_32(DBSC_DBPDRGD0, 0x00010401);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
RegVal_R5 = ((mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 0x8); r5 = ((mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >> 0x8);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B4 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB4 + i * 0x20);
RegVal_R6 = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF); r6 = mmio_read_32(DBSC_DBPDRGD0) & 0xFF;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B3 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB3 + i * 0x20);
RegVal_R7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007); r7 = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
RegVal_R12 = (RegVal_R5 >> 0x2); r12 = (r5 >> 0x2);
if (RegVal_R12 < RegVal_R6) { if (r12 < r6) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r7 + 0x1) & 0x7));
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R6 - (RegVal_R12)) & 0x000000FF)); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r6 - r12) & 0xFF));
} else { } else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | (RegVal_R7 & 0x00000007)); mmio_write_32(DBSC_DBPDRGD0, r2 | (r7 & 0x7));
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R6 + (RegVal_R5) + ((RegVal_R5) >> 1) + (RegVal_R12)) & 0x000000FF)); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r6 + r5 +
} /* RegVal_R12 < RegVal_R6 */ (r5 >> 1) + r12) & 0xFF));
} /* for i */ }
}
/* rev.0.10 move Comment */ /*
/****************************************************************************
* Initial_Step5-2_7-2( Rd bit Rd eye ) * Initial_Step5-2_7-2( Rd bit Rd eye )
***************************************************************************/ */
/* rev.0.08 */ if (pdqsr_ctl == 0) {
if (pdqsr_ctl == 1){} else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -616,7 +609,7 @@ if (pdqsr_ctl == 1) { ...@@ -616,7 +609,7 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR always off */ /* rev.0.10 */ /* PDR always off */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000008); mmio_write_32(DBSC_DBPDRGD0, 0x00000008);
...@@ -631,115 +624,142 @@ if (pdqsr_ctl == 1) { ...@@ -631,115 +624,142 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00015001); mmio_write_32(DBSC_DBPDRGD0, 0x00015001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* rev.0.08 */
if (lcdl_ctl == 1) { if (lcdl_ctl == 1) {
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
dqsgd_0c = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF); dqsgd_0c = mmio_read_32(DBSC_DBPDRGD0) & 0xFF;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
bdlcount_0c = ((mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 8); bdlcount_0c = (mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >>
bdlcount_0c_div2 = (bdlcount_0c >> 1); 8;
bdlcount_0c_div4 = (bdlcount_0c >> 2); bdlcount_0c_div2 = bdlcount_0c >> 1;
bdlcount_0c_div8 = (bdlcount_0c >> 3); bdlcount_0c_div4 = bdlcount_0c >> 2;
bdlcount_0c_div16 = (bdlcount_0c >> 4); bdlcount_0c_div8 = bdlcount_0c >> 3;
bdlcount_0c_div16 = bdlcount_0c >> 4;
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4 + bdlcount_0c_div8; lcdl_judge1 = bdlcount_0c_div2 +
lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4 + bdlcount_0c_div16; bdlcount_0c_div4 +
bdlcount_0c_div8;
lcdl_judge2 = bdlcount_0c +
bdlcount_0c_div4 +
bdlcount_0c_div16;
} else { /* 1856Mbps */ } else { /* 1856Mbps */
lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4; lcdl_judge1 = bdlcount_0c_div2 +
lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4; bdlcount_0c_div4;
} /* ddr_md */ lcdl_judge2 = bdlcount_0c +
bdlcount_0c_div4;
}
if (dqsgd_0c <= lcdl_judge1)
continue;
if (dqsgd_0c > lcdl_judge1) {
if (dqsgd_0c <= lcdl_judge2) { if (dqsgd_0c <= lcdl_judge2) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); regval = mmio_read_32(DBSC_DBPDRGD0) &
mmio_write_32(DBSC_DBPDRGD0, ((dqsgd_0c - bdlcount_0c_div8) | RegVal)); 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGD0,
(dqsgd_0c - bdlcount_0c_div8) |
regval);
} else { } else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); regval = mmio_read_32(DBSC_DBPDRGD0) &
mmio_write_32(DBSC_DBPDRGD0, RegVal); 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGD0, regval);
gatesl_0c = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); gatesl_0c = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, (RegVal | (gatesl_0c + 1))); regval = mmio_read_32(DBSC_DBPDRGD0) &
mmio_write_32(DBSC_DBPDRGA0, 0x000000AF + i * 0x20); 0xFFFFFFF8;
RegVal = (mmio_read_32(DBSC_DBPDRGD0)); mmio_write_32(DBSC_DBPDRGD0, regval |
rdqsd_0c = (RegVal & 0x0000FF00) >> 8; (gatesl_0c + 1));
rdqsnd_0c = (RegVal & 0x00FF0000) >> 16; mmio_write_32(DBSC_DBPDRGA0, 0xAF + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000AF + i * 0x20); regval = (mmio_read_32(DBSC_DBPDRGD0));
mmio_write_32(DBSC_DBPDRGD0, ((RegVal & 0xFF0000FF) | ((rdqsd_0c + bdlcount_0c_div4) << 8) | ((rdqsnd_0c + bdlcount_0c_div4) << 16))); rdqsd_0c = (regval & 0xFF00) >> 8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000AA + i * 0x20); rdqsnd_0c = (regval & 0xFF0000) >> 16;
RegVal = (mmio_read_32(DBSC_DBPDRGD0)); mmio_write_32(DBSC_DBPDRGA0, 0xAF + i * 0x20);
rbd_0c[0] = (RegVal) &0x0000001f; mmio_write_32(DBSC_DBPDRGD0,
rbd_0c[1] = (RegVal >> 8) & 0x0000001f; (regval & 0xFF0000FF) |
rbd_0c[2] = (RegVal >> 16) & 0x0000001f; ((rdqsd_0c +
rbd_0c[3] = (RegVal >> 24) & 0x0000001f; bdlcount_0c_div4) << 8) |
mmio_write_32(DBSC_DBPDRGA0, 0x000000AA + i * 0x20); ((rdqsnd_0c +
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xE0E0E0E0); bdlcount_0c_div4) << 16));
for (j = 0; j < 4; j++) { mmio_write_32(DBSC_DBPDRGA0, 0xAA + i * 0x20);
rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); regval = (mmio_read_32(DBSC_DBPDRGD0));
if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; rbd_0c[0] = (regval) & 0x1f;
RegVal = RegVal | (rbd_0c[j] << 8 * j); rbd_0c[1] = (regval >> 8) & 0x1f;
} rbd_0c[2] = (regval >> 16) & 0x1f;
mmio_write_32(DBSC_DBPDRGD0, RegVal); rbd_0c[3] = (regval >> 24) & 0x1f;
mmio_write_32(DBSC_DBPDRGA0, 0x000000AB + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xAA + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0)); regval = mmio_read_32(DBSC_DBPDRGD0) &
rbd_0c[0] = (RegVal) &0x0000001f; 0xE0E0E0E0;
rbd_0c[1] = (RegVal >> 8) & 0x0000001f;
rbd_0c[2] = (RegVal >> 16) & 0x0000001f;
rbd_0c[3] = (RegVal >> 24) & 0x0000001f;
mmio_write_32(DBSC_DBPDRGA0, 0x000000AB + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xE0E0E0E0);
for (j = 0; j < 4; j++) { for (j = 0; j < 4; j++) {
rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); rbd_0c[j] = rbd_0c[j] +
if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; bdlcount_0c_div4;
RegVal = RegVal | (rbd_0c[j] << 8 * j); if (rbd_0c[j] > 0x1F)
rbd_0c[j] = 0x1F;
regval = regval | (rbd_0c[j] << 8 * j);
} }
mmio_write_32(DBSC_DBPDRGD0, RegVal); mmio_write_32(DBSC_DBPDRGD0, regval);
mmio_write_32(DBSC_DBPDRGA0, 0xAB + i * 0x20);
regval = (mmio_read_32(DBSC_DBPDRGD0));
rbd_0c[0] = (regval) & 0x1f;
rbd_0c[1] = (regval >> 8) & 0x1f;
rbd_0c[2] = (regval >> 16) & 0x1f;
rbd_0c[3] = (regval >> 24) & 0x1f;
mmio_write_32(DBSC_DBPDRGA0, 0xAB + i * 0x20);
regval = mmio_read_32(DBSC_DBPDRGD0) &
0xE0E0E0E0;
for (j = 0; j < 4; j++) {
rbd_0c[j] = rbd_0c[j] +
bdlcount_0c_div4;
if (rbd_0c[j] > 0x1F)
rbd_0c[j] = 0x1F;
regval = regval | (rbd_0c[j] << 8 * j);
} }
mmio_write_32(DBSC_DBPDRGD0, regval);
} }
} }
mmio_write_32(DBSC_DBPDRGA0, 0x00000002); mmio_write_32(DBSC_DBPDRGA0, 0x2);
mmio_write_32(DBSC_DBPDRGD0, 0x07D81E37); mmio_write_32(DBSC_DBPDRGD0, 0x7D81E37);
} }
mmio_write_32(DBSC_DBPDRGA0, 0x00000003); mmio_write_32(DBSC_DBPDRGA0, 0x00000003);
if (byp_ctl == 1) { if (byp_ctl == 1)
mmio_write_32(DBSC_DBPDRGD0, 0x0380C720); mmio_write_32(DBSC_DBPDRGD0, 0x0380C720);
} else { else
mmio_write_32(DBSC_DBPDRGD0, 0x0380C700); mmio_write_32(DBSC_DBPDRGD0, 0x0380C700);
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000007); mmio_write_32(DBSC_DBPDRGA0, 0x00000007);
while ((BIT(30) & mmio_read_32(DBSC_DBPDRGD0)) != 0); while (mmio_read_32(DBSC_DBPDRGD0) & BIT(30))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000021); mmio_write_32(DBSC_DBPDRGA0, 0x00000021);
mmio_write_32(DBSC_DBPDRGD0, 0x0024643E); mmio_write_32(DBSC_DBPDRGD0, 0x0024643E);
mmio_write_32(DBSC_DBBUS0CNF1, 0x00000010); mmio_write_32(DBSC_DBBUS0CNF1, 0x00000010);
mmio_write_32(DBSC_DBCALCNF, (uint32_t)(64000000 / REFRESH_RATE) + 0x01000000); mmio_write_32(DBSC_DBCALCNF, (64000000 / REFRESH_RATE) + 0x01000000);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
mmio_write_32(DBSC_DBRFCNF1, (uint32_t)(REFRESH_RATE * 99 / 125) + 0x00080000); mmio_write_32(DBSC_DBRFCNF1,
(REFRESH_RATE * 99 / 125) + 0x00080000);
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBRFCNF1, (uint32_t)(REFRESH_RATE * 116 / 125) + 0x00080000); mmio_write_32(DBSC_DBRFCNF1,
} /* ddr_md */ (REFRESH_RATE * 116 / 125) + 0x00080000);
}
mmio_write_32(DBSC_DBRFCNF2, 0x00010000); mmio_write_32(DBSC_DBRFCNF2, 0x00010000);
mmio_write_32(DBSC_DBDFICUPDCNF, 0x40100001); mmio_write_32(DBSC_DBDFICUPDCNF, 0x40100001);
mmio_write_32(DBSC_DBRFEN, 0x00000001); mmio_write_32(DBSC_DBRFEN, 0x00000001);
mmio_write_32(DBSC_DBACEN, 0x00000001); mmio_write_32(DBSC_DBACEN, 0x00000001);
/* rev.0.08 */
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(0xE67F0018, 0x00000001); mmio_write_32(0xE67F0018, 0x00000001);
RegVal = mmio_read_32(0x40000000); regval = mmio_read_32(0x40000000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000000); mmio_write_32(DBSC_DBPDRGA0, 0x00000000);
mmio_write_32(DBSC_DBPDRGD0, RegVal); mmio_write_32(DBSC_DBPDRGD0, regval);
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -750,7 +770,7 @@ if (pdqsr_ctl == 1) { ...@@ -750,7 +770,7 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR dynamic */ /* rev.0.10 */ /* PDR dynamic */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
...@@ -762,10 +782,9 @@ if (pdqsr_ctl == 1) { ...@@ -762,10 +782,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
} }
/* rev.0.03 add Comment */ /*
/****************************************************************************
* Initial_Step9( Initial End ) * Initial_Step9( Initial End )
***************************************************************************/ */
mmio_write_32(DBSC_DBPDLK0, 0x00000000); mmio_write_32(DBSC_DBPDLK0, 0x00000000);
mmio_write_32(DBSC_DBSYSCNT0, 0x00000000); mmio_write_32(DBSC_DBSYSCNT0, 0x00000000);
...@@ -802,49 +821,41 @@ if (pdqsr_ctl == 1) { ...@@ -802,49 +821,41 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBSCHQOS152, 0x00000020); mmio_write_32(DBSC_DBSCHQOS152, 0x00000020);
mmio_write_32(DBSC_DBSCHQOS153, 0x00000010); mmio_write_32(DBSC_DBSCHQOS153, 0x00000010);
/* rev.0.08 */ if (pdqsr_ctl == 0)
if (pdqsr_ctl == 1){} else {
mmio_write_32(0xE67F0018, 0x00000001); mmio_write_32(0xE67F0018, 0x00000001);
}
mmio_write_32(DBSC_DBSYSCNT0, 0x00000000); mmio_write_32(DBSC_DBSYSCNT0, 0x00000000);
#endif #endif
return 1; /* rev.0.04 Restore the return code */ return 1;
}
} /* init_ddr */
/* rev.0.04 add function */ static uint32_t recovery_from_backup_mode(uint32_t ddr_backup)
static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
{ {
/**************************************************************************** /*
* recovery_Step0(DBSC Setting 1) / same "init_ddr" * recovery_Step0(DBSC Setting 1) / same "init_ddr"
***************************************************************************/ */
uint32_t RegVal_R2, RegVal_R5, RegVal_R6, RegVal_R7, RegVal_R12, i; uint32_t r2, r5, r6, r7, r12, i;
uint32_t ddr_md; uint32_t ddr_md;
uint32_t err; uint32_t err;
uint32_t regval, j;
/* rev.0.08 */ uint32_t dqsgd_0c, bdlcount_0c, bdlcount_0c_div2, bdlcount_0c_div4;
uint32_t RegVal, j; uint32_t bdlcount_0c_div8, bdlcount_0c_div16;
uint32_t dqsgd_0c, bdlcount_0c, bdlcount_0c_div2, bdlcount_0c_div4, bdlcount_0c_div8, bdlcount_0c_div16;
uint32_t gatesl_0c, rdqsd_0c, rdqsnd_0c, rbd_0c[4]; uint32_t gatesl_0c, rdqsd_0c, rdqsnd_0c, rbd_0c[4];
uint32_t pdqsr_ctl, lcdl_ctl, lcdl_judge1, lcdl_judge2; uint32_t pdqsr_ctl, lcdl_ctl, lcdl_judge1, lcdl_judge2;
/* rev.0.10 */
uint32_t pdr_ctl; uint32_t pdr_ctl;
/* rev.0.11 */
uint32_t byp_ctl; uint32_t byp_ctl;
/* rev.0.08 */
if ((mmio_read_32(0xFFF00044) & 0x000000FF) == 0x00000000) { if ((mmio_read_32(0xFFF00044) & 0x000000FF) == 0x00000000) {
pdqsr_ctl = 1; pdqsr_ctl = 1;
lcdl_ctl = 1; lcdl_ctl = 1;
pdr_ctl = 1; /* rev.0.10 */ pdr_ctl = 1;
byp_ctl = 1; /* rev.0.11 */ byp_ctl = 1;
} else { } else {
pdqsr_ctl = 0; pdqsr_ctl = 0;
lcdl_ctl = 0; lcdl_ctl = 0;
pdr_ctl = 0; /* rev.0.10 */ pdr_ctl = 0;
byp_ctl = 0; /* rev.0.11 */ byp_ctl = 0;
} }
/* Judge the DDR bit rate (ddr_md : 0 = 1584Mbps, 1 = 1856Mbps) */ /* Judge the DDR bit rate (ddr_md : 0 = 1584Mbps, 1 = 1856Mbps) */
...@@ -852,21 +863,19 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -852,21 +863,19 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
/* 1584Mbps setting */ /* 1584Mbps setting */
if (ddr_md == 0) { if (ddr_md == 0) {
/* CPG setting ===============================================*/
mmio_write_32(CPG_CPGWPR, 0x5A5AFFFF); mmio_write_32(CPG_CPGWPR, 0x5A5AFFFF);
mmio_write_32(CPG_CPGWPCR, 0xA5A50000); mmio_write_32(CPG_CPGWPCR, 0xA5A50000);
mmio_write_32(CPG_SRCR4, 0x20000000); mmio_write_32(CPG_SRCR4, 0x20000000);
mmio_write_32(0xE61500DC, 0xe2200000); /* Change to 1584Mbps */ mmio_write_32(0xE61500DC, 0xe2200000); /* Change to 1584Mbps */
while ((BIT(11) & mmio_read_32(CPG_PLLECR)) == 0); while (!(mmio_read_32(CPG_PLLECR) & BIT(11)))
;
mmio_write_32(CPG_SRSTCLR4, 0x20000000); mmio_write_32(CPG_SRSTCLR4, 0x20000000);
mmio_write_32(CPG_CPGWPCR, 0xA5A50001); mmio_write_32(CPG_CPGWPCR, 0xA5A50001);
}
/* CPG setting ===============================================*/
} /* ddr_md */
mmio_write_32(DBSC_DBSYSCNT0, 0x00001234); mmio_write_32(DBSC_DBSYSCNT0, 0x00001234);
mmio_write_32(DBSC_DBKIND, 0x00000007); mmio_write_32(DBSC_DBKIND, 0x00000007);
...@@ -877,10 +886,9 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -877,10 +886,9 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBMEMCONF00, 0x10030a02); mmio_write_32(DBSC_DBMEMCONF00, 0x10030a02);
#endif #endif
/* rev.0.08 */
#if RCAR_DRAM_DDR3L_MEMDUAL == 1 #if RCAR_DRAM_DDR3L_MEMDUAL == 1
RegVal_R2 = (mmio_read_32(0xE6790614)); r2 = mmio_read_32(0xE6790614);
mmio_write_32(0xE6790614, RegVal_R2 | 0x00000003); /* MCS1_N/MODT1 are activated. */ mmio_write_32(0xE6790614, r2 | 0x3); /* MCS1_N/MODT1 are activated. */
#endif #endif
mmio_write_32(DBSC_DBPHYCONF0, 0x00000001); mmio_write_32(DBSC_DBPHYCONF0, 0x00000001);
...@@ -892,7 +900,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -892,7 +900,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBTR0, 0x0000000D); mmio_write_32(DBSC_DBTR0, 0x0000000D);
mmio_write_32(DBSC_DBTR1, 0x00000009); mmio_write_32(DBSC_DBTR1, 0x00000009);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR2, 0x00000000); mmio_write_32(DBSC_DBTR2, 0x00000000);
...@@ -907,7 +915,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -907,7 +915,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBTR4, 0x000D000D); mmio_write_32(DBSC_DBTR4, 0x000D000D);
mmio_write_32(DBSC_DBTR5, 0x0000002D); mmio_write_32(DBSC_DBTR5, 0x0000002D);
mmio_write_32(DBSC_DBTR6, 0x00000020); mmio_write_32(DBSC_DBTR6, 0x00000020);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR7, 0x00060006); mmio_write_32(DBSC_DBTR7, 0x00060006);
...@@ -934,7 +942,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -934,7 +942,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBTR15, 0x00060005); mmio_write_32(DBSC_DBTR15, 0x00060005);
mmio_write_32(DBSC_DBTR16, 0x09210507); mmio_write_32(DBSC_DBTR16, 0x09210507);
mmio_write_32(DBSC_DBTR17, 0x040E0000); mmio_write_32(DBSC_DBTR17, 0x040E0000);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR18, 0x00000200); mmio_write_32(DBSC_DBTR18, 0x00000200);
...@@ -945,7 +953,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -945,7 +953,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBTR19, 0x0129004B); mmio_write_32(DBSC_DBTR19, 0x0129004B);
mmio_write_32(DBSC_DBTR20, 0x020000FB); mmio_write_32(DBSC_DBTR20, 0x020000FB);
} /* ddr_md */ }
mmio_write_32(DBSC_DBTR21, 0x00040004); mmio_write_32(DBSC_DBTR21, 0x00040004);
mmio_write_32(DBSC_DBBL, 0x00000000); mmio_write_32(DBSC_DBBL, 0x00000000);
...@@ -963,84 +971,82 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -963,84 +971,82 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_SCFCTST0, 0x0C050B03); mmio_write_32(DBSC_SCFCTST0, 0x0C050B03);
mmio_write_32(DBSC_SCFCTST1, 0x0305030C); mmio_write_32(DBSC_SCFCTST1, 0x0305030C);
} /* ddr_md */ }
/**************************************************************************** /*
* recovery_Step1(PHY setting 1) * recovery_Step1(PHY setting 1)
***************************************************************************/ */
mmio_write_32(DBSC_DBPDLK0, 0x0000A55A); mmio_write_32(DBSC_DBPDLK0, 0x0000A55A);
mmio_write_32(DBSC_DBCMD, 0x01840001); mmio_write_32(DBSC_DBCMD, 0x01840001);
mmio_write_32(DBSC_DBCMD, 0x0A840000); mmio_write_32(DBSC_DBCMD, 0x0A840000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000008); /* DDR_PLLCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000008); /* DDR_PLLCR */
mmio_write_32(DBSC_DBPDRGD0, 0x000B8000); mmio_write_32(DBSC_DBPDRGD0, 0x000B8000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000003); /* DDR_PGCR1 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000003); /* DDR_PGCR1 */
if (byp_ctl == 1) { if (byp_ctl == 1)
mmio_write_32(DBSC_DBPDRGD0, 0x0780C720); mmio_write_32(DBSC_DBPDRGD0, 0x0780C720);
} else { else
mmio_write_32(DBSC_DBPDRGD0, 0x0780C700); mmio_write_32(DBSC_DBPDRGD0, 0x0780C700);
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000020); /* DDR_DXCCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000020); /* DDR_DXCCR */
mmio_write_32(DBSC_DBPDRGD0, 0x00181884); mmio_write_32(DBSC_DBPDRGD0, 0x00181884);
mmio_write_32(DBSC_DBPDRGA0, 0x0000001A); /* DDR_ACIOCR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x0000001A); /* DDR_ACIOCR0 */
mmio_write_32(DBSC_DBPDRGD0, 0x33C03C10); mmio_write_32(DBSC_DBPDRGD0, 0x33C03C10);
mmio_write_32(DBSC_DBPDRGA0, 0x00000007); mmio_write_32(DBSC_DBPDRGA0, 0x00000007);
while ((BIT(30) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(30)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000004); mmio_write_32(DBSC_DBPDRGA0, 0x00000004);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, (uint32_t)(REFRESH_RATE * 792 / 125) - 400 + 0x08B00000); mmio_write_32(DBSC_DBPDRGD0, (REFRESH_RATE * 792 / 125) -
400 + 0x08B00000);
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, (uint32_t)(REFRESH_RATE * 928 / 125) - 400 + 0x0A300000); mmio_write_32(DBSC_DBPDRGD0, (REFRESH_RATE * 928 / 125) -
} /* ddr_md */ 400 + 0x0A300000);
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000022); mmio_write_32(DBSC_DBPDRGA0, 0x00000022);
mmio_write_32(DBSC_DBPDRGD0, 0x1000040B); mmio_write_32(DBSC_DBPDRGD0, 0x1000040B);
mmio_write_32(DBSC_DBPDRGA0, 0x00000023); mmio_write_32(DBSC_DBPDRGA0, 0x00000023);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x2D9C0B66); mmio_write_32(DBSC_DBPDRGD0, 0x2D9C0B66);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x35A00D77); mmio_write_32(DBSC_DBPDRGD0, 0x35A00D77);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000024); mmio_write_32(DBSC_DBPDRGA0, 0x00000024);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x2A88B400); mmio_write_32(DBSC_DBPDRGD0, 0x2A88B400);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x2A8A2C28); mmio_write_32(DBSC_DBPDRGD0, 0x2A8A2C28);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000025); mmio_write_32(DBSC_DBPDRGA0, 0x00000025);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x30005200); mmio_write_32(DBSC_DBPDRGD0, 0x30005200);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x30005E00); mmio_write_32(DBSC_DBPDRGD0, 0x30005E00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000026); mmio_write_32(DBSC_DBPDRGA0, 0x00000026);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0014A9C9); mmio_write_32(DBSC_DBPDRGD0, 0x0014A9C9);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0014CB49); mmio_write_32(DBSC_DBPDRGD0, 0x0014CB49);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000027); mmio_write_32(DBSC_DBPDRGA0, 0x00000027);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x00000D70); mmio_write_32(DBSC_DBPDRGD0, 0x00000D70);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x00000F14); mmio_write_32(DBSC_DBPDRGD0, 0x00000F14);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000028); mmio_write_32(DBSC_DBPDRGA0, 0x00000028);
mmio_write_32(DBSC_DBPDRGD0, 0x00000046); mmio_write_32(DBSC_DBPDRGD0, 0x00000046);
...@@ -1048,18 +1054,16 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1048,18 +1054,16 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
if (REFRESH_RATE > 3900) { if (REFRESH_RATE > 3900)
mmio_write_32(DBSC_DBPDRGD0, 0x00000018); /* [7]SRT=0 */ mmio_write_32(DBSC_DBPDRGD0, 0x18); /* [7]SRT=0 */
} else { else
mmio_write_32(DBSC_DBPDRGD0, 0x00000098); /* [7]SRT=1 */ mmio_write_32(DBSC_DBPDRGD0, 0x98); /* [7]SRT=1 */
}
} else { /* 1856Mbps */ } else { /* 1856Mbps */
if (REFRESH_RATE > 3900) { if (REFRESH_RATE > 3900)
mmio_write_32(DBSC_DBPDRGD0, 0x00000020); /* [7]SRT=0 */ mmio_write_32(DBSC_DBPDRGD0, 0x20); /* [7]SRT=0 */
} else { else
mmio_write_32(DBSC_DBPDRGD0, 0x000000A0); /* [7]SRT=1 */ mmio_write_32(DBSC_DBPDRGD0, 0xA0); /* [7]SRT=1 */
} /* REFRESH_RATE */ }
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x0000002C); mmio_write_32(DBSC_DBPDRGA0, 0x0000002C);
mmio_write_32(DBSC_DBPDRGD0, 0x81003047); mmio_write_32(DBSC_DBPDRGD0, 0x81003047);
...@@ -1072,13 +1076,15 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1072,13 +1076,15 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBPDRGA0, 0x00000021); /* DDR_DSGCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000021); /* DDR_DSGCR */
mmio_write_32(DBSC_DBPDRGD0, 0x0024641E); mmio_write_32(DBSC_DBPDRGD0, 0x0024641E);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */
mmio_write_32(DBSC_DBPDRGD0, 0x40010000); mmio_write_32(DBSC_DBPDRGD0, 0x40010000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000092); /* DDR_ZQ0DR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000092); /* DDR_ZQ0DR */
mmio_write_32(DBSC_DBPDRGD0, 0xC2C59AB5); mmio_write_32(DBSC_DBPDRGD0, 0xC2C59AB5);
...@@ -1089,38 +1095,37 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1089,38 +1095,37 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0C058900); mmio_write_32(DBSC_DBPDRGD0, 0x0C058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0C058A00); mmio_write_32(DBSC_DBPDRGD0, 0x0C058A00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058900); mmio_write_32(DBSC_DBPDRGD0, 0x04058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058A00); mmio_write_32(DBSC_DBPDRGD0, 0x04058A00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */
mmio_write_32(DBSC_DBPDRGD0, 0x00050001); mmio_write_32(DBSC_DBPDRGD0, 0x00050001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* ddr backupmode end */ /* ddr backupmode end */
if (ddrBackup) { if (ddr_backup)
NOTICE("BL2: [WARM_BOOT]\n"); NOTICE("BL2: [WARM_BOOT]\n");
} else { else
NOTICE("BL2: [COLD_BOOT]\n"); NOTICE("BL2: [COLD_BOOT]\n");
} /* ddrBackup */
err = rcar_dram_update_boot_status(ddrBackup); err = rcar_dram_update_boot_status(ddr_backup);
if (err) { if (err) {
NOTICE("BL2: [BOOT_STATUS_UPDATE_ERROR]\n"); NOTICE("BL2: [BOOT_STATUS_UPDATE_ERROR]\n");
return INITDRAM_ERR_I; return INITDRAM_ERR_I;
} /* err */ }
mmio_write_32(DBSC_DBPDRGA0, 0x00000092); /* DDR_ZQ0DR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000092); /* DDR_ZQ0DR */
mmio_write_32(DBSC_DBPDRGD0, 0x02C59AB5); mmio_write_32(DBSC_DBPDRGD0, 0x02C59AB5);
...@@ -1136,47 +1141,48 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1136,47 +1141,48 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBPDRGD0, 0x00000003); mmio_write_32(DBSC_DBPDRGD0, 0x00000003);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */
mmio_write_32(DBSC_DBPDRGD0, 0x80010000); mmio_write_32(DBSC_DBPDRGD0, 0x80010000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */
mmio_write_32(DBSC_DBPDRGD0, 0x00010073); mmio_write_32(DBSC_DBPDRGD0, 0x00010073);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0C058900); mmio_write_32(DBSC_DBPDRGD0, 0x0C058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x0C058A00); mmio_write_32(DBSC_DBPDRGD0, 0x0C058A00);
} /* ddr_md */
mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000090); /* DDR_ZQCR */
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) /* 1584Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058900); mmio_write_32(DBSC_DBPDRGD0, 0x04058900);
} else { /* 1856Mbps */ else /* 1856Mbps */
mmio_write_32(DBSC_DBPDRGD0, 0x04058A00); mmio_write_32(DBSC_DBPDRGD0, 0x04058A00);
} /* ddr_md */
/* rev0.08 */
mmio_write_32(DBSC_DBPDRGA0, 0x0000000C); mmio_write_32(DBSC_DBPDRGA0, 0x0000000C);
mmio_write_32(DBSC_DBPDRGD0, 0x18000040); mmio_write_32(DBSC_DBPDRGD0, 0x18000040);
/**************************************************************************** /*
* recovery_Step2(PHY setting 2) * recovery_Step2(PHY setting 2)
***************************************************************************/ */
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x000000A7); mmio_write_32(DBSC_DBPDRGA0, 0x000000A7);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D); mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
...@@ -1203,70 +1209,75 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1203,70 +1209,75 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBPDRGA0, 0x00000109); mmio_write_32(DBSC_DBPDRGA0, 0x00000109);
mmio_write_32(DBSC_DBPDRGD0, 0x000D0D0D); mmio_write_32(DBSC_DBPDRGD0, 0x000D0D0D);
mmio_write_32(DBSC_DBCALCNF, (uint32_t)(64000000 / REFRESH_RATE) + 0x01000000); mmio_write_32(DBSC_DBCALCNF, (64000000 / REFRESH_RATE) + 0x01000000);
mmio_write_32(DBSC_DBBUS0CNF1, 0x00000010); mmio_write_32(DBSC_DBBUS0CNF1, 0x00000010);
/* Select setting value in bps */ /* Select setting value in bps */
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
mmio_write_32(DBSC_DBRFCNF1, (uint32_t)(REFRESH_RATE * 99 / 125) + 0x00080000); mmio_write_32(DBSC_DBRFCNF1,
(REFRESH_RATE * 99 / 125) + 0x00080000);
} else { /* 1856Mbps */ } else { /* 1856Mbps */
mmio_write_32(DBSC_DBRFCNF1, (uint32_t)(REFRESH_RATE * 116 / 125) + 0x00080000); mmio_write_32(DBSC_DBRFCNF1,
} /* ddr_md */ (REFRESH_RATE * 116 / 125) + 0x00080000);
}
mmio_write_32(DBSC_DBRFCNF2, 0x00010000); mmio_write_32(DBSC_DBRFCNF2, 0x00010000);
mmio_write_32(DBSC_DBRFEN, 0x00000001); mmio_write_32(DBSC_DBRFEN, 0x00000001);
mmio_write_32(DBSC_DBCMD, 0x0A840001); mmio_write_32(DBSC_DBCMD, 0x0A840001);
while ((BIT(0) & mmio_read_32(DBSC_DBWAIT)) != 0); while (mmio_read_32(DBSC_DBWAIT) & BIT(0))
;
mmio_write_32(DBSC_DBCMD, 0x00000000); mmio_write_32(DBSC_DBCMD, 0x00000000);
mmio_write_32(DBSC_DBCMD, 0x04840010); mmio_write_32(DBSC_DBCMD, 0x04840010);
while ((BIT(0) & mmio_read_32(DBSC_DBWAIT)) != 0); while (mmio_read_32(DBSC_DBWAIT) & BIT(0))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */ mmio_write_32(DBSC_DBPDRGA0, 0x00000001); /* DDR_PIR */
mmio_write_32(DBSC_DBPDRGD0, 0x00010701); mmio_write_32(DBSC_DBPDRGD0, 0x00010701);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */ mmio_write_32(DBSC_DBPDRGA0, 0x00000006); /* DDR_PGSR0 */
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
for (i = 0; i < 4; i++) for (i = 0; i < 4; i++) {
{ mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20); r5 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >> 0x8;
RegVal_R5 = (mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 0x8; mmio_write_32(DBSC_DBPDRGA0, 0xB4 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B4 + i * 0x20); r6 = mmio_read_32(DBSC_DBPDRGD0) & 0xFF;
RegVal_R6 = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF); mmio_write_32(DBSC_DBPDRGA0, 0xB3 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B3 + i * 0x20); r7 = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
RegVal_R7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007);
if (r6 > 0) {
if (RegVal_R6 > 0) { mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r7 + 0x1) & 0x7));
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGD0, r2 | r6);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | RegVal_R6);
} else { } else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | RegVal_R7); mmio_write_32(DBSC_DBPDRGD0, r2 | r7);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R6 + ((RegVal_R5) << 1)) & 0x000000FF)); mmio_write_32(DBSC_DBPDRGD0,
} /* RegVal_R6 */ r2 | ((r6 + (r5 << 1)) & 0xFF));
} /* for i */ }
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000005); mmio_write_32(DBSC_DBPDRGA0, 0x00000005);
mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00C0); mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00C0);
/* rev.0.08 */ if (pdqsr_ctl == 0) {
if (pdqsr_ctl == 1){} else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -1277,7 +1288,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1277,7 +1288,7 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR always off */ /* rev.0.10 */ /* PDR always off */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000008); mmio_write_32(DBSC_DBPDRGD0, 0x00000008);
...@@ -1292,18 +1303,19 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup) ...@@ -1292,18 +1303,19 @@ static uint32_t recovery_from_backup_mode(uint32_t ddrBackup)
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010801); mmio_write_32(DBSC_DBPDRGD0, 0x00010801);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000005); mmio_write_32(DBSC_DBPDRGA0, 0x00000005);
mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00D8); mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00D8);
/* rev.0.08 */
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00011001); mmio_write_32(DBSC_DBPDRGD0, 0x00011001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -1312,9 +1324,9 @@ if (pdqsr_ctl == 1) { ...@@ -1312,9 +1324,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100); mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR dynamic */ /* rev.0.10 */ /* PDR dynamic */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
...@@ -1329,9 +1341,10 @@ if (pdqsr_ctl == 1) { ...@@ -1329,9 +1341,10 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00012001); mmio_write_32(DBSC_DBPDRGD0, 0x00012001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -1340,9 +1353,9 @@ if (pdqsr_ctl == 1) { ...@@ -1340,9 +1353,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100); mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
} }
/* PDR always off */ /* rev.0.10 */ /* PDR always off */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000008); mmio_write_32(DBSC_DBPDRGD0, 0x00000008);
...@@ -1357,9 +1370,10 @@ if (pdqsr_ctl == 1) { ...@@ -1357,9 +1370,10 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00014001); mmio_write_32(DBSC_DBPDRGD0, 0x00014001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -1368,9 +1382,9 @@ if (pdqsr_ctl == 1) { ...@@ -1368,9 +1382,9 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100); mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR dynamic */ /* rev.0.10 */ /* PDR dynamic */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
...@@ -1385,7 +1399,8 @@ if (pdqsr_ctl == 1) { ...@@ -1385,7 +1399,8 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00018001); mmio_write_32(DBSC_DBPDRGD0, 0x00018001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285); mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
...@@ -1400,40 +1415,42 @@ if (pdqsr_ctl == 1) { ...@@ -1400,40 +1415,42 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010401); mmio_write_32(DBSC_DBPDRGD0, 0x00010401);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
RegVal_R5 = ((mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 0x8); r5 = ((mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >> 0x8);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B4 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB4 + i * 0x20);
RegVal_R6 = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF); r6 = mmio_read_32(DBSC_DBPDRGD0) & 0xFF;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B3 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB3 + i * 0x20);
RegVal_R7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007); r7 = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
RegVal_R12 = (RegVal_R5 >> 0x2); r12 = r5 >> 0x2;
if (RegVal_R12 < RegVal_R6) { if (r12 < r6) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r7 + 0x1) & 0x7));
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R6 - (RegVal_R12)) & 0x000000FF)); mmio_write_32(DBSC_DBPDRGD0, r2 | ((r6 - r12) & 0xFF));
} else { } else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | (RegVal_R7 & 0x00000007)); mmio_write_32(DBSC_DBPDRGD0, r2 | (r7 & 0x7));
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); r2 = mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, RegVal_R2 | ((RegVal_R6 + (RegVal_R5) + ((RegVal_R5) >> 1) + (RegVal_R12)) & 0x000000FF)); mmio_write_32(DBSC_DBPDRGD0,
} /* RegVal_R12 < RegVal_R6 */ r2 |
} /* for i */ ((r6 + r5 + (r5 >> 1) + r12) & 0xFF));
}
}
/* rev.0.08 */ if (pdqsr_ctl == 0) {
if (pdqsr_ctl == 1){} else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -1444,7 +1461,7 @@ if (pdqsr_ctl == 1) { ...@@ -1444,7 +1461,7 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR always off */ /* rev.0.10 */ /* PDR always off */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000008); mmio_write_32(DBSC_DBPDRGD0, 0x00000008);
...@@ -1459,107 +1476,131 @@ if (pdqsr_ctl == 1) { ...@@ -1459,107 +1476,131 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x00000001); mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00015001); mmio_write_32(DBSC_DBPDRGD0, 0x00015001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006); mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while ((BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0); while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
/* rev.0.08 */
if (lcdl_ctl == 1) { if (lcdl_ctl == 1) {
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20);
dqsgd_0c = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF); dqsgd_0c = mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0x000000B1 + i * 0x20);
bdlcount_0c = ((mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 8); bdlcount_0c = (mmio_read_32(DBSC_DBPDRGD0) &
0x0000FF00) >> 8;
bdlcount_0c_div2 = (bdlcount_0c >> 1); bdlcount_0c_div2 = (bdlcount_0c >> 1);
bdlcount_0c_div4 = (bdlcount_0c >> 2); bdlcount_0c_div4 = (bdlcount_0c >> 2);
bdlcount_0c_div8 = (bdlcount_0c >> 3); bdlcount_0c_div8 = (bdlcount_0c >> 3);
bdlcount_0c_div16 = (bdlcount_0c >> 4); bdlcount_0c_div16 = (bdlcount_0c >> 4);
if (ddr_md == 0) { /* 1584Mbps */ if (ddr_md == 0) { /* 1584Mbps */
lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4 + bdlcount_0c_div8; lcdl_judge1 = bdlcount_0c_div2 +
lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4 + bdlcount_0c_div16; bdlcount_0c_div4 +
bdlcount_0c_div8;
lcdl_judge2 = bdlcount_0c +
bdlcount_0c_div4 +
bdlcount_0c_div16;
} else { /* 1856Mbps */ } else { /* 1856Mbps */
lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4; lcdl_judge1 = bdlcount_0c_div2 +
lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4; bdlcount_0c_div4;
} /* ddr_md */ lcdl_judge2 = bdlcount_0c +
bdlcount_0c_div4;
}
if (dqsgd_0c <= lcdl_judge1)
continue;
if (dqsgd_0c > lcdl_judge1) {
if (dqsgd_0c <= lcdl_judge2) { if (dqsgd_0c <= lcdl_judge2) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); regval = mmio_read_32(DBSC_DBPDRGD0) &
mmio_write_32(DBSC_DBPDRGD0, ((dqsgd_0c - bdlcount_0c_div8) | RegVal)); 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGD0,
(dqsgd_0c - bdlcount_0c_div8) |
regval);
} else { } else {
mmio_write_32(DBSC_DBPDRGA0, 0x000000B0 + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00); regval = mmio_read_32(DBSC_DBPDRGD0) &
mmio_write_32(DBSC_DBPDRGD0, RegVal); 0xFFFFFF00;
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); mmio_write_32(DBSC_DBPDRGD0, regval);
gatesl_0c = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000B2 + i * 0x20); gatesl_0c = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8); mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, (RegVal | (gatesl_0c + 1))); regval = mmio_read_32(DBSC_DBPDRGD0) &
mmio_write_32(DBSC_DBPDRGA0, 0x000000AF + i * 0x20); 0xFFFFFFF8;
RegVal = (mmio_read_32(DBSC_DBPDRGD0)); mmio_write_32(DBSC_DBPDRGD0,
rdqsd_0c = (RegVal & 0x0000FF00) >> 8; regval | (gatesl_0c + 1));
rdqsnd_0c = (RegVal & 0x00FF0000) >> 16; mmio_write_32(DBSC_DBPDRGA0, 0xAF + i * 0x20);
mmio_write_32(DBSC_DBPDRGA0, 0x000000AF + i * 0x20); regval = mmio_read_32(DBSC_DBPDRGD0);
mmio_write_32(DBSC_DBPDRGD0, ((RegVal & 0xFF0000FF) | ((rdqsd_0c + bdlcount_0c_div4) << 8) | ((rdqsnd_0c + bdlcount_0c_div4) << 16))); rdqsd_0c = (regval & 0xFF00) >> 8;
mmio_write_32(DBSC_DBPDRGA0, 0x000000AA + i * 0x20); rdqsnd_0c = (regval & 0xFF0000) >> 16;
RegVal = (mmio_read_32(DBSC_DBPDRGD0)); mmio_write_32(DBSC_DBPDRGA0, 0xAF + i * 0x20);
rbd_0c[0] = (RegVal) &0x0000001f; mmio_write_32(DBSC_DBPDRGD0,
rbd_0c[1] = (RegVal >> 8) & 0x0000001f; (regval & 0xFF0000FF) |
rbd_0c[2] = (RegVal >> 16) & 0x0000001f; ((rdqsd_0c +
rbd_0c[3] = (RegVal >> 24) & 0x0000001f; bdlcount_0c_div4) << 8) |
mmio_write_32(DBSC_DBPDRGA0, 0x000000AA + i * 0x20); ((rdqsnd_0c +
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xE0E0E0E0); bdlcount_0c_div4) << 16));
for (j = 0; j < 4; j++) { mmio_write_32(DBSC_DBPDRGA0, 0xAA + i * 0x20);
rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); regval = (mmio_read_32(DBSC_DBPDRGD0));
if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; rbd_0c[0] = (regval) & 0x1f;
RegVal = RegVal | (rbd_0c[j] << 8 * j); rbd_0c[1] = (regval >> 8) & 0x1f;
} rbd_0c[2] = (regval >> 16) & 0x1f;
mmio_write_32(DBSC_DBPDRGD0, RegVal); rbd_0c[3] = (regval >> 24) & 0x1f;
mmio_write_32(DBSC_DBPDRGA0, 0x000000AB + i * 0x20); mmio_write_32(DBSC_DBPDRGA0, 0xAA + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0)); regval = mmio_read_32(DBSC_DBPDRGD0) &
rbd_0c[0] = (RegVal) &0x0000001f; 0xE0E0E0E0;
rbd_0c[1] = (RegVal >> 8) & 0x0000001f;
rbd_0c[2] = (RegVal >> 16) & 0x0000001f;
rbd_0c[3] = (RegVal >> 24) & 0x0000001f;
mmio_write_32(DBSC_DBPDRGA0, 0x000000AB + i * 0x20);
RegVal = (mmio_read_32(DBSC_DBPDRGD0) & 0xE0E0E0E0);
for (j = 0; j < 4; j++) { for (j = 0; j < 4; j++) {
rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); rbd_0c[j] = rbd_0c[j] +
if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; bdlcount_0c_div4;
RegVal = RegVal | (rbd_0c[j] << 8 * j); if (rbd_0c[j] > 0x1F)
rbd_0c[j] = 0x1F;
regval = regval | (rbd_0c[j] << 8 * j);
} }
mmio_write_32(DBSC_DBPDRGD0, RegVal); mmio_write_32(DBSC_DBPDRGD0, regval);
mmio_write_32(DBSC_DBPDRGA0, 0xAB + i * 0x20);
regval = (mmio_read_32(DBSC_DBPDRGD0));
rbd_0c[0] = regval & 0x1f;
rbd_0c[1] = (regval >> 8) & 0x1f;
rbd_0c[2] = (regval >> 16) & 0x1f;
rbd_0c[3] = (regval >> 24) & 0x1f;
mmio_write_32(DBSC_DBPDRGA0, 0xAB + i * 0x20);
regval = mmio_read_32(DBSC_DBPDRGD0) &
0xE0E0E0E0;
for (j = 0; j < 4; j++) {
rbd_0c[j] = rbd_0c[j] +
bdlcount_0c_div4;
if (rbd_0c[j] > 0x1F)
rbd_0c[j] = 0x1F;
regval = regval | (rbd_0c[j] << 8 * j);
} }
mmio_write_32(DBSC_DBPDRGD0, regval);
} }
} }
mmio_write_32(DBSC_DBPDRGA0, 0x00000002); mmio_write_32(DBSC_DBPDRGA0, 0x00000002);
mmio_write_32(DBSC_DBPDRGD0, 0x07D81E37); mmio_write_32(DBSC_DBPDRGD0, 0x07D81E37);
} }
mmio_write_32(DBSC_DBPDRGA0, 0x00000003); mmio_write_32(DBSC_DBPDRGA0, 0x00000003);
if (byp_ctl == 1) { if (byp_ctl == 1)
mmio_write_32(DBSC_DBPDRGD0, 0x0380C720); mmio_write_32(DBSC_DBPDRGD0, 0x0380C720);
} else { else
mmio_write_32(DBSC_DBPDRGD0, 0x0380C700); mmio_write_32(DBSC_DBPDRGD0, 0x0380C700);
}
mmio_write_32(DBSC_DBPDRGA0, 0x00000007); mmio_write_32(DBSC_DBPDRGA0, 0x00000007);
while ((BIT(30) & mmio_read_32(DBSC_DBPDRGD0)) != 0); while (mmio_read_32(DBSC_DBPDRGD0) & BIT(30))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000021); mmio_write_32(DBSC_DBPDRGA0, 0x00000021);
mmio_write_32(DBSC_DBPDRGD0, 0x0024643E); mmio_write_32(DBSC_DBPDRGD0, 0x0024643E);
/**************************************************************************** /*
* recovery_Step3(DBSC Setting 2) * recovery_Step3(DBSC Setting 2)
***************************************************************************/ */
mmio_write_32(DBSC_DBDFICUPDCNF, 0x40100001); mmio_write_32(DBSC_DBDFICUPDCNF, 0x40100001);
mmio_write_32(DBSC_DBACEN, 0x00000001); mmio_write_32(DBSC_DBACEN, 0x00000001);
/* rev.0.08 */
if (pdqsr_ctl == 1) { if (pdqsr_ctl == 1) {
mmio_write_32(0xE67F0018, 0x00000001); mmio_write_32(0xE67F0018, 0x00000001);
RegVal = mmio_read_32(0x40000000); regval = mmio_read_32(0x40000000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000000); mmio_write_32(DBSC_DBPDRGA0, 0x00000000);
mmio_write_32(DBSC_DBPDRGD0, RegVal); mmio_write_32(DBSC_DBPDRGD0, regval);
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0); mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0); mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
...@@ -1570,7 +1611,7 @@ if (pdqsr_ctl == 1) { ...@@ -1570,7 +1611,7 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5); mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
} }
/* PDR dynamic */ /* rev.0.10 */ /* PDR dynamic */
if (pdr_ctl == 1) { if (pdr_ctl == 1) {
mmio_write_32(DBSC_DBPDRGA0, 0x000000A3); mmio_write_32(DBSC_DBPDRGA0, 0x000000A3);
mmio_write_32(DBSC_DBPDRGD0, 0x00000000); mmio_write_32(DBSC_DBPDRGD0, 0x00000000);
...@@ -1618,10 +1659,8 @@ if (pdqsr_ctl == 1) { ...@@ -1618,10 +1659,8 @@ if (pdqsr_ctl == 1) {
mmio_write_32(DBSC_DBSCHQOS152, 0x00000020); mmio_write_32(DBSC_DBSCHQOS152, 0x00000020);
mmio_write_32(DBSC_DBSCHQOS153, 0x00000010); mmio_write_32(DBSC_DBSCHQOS153, 0x00000010);
/* rev.0.08 */ if (pdqsr_ctl == 0)
if (pdqsr_ctl == 1){} else {
mmio_write_32(0xE67F0018, 0x00000001); mmio_write_32(0xE67F0018, 0x00000001);
}
mmio_write_32(DBSC_DBSYSCNT0, 0x00000000); mmio_write_32(DBSC_DBSYSCNT0, 0x00000000);
#endif #endif
...@@ -1630,50 +1669,43 @@ if (pdqsr_ctl == 1) { ...@@ -1630,50 +1669,43 @@ if (pdqsr_ctl == 1) {
} /* recovery_from_backup_mode */ } /* recovery_from_backup_mode */
/******************************************************************************* /*
* init_ddr : MD19=0,DDR3L,1584Mbps / MD19=1,DDR3L,1856Mbps * init_ddr : MD19=0,DDR3L,1584Mbps / MD19=1,DDR3L,1856Mbps
******************************************************************************/ */
/******************************************************************************* /*
* DDR Initialize entry for IPL * DDR Initialize entry for IPL
******************************************************************************/ */
int32_t rcar_dram_init(void) int32_t rcar_dram_init(void)
{ {
uint32_t dataL; uint32_t dataL;
uint32_t failcount; uint32_t failcount;
uint32_t md = 0; uint32_t md = 0;
uint32_t ddr = 0; uint32_t ddr = 0;
uint32_t ddrBackup; uint32_t ddr_backup;
md = *((volatile uint32_t*)RST_MODEMR); md = *((volatile uint32_t*)RST_MODEMR);
ddr = (md & 0x00080000) >> 19; ddr = (md & 0x00080000) >> 19;
if (ddr == 0x0) { if (ddr == 0x0)
NOTICE("BL2: DDR1584(%s)\n", RCAR_E3_DDR_VERSION); NOTICE("BL2: DDR1584(%s)\n", RCAR_E3_DDR_VERSION);
} else if(ddr == 0x1){ else if (ddr == 0x1)
NOTICE("BL2: DDR1856(%s)\n", RCAR_E3_DDR_VERSION); NOTICE("BL2: DDR1856(%s)\n", RCAR_E3_DDR_VERSION);
} /* ddr */
rcar_dram_get_boot_status(&ddrBackup); rcar_dram_get_boot_status(&ddr_backup);
if (ddrBackup == DRAM_BOOT_STATUS_WARM) { if (ddr_backup == DRAM_BOOT_STATUS_WARM)
dataL = recovery_from_backup_mode(ddrBackup); /* WARM boot */ dataL = recovery_from_backup_mode(ddr_backup); /* WARM boot */
} else { else
dataL = init_ddr(); /* COLD boot */ dataL = init_ddr(); /* COLD boot */
} /* ddrBackup */
if (dataL == 1) { if (dataL == 1)
failcount = 0; failcount = 0;
} else { else
failcount = 1; failcount = 1;
} /* dataL */
if (failcount == 0) { if (failcount == 0)
return INITDRAM_OK; return INITDRAM_OK;
} else { else
return INITDRAM_NG; return INITDRAM_NG;
} /* failcount */
} /* InitDram */
/******************************************************************************* }
* END
******************************************************************************/
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment